12/16用テスト
Dependencies: ATP3012 mbed a HMC US015_2 getGPS
Diff: Function.h
- Revision:
- 21:52f8f01a29c5
- Parent:
- 18:bd0b2394fa48
diff -r bd0b2394fa48 -r 52f8f01a29c5 Function.h --- a/Function.h Wed Dec 15 06:17:48 2021 +0000 +++ b/Function.h Thu Dec 16 06:10:06 2021 +0000 @@ -106,6 +106,7 @@ double theta; double delta; + catchGPS(); xbee.printf("gps.latitude=%f, gps.longitude=%f\r\n", gps.latitude, gps.longitude); theta = atan2(next_CP_y - gps.longitude , next_CP_x - gps.latitude) * 180 / 3.14159265359; printf("theta=%f\r\n", theta);