Control YOZAKURA arm vir USB
Dependencies: Dynamixel MEMS_Thermal_Sensor SerialHalfDuplex mbed
Diff: main.cpp
- Revision:
- 2:3a4f83edb424
- Parent:
- 1:37af6a93195e
- Child:
- 3:6dbba9951f9e
diff -r 37af6a93195e -r 3a4f83edb424 main.cpp --- a/main.cpp Wed Apr 15 15:02:19 2015 +0000 +++ b/main.cpp Wed Apr 15 15:03:49 2015 +0000 @@ -1,6 +1,6 @@ /*YOZAKURAのアームコード - UDP通信で送るデータ S_Data={linearD[4],pitchD[4],yawD[4],ThermoD1[16],ThermoD2[16],CO2[4]} 計48bytes - UDP通信で受け取るデータ R_Data={mode[2bit],linear_ref[2bit],pitch_ref[2bit],yaw_ref[2bit]} 計1byte + シリアル通信で送るデータ S_Data={linearD[4],pitchD[4],yawD[4],ThermoD1[16],ThermoD2[16],CO2[4]} 計48bytes + シリアル通信で受け取るデータ R_Data={mode[2bit],linear_ref[2bit],pitch_ref[2bit],yaw_ref[2bit]} 計1byte */ #include "mbed.h" @@ -175,7 +175,7 @@ ThD2[8],ThD2[9],ThD2[10],ThD2[11],ThD2[12],ThD2[13],ThD2[14],ThD2[15]); sprintf(S_data, "%f %f %f %f %f %f %s %f",lP,lV,pP,pC,yP,yC,Thermo_data,CO2_data); // sock.sendTo(echo_server, S_data, sizeof(S_data)); - printf("%s\n",S_data) + pc.printf("%s\n",S_data) myled3=0; break;