Hiroshi Yamaguchi
/
LSM303DLH_Example
LSM303DLH sample program
main.cpp@0:5864a85f25c1, 2011-10-06 (annotated)
- Committer:
- yamaguch
- Date:
- Thu Oct 06 08:39:39 2011 +0000
- Revision:
- 0:5864a85f25c1
0.1
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
yamaguch | 0:5864a85f25c1 | 1 | #include "LSM303DLH.h" |
yamaguch | 0:5864a85f25c1 | 2 | |
yamaguch | 0:5864a85f25c1 | 3 | LSM303DLH lsm(p28, p27, p23, p22); |
yamaguch | 0:5864a85f25c1 | 4 | |
yamaguch | 0:5864a85f25c1 | 5 | void int1Detected() { |
yamaguch | 0:5864a85f25c1 | 6 | printf("INT1 detected\n"); |
yamaguch | 0:5864a85f25c1 | 7 | } |
yamaguch | 0:5864a85f25c1 | 8 | |
yamaguch | 0:5864a85f25c1 | 9 | void int2Detected() { |
yamaguch | 0:5864a85f25c1 | 10 | printf("INT2 detected\n"); |
yamaguch | 0:5864a85f25c1 | 11 | } |
yamaguch | 0:5864a85f25c1 | 12 | /* |
yamaguch | 0:5864a85f25c1 | 13 | * AOI AND 1 0 |
yamaguch | 0:5864a85f25c1 | 14 | * 6D 6D 0 0 |
yamaguch | 0:5864a85f25c1 | 15 | * ZH 0 1 |
yamaguch | 0:5864a85f25c1 | 16 | * ZL 1 0 |
yamaguch | 0:5864a85f25c1 | 17 | * YH 0 1 |
yamaguch | 0:5864a85f25c1 | 18 | * YL 1 0 |
yamaguch | 0:5864a85f25c1 | 19 | * XH 0 1 |
yamaguch | 0:5864a85f25c1 | 20 | * XL 1 0 |
yamaguch | 0:5864a85f25c1 | 21 | */ |
yamaguch | 0:5864a85f25c1 | 22 | int main() { |
yamaguch | 0:5864a85f25c1 | 23 | lsm.attach(INT1, 0x95, 31, 3, int1Detected); |
yamaguch | 0:5864a85f25c1 | 24 | lsm.attach(INT2, 0x2A, 127, 3, int2Detected); |
yamaguch | 0:5864a85f25c1 | 25 | while (true) { |
yamaguch | 0:5864a85f25c1 | 26 | if (lsm.read()) { |
yamaguch | 0:5864a85f25c1 | 27 | printf("acc: (%f, %f, %f), mag: (%f, %f, %f)\n", lsm.ax, lsm.ay, lsm.az, lsm.mx, lsm.my, lsm.mz); |
yamaguch | 0:5864a85f25c1 | 28 | printf("direction = %.0f\n", lsm.getHeading() * 180 / 3.14159265358979); |
yamaguch | 0:5864a85f25c1 | 29 | } |
yamaguch | 0:5864a85f25c1 | 30 | wait(5); |
yamaguch | 0:5864a85f25c1 | 31 | } |
yamaguch | 0:5864a85f25c1 | 32 | } |