CanSat-C 2021 / Mbed 2 deprecated AvoidTest

回避行動用のプログラムです。

Dependencies:   ATP3012 mbed a HMC US015_2 getGPS

main.cpp

Committer:
ushiroji
Date:
2021-12-03
Revision:
1:f70beec382b6
Parent:
0:99f4fe3e21c6

File content as of revision 1:f70beec382b6:

#include "mbed.h"
// 自作関数
#include "Function.h"

int main() {
    double angle = 0;
    
    Calibration();

    compass.setOpMode(HMC6352_CONTINUOUS, 1, 20);
    angle = compass.sample() / 10;
    xbee.printf("%f\r\n", angle);

        //角度調節
         while(1) {
            if(angle < 20 || angle > 340) {  //角度判定
                xbee.printf("direction finish\n\r");
                Move('1', 0);   //停止
                wait(5);
                compass.setOpMode(HMC6352_CONTINUOUS, 1, 20);
                angle = compass.sample() / 10;
                xbee.printf("%f\r\n", angle);
                            }
            else {
                Move('4', 0.15);//時計回りに回転
                compass.setOpMode(HMC6352_CONTINUOUS, 1, 20);
                angle = compass.sample() / 10;
                xbee.printf("%f\r\n", angle);
            }
        }
}