Kohei Yamamoto
/
F303k8-toy-c-test
for20210702
main.cpp
- Committer:
- asha_ndf
- Date:
- 2021-07-02
- Revision:
- 1:fb2003e84b92
- Parent:
- 0:4bb9fdb82508
File content as of revision 1:fb2003e84b92:
#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); xbee.printf("\nToy-C example\n"); while(1) { //Xbeeの受信 if (xbee.readable()){ value = xbee.getc(); if (value=='a'){//1を受信した時 nowarg = 90; cnowarg = calc(nowarg); servo1.pulsewidth(cnowarg); servo2.pulsewidth(cnowarg); led =1; }else if (value =='b'){ nowarg = 0;//0を受信した時 cnowarg = calc(nowarg); servo1.pulsewidth(cnowarg); servo2.pulsewidth(cnowarg); led =0; } } //Xbeeの送信 xbee.printf("Status%f\r\n",nowarg); wait(1); } }