sakthi priya amirtharaj / Mbed 2 deprecated BAE_working_always

i2c working version

Dependencies:   mbed-rtos mbed

mnm.cpp@0:7882d03f59e2, 2015-04-09 (annotated)

Committer:
sakthipriya
Date:
Thu Apr 09 22:44:39 2015 +0000
Revision:
0:7882d03f59e2
i2c working version

Who changed what in which revision?

UserRevisionLine numberNew contents of line
sakthipriya 0:7882d03f59e2 1 #include<mbed.h>
sakthipriya 0:7882d03f59e2 2 #include "mnm.h"
sakthipriya 0:7882d03f59e2 3 #include "pni.h" //pni header file
sakthipriya 0:7882d03f59e2 4 Serial mnm(USBTX,USBRX); //for usb communication
sakthipriya 0:7882d03f59e2 5 I2C i2c (PTC9,PTC8); //PTC2-sda,PTC1-scl
sakthipriya 0:7882d03f59e2 6 /*void INIT_PNI(void); //initialization of registers happens
sakthipriya 0:7882d03f59e2 7 float *EXECUTE_PNI(); //data is obtained
sakthipriya 0:7882d03f59e2 8 void T_OUT(); //timeout function to stop infinite loop*/
sakthipriya 0:7882d03f59e2 9 Timeout to; //Timeout variable to
sakthipriya 0:7882d03f59e2 10 int toFlag;
sakthipriya 0:7882d03f59e2 11 void T_OUT()
sakthipriya 0:7882d03f59e2 12 {
sakthipriya 0:7882d03f59e2 13 toFlag=0; //as T_OUT function gets called the while loop gets terminated
sakthipriya 0:7882d03f59e2 14 }
sakthipriya 0:7882d03f59e2 15
sakthipriya 0:7882d03f59e2 16 //DEFINING VARIABLES
sakthipriya 0:7882d03f59e2 17 char cmd[2];
sakthipriya 0:7882d03f59e2 18 char raw_gyro[6];
sakthipriya 0:7882d03f59e2 19 char raw_mag[6];
sakthipriya 0:7882d03f59e2 20 char store,status;
sakthipriya 0:7882d03f59e2 21 int16_t bit_data;
sakthipriya 0:7882d03f59e2 22 float gyro_data[3], mag_data[3],combined_values[6],*data;
sakthipriya 0:7882d03f59e2 23 float senstivity_gyro =6.5536; //senstivity is obtained from 2^15/5000dps
sakthipriya 0:7882d03f59e2 24 float senstivity_mag =32.768; //senstivity is obtained from 2^15/1000microtesla
sakthipriya 0:7882d03f59e2 25 float gyro_error[3]= {0,0,0}, mag_error[3]= {0,0,0};
sakthipriya 0:7882d03f59e2 26
sakthipriya 0:7882d03f59e2 27 Timer r0;
sakthipriya 0:7882d03f59e2 28 Timer r1;
sakthipriya 0:7882d03f59e2 29 Timer r2;
sakthipriya 0:7882d03f59e2 30 Timer r3;
sakthipriya 0:7882d03f59e2 31 Timer r4;
sakthipriya 0:7882d03f59e2 32
sakthipriya 0:7882d03f59e2 33
sakthipriya 0:7882d03f59e2 34 /*
sakthipriya 0:7882d03f59e2 35 int main(void)
sakthipriya 0:7882d03f59e2 36 {
sakthipriya 0:7882d03f59e2 37
sakthipriya 0:7882d03f59e2 38 INIT_PNI();
sakthipriya 0:7882d03f59e2 39 data=EXECUTE_PNI(); //the angular velocity is stored in the first 3 values and magnetic field values in next 3
sakthipriya 0:7882d03f59e2 40 mnm.printf("gyro values\n"); //printing the angular velocity and magnetic field values
sakthipriya 0:7882d03f59e2 41 for(int i=0; i<3; i++) {
sakthipriya 0:7882d03f59e2 42 mnm.printf("%f\t",data[i]);
sakthipriya 0:7882d03f59e2 43 }
sakthipriya 0:7882d03f59e2 44 mnm.printf("mag values\n");
sakthipriya 0:7882d03f59e2 45 for(int i=3; i<6; i++) {
sakthipriya 0:7882d03f59e2 46 mnm.printf("%f\t",data[i]);
sakthipriya 0:7882d03f59e2 47 }
sakthipriya 0:7882d03f59e2 48 }*/
sakthipriya 0:7882d03f59e2 49
sakthipriya 0:7882d03f59e2 50 void INIT_PNI()
sakthipriya 0:7882d03f59e2 51 { r0.start();
sakthipriya 0:7882d03f59e2 52 cmd[0]=RESETREQ;
sakthipriya 0:7882d03f59e2 53 cmd[1]=BIT_RESREQ;
sakthipriya 0:7882d03f59e2 54 i2c.write(SLAVE_ADDR,cmd,2);
sakthipriya 0:7882d03f59e2 55 r0.stop(); //When 0x01 is written in reset request register Emulates a hard power down/power up
sakthipriya 0:7882d03f59e2 56 wait_ms(2000); //waiting for loading configuration file stored in EEPROM
sakthipriya 0:7882d03f59e2 57 cmd[0]=SENTRALSTATUS;
sakthipriya 0:7882d03f59e2 58 r1.start();
sakthipriya 0:7882d03f59e2 59 i2c.write(SLAVE_ADDR,cmd,1);
sakthipriya 0:7882d03f59e2 60 i2c.read(SLAVE_ADDR_READ,&store,1);
sakthipriya 0:7882d03f59e2 61 r1.stop();
sakthipriya 0:7882d03f59e2 62 wait_ms(100);
sakthipriya 0:7882d03f59e2 63 //to check whether EEPROM is uploaded
sakthipriya 0:7882d03f59e2 64
sakthipriya 0:7882d03f59e2 65 /* switch((int)store) {
sakthipriya 0:7882d03f59e2 66 case(3): {
sakthipriya 0:7882d03f59e2 67 printf("\nstore :%d\n",store);
sakthipriya 0:7882d03f59e2 68 break;
sakthipriya 0:7882d03f59e2 69 }
sakthipriya 0:7882d03f59e2 70 case(11): {
sakthipriya 0:7882d03f59e2 71 printf("\nstore11 :%d\n",store);
sakthipriya 0:7882d03f59e2 72 break;
sakthipriya 0:7882d03f59e2 73 }
sakthipriya 0:7882d03f59e2 74 default: {
sakthipriya 0:7882d03f59e2 75 cmd[0]=RESETREQ;
sakthipriya 0:7882d03f59e2 76 cmd[1]=BIT_RESREQ;
sakthipriya 0:7882d03f59e2 77 i2c.write(SLAVE_ADDR,cmd,2);
sakthipriya 0:7882d03f59e2 78 wait_ms(2000);
sakthipriya 0:7882d03f59e2 79 }
sakthipriya 0:7882d03f59e2 80 }*/
sakthipriya 0:7882d03f59e2 81 //mnm.printf("Sentral Status is %x\n",(int)store);
sakthipriya 0:7882d03f59e2 82 r2.start();
sakthipriya 0:7882d03f59e2 83 cmd[0]=HOST_CTRL; //0x01 is written in HOST CONTROL register to enable the sensors
sakthipriya 0:7882d03f59e2 84 cmd[1]=BIT_RUN_ENB;
sakthipriya 0:7882d03f59e2 85 i2c.write(SLAVE_ADDR,cmd,2);
sakthipriya 0:7882d03f59e2 86 r2.stop();
sakthipriya 0:7882d03f59e2 87 wait_ms(100);
sakthipriya 0:7882d03f59e2 88 r3.start();
sakthipriya 0:7882d03f59e2 89 cmd[0]=MAGRATE; //Output data rate of 100Hz is used for magnetometer
sakthipriya 0:7882d03f59e2 90 cmd[1]=BIT_MAGODR;
sakthipriya 0:7882d03f59e2 91 i2c.write(SLAVE_ADDR,cmd,2);
sakthipriya 0:7882d03f59e2 92 r3.stop();
sakthipriya 0:7882d03f59e2 93 wait_ms(100);
sakthipriya 0:7882d03f59e2 94 r4.start();
sakthipriya 0:7882d03f59e2 95 cmd[0]=GYRORATE; //Output data rate of 150Hz is used for gyroscope
sakthipriya 0:7882d03f59e2 96 cmd[1]=BIT_GYROODR;
sakthipriya 0:7882d03f59e2 97 i2c.write(SLAVE_ADDR,cmd,2);
sakthipriya 0:7882d03f59e2 98 r4.stop();
sakthipriya 0:7882d03f59e2 99 wait_ms(100);
sakthipriya 0:7882d03f59e2 100 cmd[0]=ALGO_CTRL; //When 0x00 is written to ALGO CONTROL register we get scaled sensor values
sakthipriya 0:7882d03f59e2 101 cmd[1]=0x00;
sakthipriya 0:7882d03f59e2 102 i2c.write(SLAVE_ADDR,cmd,2);
sakthipriya 0:7882d03f59e2 103 wait_ms(100);
sakthipriya 0:7882d03f59e2 104 cmd[0]=ENB_EVT; //enabling the error,gyro values and magnetometer values
sakthipriya 0:7882d03f59e2 105 cmd[1]=BIT_EVT_ENB;
sakthipriya 0:7882d03f59e2 106 i2c.write(SLAVE_ADDR,cmd,2);
sakthipriya 0:7882d03f59e2 107 wait_ms(100);
sakthipriya 0:7882d03f59e2 108 printf("\n \r %d %d %d %d %d",r0.read_us(),r1.read_us(),r2.read_us(),r3.read_us(),r4.read_us());
sakthipriya 0:7882d03f59e2 109 }
sakthipriya 0:7882d03f59e2 110
sakthipriya 0:7882d03f59e2 111 float *EXECUTE_PNI()
sakthipriya 0:7882d03f59e2 112 {
sakthipriya 0:7882d03f59e2 113 //printf("\n\r mnm func \n");
sakthipriya 0:7882d03f59e2 114 toFlag=1; //toFlag is set to 1 so that it enters while loop
sakthipriya 0:7882d03f59e2 115 to.attach(&T_OUT,2); //after 2 seconds the while loop gets terminated
sakthipriya 0:7882d03f59e2 116 while(toFlag) {
sakthipriya 0:7882d03f59e2 117 cmd[0]=EVT_STATUS;
sakthipriya 0:7882d03f59e2 118 i2c.write(SLAVE_ADDR,cmd,1);
sakthipriya 0:7882d03f59e2 119 i2c.read(SLAVE_ADDR_READ,&status,1);
sakthipriya 0:7882d03f59e2 120 wait_ms(100);
sakthipriya 0:7882d03f59e2 121 //mnm.printf("\nEvent Status is %x\n",(int)status);
sakthipriya 0:7882d03f59e2 122 //if the 6th and 4th bit are 1 then it implies that gyro and magnetometer values are ready to take
sakthipriya 0:7882d03f59e2 123 if(((int)status&40)==40) {
sakthipriya 0:7882d03f59e2 124 printf("\nin if of mnm\n");
sakthipriya 0:7882d03f59e2 125 cmd[0]=GYRO_XOUT_H; //0x22 gyro LSB of x
sakthipriya 0:7882d03f59e2 126 i2c.write(SLAVE_ADDR,cmd,1);
sakthipriya 0:7882d03f59e2 127 i2c.read(SLAVE_ADDR_READ,raw_gyro,6);
sakthipriya 0:7882d03f59e2 128 cmd[0]=MAG_XOUT_H; //LSB of x
sakthipriya 0:7882d03f59e2 129 i2c.write(SLAVE_ADDR,cmd,1);
sakthipriya 0:7882d03f59e2 130 i2c.read(SLAVE_ADDR_READ,raw_mag,6);
sakthipriya 0:7882d03f59e2 131 //mnm.printf("\nGyro Values:\n");
sakthipriya 0:7882d03f59e2 132 for(int i=0; i<3; i++) {
sakthipriya 0:7882d03f59e2 133 //concatenating gyro LSB and MSB to get 16 bit signed data values
sakthipriya 0:7882d03f59e2 134 bit_data= ((int16_t)raw_gyro[2*i+1]<<8)|(int16_t)raw_gyro[2*i];
sakthipriya 0:7882d03f59e2 135 gyro_data[i]=(float)bit_data;
sakthipriya 0:7882d03f59e2 136 gyro_data[i]=gyro_data[i]/senstivity_gyro;
sakthipriya 0:7882d03f59e2 137 gyro_data[i]+=gyro_error[i];
sakthipriya 0:7882d03f59e2 138 //mnm.printf("%f\t",gyro_data[i]);
sakthipriya 0:7882d03f59e2 139 }
sakthipriya 0:7882d03f59e2 140 //mnm.printf("\nMag Values:\n");
sakthipriya 0:7882d03f59e2 141 for(int i=0; i<3; i++) {
sakthipriya 0:7882d03f59e2 142 //concatenating mag LSB and MSB to get 16 bit signed data values
sakthipriya 0:7882d03f59e2 143 bit_data= ((int16_t)raw_mag[2*i+1]<<8)|(int16_t)raw_mag[2*i];
sakthipriya 0:7882d03f59e2 144 mag_data[i]=(float)bit_data;
sakthipriya 0:7882d03f59e2 145 mag_data[i]=mag_data[i]/senstivity_mag;
sakthipriya 0:7882d03f59e2 146 mag_data[i]+=mag_error[i];
sakthipriya 0:7882d03f59e2 147 //mnm.printf("%f\t",mag_data[i]);
sakthipriya 0:7882d03f59e2 148 }
sakthipriya 0:7882d03f59e2 149 for(int i=0; i<3; i++) {
sakthipriya 0:7882d03f59e2 150 combined_values[i]=gyro_data[i];
sakthipriya 0:7882d03f59e2 151 combined_values[i+3]=mag_data[i];
sakthipriya 0:7882d03f59e2 152 }
sakthipriya 0:7882d03f59e2 153 return(combined_values); //returning poiter combined values
sakthipriya 0:7882d03f59e2 154 }
sakthipriya 0:7882d03f59e2 155 //checking for the error
sakthipriya 0:7882d03f59e2 156
sakthipriya 0:7882d03f59e2 157 else if (((int)status&2)==2) {
sakthipriya 0:7882d03f59e2 158 INIT_PNI(); //when there is any error then Again inilization is done to remove error
sakthipriya 0:7882d03f59e2 159 }
sakthipriya 0:7882d03f59e2 160
sakthipriya 0:7882d03f59e2 161
sakthipriya 0:7882d03f59e2 162 }
sakthipriya 0:7882d03f59e2 163 }