Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
Q2PARTIE2.cpp@0:baf388d9e3b7, 2018-11-18 (annotated)
- Committer:
- louisverzellesi
- Date:
- Sun Nov 18 14:16:29 2018 +0000
- Revision:
- 0:baf388d9e3b7
1
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| louisverzellesi | 0:baf388d9e3b7 | 1 | // LSM9DS91 Demo |
| louisverzellesi | 0:baf388d9e3b7 | 2 | |
| louisverzellesi | 0:baf388d9e3b7 | 3 | #include "mbed.h" |
| louisverzellesi | 0:baf388d9e3b7 | 4 | #include "LSM9DS1.h" |
| louisverzellesi | 0:baf388d9e3b7 | 5 | |
| louisverzellesi | 0:baf388d9e3b7 | 6 | // refresh time. set to 500 for part 2 and 50 for part 4 |
| louisverzellesi | 0:baf388d9e3b7 | 7 | #define REFRESH_TIME_MS 1000 |
| louisverzellesi | 0:baf388d9e3b7 | 8 | |
| louisverzellesi | 0:baf388d9e3b7 | 9 | // Verify that the pin assignments below match your breadboard |
| louisverzellesi | 0:baf388d9e3b7 | 10 | LSM9DS1 imu(p9, p10); |
| louisverzellesi | 0:baf388d9e3b7 | 11 | Serial pc(USBTX, USBRX); |
| louisverzellesi | 0:baf388d9e3b7 | 12 | LocalFileSystem local("local"); |
| louisverzellesi | 0:baf388d9e3b7 | 13 | DigitalOut myled(LED1); |
| louisverzellesi | 0:baf388d9e3b7 | 14 | int i; |
| louisverzellesi | 0:baf388d9e3b7 | 15 | float j; |
| louisverzellesi | 0:baf388d9e3b7 | 16 | float g; |
| louisverzellesi | 0:baf388d9e3b7 | 17 | float sina; |
| louisverzellesi | 0:baf388d9e3b7 | 18 | float angleroulis; |
| louisverzellesi | 0:baf388d9e3b7 | 19 | float angletanguage; |
| louisverzellesi | 0:baf388d9e3b7 | 20 | float sinb; |
| louisverzellesi | 0:baf388d9e3b7 | 21 | //Init Serial port and LSM9DS1 chip |
| louisverzellesi | 0:baf388d9e3b7 | 22 | void setup() |
| louisverzellesi | 0:baf388d9e3b7 | 23 | { |
| louisverzellesi | 0:baf388d9e3b7 | 24 | // Use the begin() function to initialize the LSM9DS0 library. |
| louisverzellesi | 0:baf388d9e3b7 | 25 | // You can either call it with no parameters (the easy way): |
| louisverzellesi | 0:baf388d9e3b7 | 26 | uint16_t status = imu.begin(); |
| louisverzellesi | 0:baf388d9e3b7 | 27 | |
| louisverzellesi | 0:baf388d9e3b7 | 28 | //Make sure communication is working |
| louisverzellesi | 0:baf388d9e3b7 | 29 | pc.printf("LSM9DS1 WHO_AM_I's returned: 0x%X\r\n", status); |
| louisverzellesi | 0:baf388d9e3b7 | 30 | pc.printf("Should be 0x683D\r\n"); |
| louisverzellesi | 0:baf388d9e3b7 | 31 | } |
| louisverzellesi | 0:baf388d9e3b7 | 32 | |
| louisverzellesi | 0:baf388d9e3b7 | 33 | int main() |
| louisverzellesi | 0:baf388d9e3b7 | 34 | { |
| louisverzellesi | 0:baf388d9e3b7 | 35 | |
| louisverzellesi | 0:baf388d9e3b7 | 36 | setup(); //Setup sensor and Serial |
| louisverzellesi | 0:baf388d9e3b7 | 37 | pc.printf("------ LSM9DS1 Demo -----------\r\n"); |
| louisverzellesi | 0:baf388d9e3b7 | 38 | |
| louisverzellesi | 0:baf388d9e3b7 | 39 | while (true) |
| louisverzellesi | 0:baf388d9e3b7 | 40 | { |
| louisverzellesi | 0:baf388d9e3b7 | 41 | for (i=0;i<=99;i=i++){ |
| louisverzellesi | 0:baf388d9e3b7 | 42 | |
| louisverzellesi | 0:baf388d9e3b7 | 43 | imu.readAccel(); |
| louisverzellesi | 0:baf388d9e3b7 | 44 | imu.readGyro(); |
| louisverzellesi | 0:baf388d9e3b7 | 45 | imu.readMag(); |
| louisverzellesi | 0:baf388d9e3b7 | 46 | g = sqrt((imu.ax)*(imu.ax)+(imu.ay)*(imu.ay)+(imu.az)*(imu.az)); |
| louisverzellesi | 0:baf388d9e3b7 | 47 | sina = (-1*imu.ay)/g; |
| louisverzellesi | 0:baf388d9e3b7 | 48 | angleroulis = asin(sina)*(180/3.1416); |
| louisverzellesi | 0:baf388d9e3b7 | 49 | sinb= imu.ax/g; |
| louisverzellesi | 0:baf388d9e3b7 | 50 | angletanguage = asin(sinb)*(180/3.1416); |
| louisverzellesi | 0:baf388d9e3b7 | 51 | pc.printf ("anglea= %f;angleb= %f\n\r",angleroulis,angletanguage); |
| louisverzellesi | 0:baf388d9e3b7 | 52 | myled = 1; |
| louisverzellesi | 0:baf388d9e3b7 | 53 | wait_ms(0.5); |
| louisverzellesi | 0:baf388d9e3b7 | 54 | } |
| louisverzellesi | 0:baf388d9e3b7 | 55 | myled = 0; |
| louisverzellesi | 0:baf388d9e3b7 | 56 | |
| louisverzellesi | 0:baf388d9e3b7 | 57 | } |
| louisverzellesi | 0:baf388d9e3b7 | 58 | } |