Ramón Chávez
/
Pruebas_Flex_IMU_copy
Código de pruebas para sensor Flex + IMU
main.cpp@0:dfc579990bfa, 2019-05-13 (annotated)
- Committer:
- ramchagar
- Date:
- Mon May 13 20:28:49 2019 +0000
- Revision:
- 0:dfc579990bfa
Codigo de prueba IMU
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
ramchagar | 0:dfc579990bfa | 1 | #include "mbed.h" |
ramchagar | 0:dfc579990bfa | 2 | #include "BMX055.h" |
ramchagar | 0:dfc579990bfa | 3 | |
ramchagar | 0:dfc579990bfa | 4 | Serial pc(USBTX,USBRX); |
ramchagar | 0:dfc579990bfa | 5 | I2C i2c(I2C_SDA, I2C_SCL); |
ramchagar | 0:dfc579990bfa | 6 | BMX055 imu(i2c); |
ramchagar | 0:dfc579990bfa | 7 | AnalogIn ain(A0); |
ramchagar | 0:dfc579990bfa | 8 | DigitalOut myled(LED2); |
ramchagar | 0:dfc579990bfa | 9 | |
ramchagar | 0:dfc579990bfa | 10 | const BMX055_TypeDef bmx055_my_parameters = { |
ramchagar | 0:dfc579990bfa | 11 | // ACC |
ramchagar | 0:dfc579990bfa | 12 | ACC_2G, |
ramchagar | 0:dfc579990bfa | 13 | ACC_BW250Hz, |
ramchagar | 0:dfc579990bfa | 14 | // GYR |
ramchagar | 0:dfc579990bfa | 15 | GYR_125DPS, |
ramchagar | 0:dfc579990bfa | 16 | GYR_200Hz23Hz, |
ramchagar | 0:dfc579990bfa | 17 | // MAG |
ramchagar | 0:dfc579990bfa | 18 | MAG_ODR10Hz |
ramchagar | 0:dfc579990bfa | 19 | }; |
ramchagar | 0:dfc579990bfa | 20 | |
ramchagar | 0:dfc579990bfa | 21 | int main() { |
ramchagar | 0:dfc579990bfa | 22 | BMX055_ACCEL_TypeDef acc; |
ramchagar | 0:dfc579990bfa | 23 | BMX055_GYRO_TypeDef gyr; |
ramchagar | 0:dfc579990bfa | 24 | BMX055_MAGNET_TypeDef mag; |
ramchagar | 0:dfc579990bfa | 25 | |
ramchagar | 0:dfc579990bfa | 26 | //while (imu.chip_ready() == 0){ |
ramchagar | 0:dfc579990bfa | 27 | // pc.printf("Bosch BMX055 is NOT avirable!!\r\n"); |
ramchagar | 0:dfc579990bfa | 28 | // wait(1); |
ramchagar | 0:dfc579990bfa | 29 | // } |
ramchagar | 0:dfc579990bfa | 30 | |
ramchagar | 0:dfc579990bfa | 31 | imu.set_parameter(&bmx055_my_parameters); |
ramchagar | 0:dfc579990bfa | 32 | while(1) { |
ramchagar | 0:dfc579990bfa | 33 | imu.get_accel(&acc); |
ramchagar | 0:dfc579990bfa | 34 | pc.printf("ACC: x=%+3.2f y=%+3.2f z=%+3.2f\r\n", acc.x, acc.y, acc.z); |
ramchagar | 0:dfc579990bfa | 35 | imu.get_gyro(&gyr); |
ramchagar | 0:dfc579990bfa | 36 | pc.printf("GYR: x=%+3.2f y=%+3.2f z=%+3.2f\r\n", gyr.x, gyr.y, gyr.z); |
ramchagar | 0:dfc579990bfa | 37 | imu.get_magnet(&mag); |
ramchagar | 0:dfc579990bfa | 38 | pc.printf("MAG: x=%+3.2f y=%+3.2f z=%+3.2f\r\n", mag.x, mag.y, mag.z); |
ramchagar | 0:dfc579990bfa | 39 | wait(0.5f); |
ramchagar | 0:dfc579990bfa | 40 | wait(1); |
ramchagar | 0:dfc579990bfa | 41 | myled = !myled; |
ramchagar | 0:dfc579990bfa | 42 | float f=ain.read(); |
ramchagar | 0:dfc579990bfa | 43 | pc.printf("value f %f \n",f); |
ramchagar | 0:dfc579990bfa | 44 | float voltage =(f*(5.0f)); |
ramchagar | 0:dfc579990bfa | 45 | pc.printf("value voltage %f \n",voltage); |
ramchagar | 0:dfc579990bfa | 46 | } |
ramchagar | 0:dfc579990bfa | 47 | } |