for20210702

Dependencies:   mbed

main.cpp

Committer:
asha_ndf
Date:
2021-07-01
Revision:
0:4bb9fdb82508
Child:
1:fb2003e84b92

File content as of revision 0:4bb9fdb82508:

#include "mbed.h"
Serial xbee(D1,D0);//TX,RXの順。要確認。
PwmOut servo1(D11);
PwmOut servo2(D12);
DigitalOut led(LED3);//何かに使いたいね
int value;

float calc(float x){
    return (1.45+(2.4-0.5)/180*x)/1000;
}
float nowarg = -1;
float cnowarg = -1;

int main()
{
    led = 1;
    wait(0.25);
    led = 0;
    wait(0.25);
    led = 1;
    wait(0.25);
    led = 0;
    wait(0.25);
    printf("\nToy-C example\n");
    while(1) {
        //Xbeeの受信
        if (xbee.readable()){
            value = xbee.getc();
            if (value==1){//1を受信した時
                nowarg = 90;
                cnowarg = calc(nowarg);
                servo1.pulsewidth(cnowarg);
                servo2.pulsewidth(cnowarg);
                led =1;
            }else if (value ==0){
                nowarg = 0;//0を受信した時
                cnowarg = calc(nowarg);
                servo1.pulsewidth(cnowarg);
                servo2.pulsewidth(cnowarg);
                led =0;
            }
        }
        //Xbeeの送信
        xbee.printf("Status%f\r\n",nowarg);
    }
}