HAPSRG / Mbed 2 deprecated read_Pmod

PmodNAV test

Dependencies:   mbed LPS25HB_I2C LSM9DS1 UsaPack

main.cpp@0:c99eaed54c50, 2021-09-27 (annotated)

Committer:
osaka
Date:
Mon Sep 27 09:02:40 2021 +0000
Revision:
0:c99eaed54c50
Child:
1:e5d5afc20fe2
Child:
2:20d44bbe80e4
PmodNAV test

Who changed what in which revision?

UserRevisionLine numberNew contents of line
osaka 0:c99eaed54c50 1 #include "mbed.h"
osaka 0:c99eaed54c50 2 #include "LSM9DS1.h"
osaka 0:c99eaed54c50 3 #include "LPS.h"
osaka 0:c99eaed54c50 4
osaka 0:c99eaed54c50 5 Serial pc(USBTX, USBRX, 57600);
osaka 0:c99eaed54c50 6 I2C i2c(PF_0, PF_1);
osaka 0:c99eaed54c50 7 LSM9DS1 lsm(i2c);
osaka 0:c99eaed54c50 8 LPS lps(i2c);
osaka 0:c99eaed54c50 9
osaka 0:c99eaed54c50 10 using namespace std;
osaka 0:c99eaed54c50 11
osaka 0:c99eaed54c50 12 int main()
osaka 0:c99eaed54c50 13 {
osaka 0:c99eaed54c50 14 uint16_t reg = lsm.begin();
osaka 0:c99eaed54c50 15 //printf("%x\n", reg);
osaka 0:c99eaed54c50 16 if (!lps.init()){
osaka 0:c99eaed54c50 17 printf("Failed to autodetect pressure sensor!\r\n");
osaka 0:c99eaed54c50 18 while (1);
osaka 0:c99eaed54c50 19 }
osaka 0:c99eaed54c50 20 lps.enableDefault();
osaka 0:c99eaed54c50 21 wait_ms(100);
osaka 0:c99eaed54c50 22 while(true)
osaka 0:c99eaed54c50 23 {
osaka 0:c99eaed54c50 24 lsm.readAccel();
osaka 0:c99eaed54c50 25 lsm.readMag();
osaka 0:c99eaed54c50 26 lsm.readGyro();
osaka 0:c99eaed54c50 27 //printf("%f %f %f %f %f %f %f %f %f\n", lsm.ax, lsm.ay, lsm.az, lsm.gx, lsm.gy, lsm.gz, lsm.mx, lsm.my, lsm.mz);
osaka 0:c99eaed54c50 28 //printf("%f %f %f\n", lsm.gx, lsm.gy, lsm.gz);
osaka 0:c99eaed54c50 29 //printf("%f %f %f\n", lsm.mx, lsm.my, lsm.mz);
osaka 0:c99eaed54c50 30 float pressure = lps.readPressureMillibars();
osaka 0:c99eaed54c50 31 float altitude = lps.pressureToAltitudeMeters(pressure);
osaka 0:c99eaed54c50 32 float temperature = lps.readTemperatureC();
osaka 0:c99eaed54c50 33 //printf("p:%.2f\t mbar\ta:%.2f m\tt:%.2f deg C\r\n",pressure,altitude,temperature);
osaka 0:c99eaed54c50 34 printf("%f %f %f %f %f %f %f %f %f %f\n", lsm.ax, lsm.ay, lsm.az, lsm.gx, lsm.gy, lsm.gz, lsm.mx, lsm.my, lsm.mz, pressure);
osaka 0:c99eaed54c50 35 wait(0.1);
osaka 0:c99eaed54c50 36 }
osaka 0:c99eaed54c50 37 }