robocup
Dependencies: HMC6352 PID mbed
wordString.cpp
- Committer:
- akudohune
- Date:
- 2013-03-08
- Revision:
- 0:13ab960fc61f
File content as of revision 0:13ab960fc61f:
#include <sstream> #include "mbed.h" string StringFIN; using namespace std; extern Serial pc; // tx, rx string IntToString(int number) { stringstream ss; ss << number; return ss.str(); } void array(int power1,int power2,int power3,int power4) { int input[4] = {power1,power2,power3,power4}; int value = 0; string StringA[4] = {"0","0","0","0"}; string StringX = "0"; string StringY = "0"; string StringZ = "0"; string String0 = "0"; StringFIN = "0"; for(uint8_t i = 0 ; i < 4; i++){ value = input[i]; StringX = IntToString(i+1); if( (value < 0) && (value >= -100) ){ StringY = "R"; value = abs(value); StringZ = IntToString(value); }else if( (value >= 0) && (value <= 100) ){ StringY = "F"; StringZ = IntToString(value); }else{ StringA[i] = StringX + "F" + "000"; } if(value < 10){ String0 = "00"; StringZ = String0 + StringZ; }else if(value < 100) { String0 = "0"; StringZ = String0 + StringZ; }else{ } StringA[i] = (StringX + StringY + StringZ); if(i == 0)StringFIN = StringA[i]; else StringFIN += StringA[i]; } StringFIN += "\r\n"; }