CatPot 2015-2016 / Mbed 2 deprecated CatPot_Main_T

CatPot for defence on RoboCup in 2015 winter

Dependencies:   AQM0802A HMC6352 MultiSerial PID Servo mbed

wordString.cpp@2:39135c67083d, 2015-03-11 (annotated)

Committer:
lilac0112_1
Date:
Wed Mar 11 01:11:02 2015 +0000
Revision:
2:39135c67083d
Parent:
1:e3248f278663 
aaaaa

Who changed what in which revision?

UserRevisionLine numberNew contents of line
lilac0112_1 2:39135c67083d 1
lilac0112_1 0:d35efbf4d62e 2 #include <sstream>
lilac0112_1 0:d35efbf4d62e 3 #include "mbed.h"
lilac0112_1 2:39135c67083d 4
lilac0112_1 0:d35efbf4d62e 5 string StringFIN;
lilac0112_1 2:39135c67083d 6
lilac0112_1 0:d35efbf4d62e 7 using namespace std;
lilac0112_1 2:39135c67083d 8
lilac0112_1 2:39135c67083d 9
lilac0112_1 0:d35efbf4d62e 10 //extern Serial pc; // tx, rx
lilac0112_1 2:39135c67083d 11
lilac0112_1 0:d35efbf4d62e 12 string IntToString(int number)
lilac0112_1 0:d35efbf4d62e 13 {
lilac0112_1 0:d35efbf4d62e 14 stringstream ss;
lilac0112_1 0:d35efbf4d62e 15 ss << number;
lilac0112_1 0:d35efbf4d62e 16 return ss.str();
lilac0112_1 0:d35efbf4d62e 17 }
lilac0112_1 2:39135c67083d 18
lilac0112_1 0:d35efbf4d62e 19 void array(int power1,int power2,int power3,int power4)
lilac0112_1 0:d35efbf4d62e 20 {
lilac0112_1 0:d35efbf4d62e 21 int input[4] = {power1,power2,power3,power4};
lilac0112_1 0:d35efbf4d62e 22 int value = 0;
lilac0112_1 0:d35efbf4d62e 23 string StringA[4] = {"0","0","0","0"};
lilac0112_1 0:d35efbf4d62e 24
lilac0112_1 0:d35efbf4d62e 25
lilac0112_1 0:d35efbf4d62e 26 string StringX = "0";
lilac0112_1 0:d35efbf4d62e 27 string StringY = "0";
lilac0112_1 0:d35efbf4d62e 28 string StringZ = "0";
lilac0112_1 0:d35efbf4d62e 29 string String0 = "0";
lilac0112_1 0:d35efbf4d62e 30
lilac0112_1 0:d35efbf4d62e 31 StringFIN = "0";
lilac0112_1 0:d35efbf4d62e 32
lilac0112_1 0:d35efbf4d62e 33 for(uint8_t i = 0 ; i < 4; i++){
lilac0112_1 0:d35efbf4d62e 34
lilac0112_1 0:d35efbf4d62e 35 value = input[i];
lilac0112_1 0:d35efbf4d62e 36
lilac0112_1 0:d35efbf4d62e 37 StringX = IntToString(i+1);
lilac0112_1 0:d35efbf4d62e 38
lilac0112_1 0:d35efbf4d62e 39 if( (value < 0) && (value >= -100) ){
lilac0112_1 0:d35efbf4d62e 40 StringY = "R";
lilac0112_1 0:d35efbf4d62e 41 value = abs(value);
lilac0112_1 0:d35efbf4d62e 42 StringZ = IntToString(value);
lilac0112_1 0:d35efbf4d62e 43 }else if( (value >= 0) && (value <= 100) ){
lilac0112_1 0:d35efbf4d62e 44 StringY = "F";
lilac0112_1 0:d35efbf4d62e 45 StringZ = IntToString(value);
lilac0112_1 0:d35efbf4d62e 46 }else{
lilac0112_1 0:d35efbf4d62e 47 value = abs(value);
lilac0112_1 0:d35efbf4d62e 48 StringY = "F";
lilac0112_1 0:d35efbf4d62e 49 StringZ = "000";
lilac0112_1 0:d35efbf4d62e 50 }
lilac0112_1 0:d35efbf4d62e 51
lilac0112_1 0:d35efbf4d62e 52 if(value < 10){
lilac0112_1 0:d35efbf4d62e 53 String0 = "00";
lilac0112_1 0:d35efbf4d62e 54 StringZ = String0 + StringZ;
lilac0112_1 0:d35efbf4d62e 55 }else if(value < 100)
lilac0112_1 0:d35efbf4d62e 56 {
lilac0112_1 0:d35efbf4d62e 57 String0 = "0";
lilac0112_1 0:d35efbf4d62e 58 StringZ = String0 + StringZ;
lilac0112_1 0:d35efbf4d62e 59 }else{
lilac0112_1 0:d35efbf4d62e 60
lilac0112_1 0:d35efbf4d62e 61 }
lilac0112_1 0:d35efbf4d62e 62
lilac0112_1 0:d35efbf4d62e 63 StringA[i] = (StringX + StringY + StringZ);
lilac0112_1 0:d35efbf4d62e 64
lilac0112_1 0:d35efbf4d62e 65 if(i == 0)StringFIN = StringA[i];
lilac0112_1 0:d35efbf4d62e 66 else StringFIN += StringA[i];
lilac0112_1 0:d35efbf4d62e 67
lilac0112_1 0:d35efbf4d62e 68 }
lilac0112_1 0:d35efbf4d62e 69
lilac0112_1 0:d35efbf4d62e 70 StringFIN += "\r\n";
lilac0112_1 2:39135c67083d 71 }