角度調整用のプログラムです。 (モータードライバー+磁気センサー)
Dependencies: ATP3012 mbed a HMC US015_2 getGPS
Diff: Function.h
- Revision:
- 1:f70beec382b6
- Parent:
- 0:99f4fe3e21c6
- Child:
- 2:83023bafb526
--- a/Function.h Wed Dec 01 08:14:01 2021 +0000 +++ b/Function.h Fri Dec 03 08:22:57 2021 +0000 @@ -116,7 +116,6 @@ delta = angle - theta; } printf("delta=%f-%f=%f\r\n", angle, theta, delta); - wait(2); return delta; } @@ -124,13 +123,14 @@ { xbee.printf("calibration start\r\n"); compass.setCalibrationMode(0x43); - Move('4', 0.1); + Move('4', 0.15); xbee.printf("mortor mode:4 speed:0.1\n\r"); - wait(6); + wait(180); Move('1', 0); xbee.printf("mortor mode:1 speed:0\n\r"); compass.setCalibrationMode(0x45); xbee.printf("calibration end\r\n"); +/* while(1) { if(gps.getgps()) { //現在地取得 GPS_x = gps.latitude; @@ -142,7 +142,7 @@ break; } } - +*/ return; }