ryo seki / Mbed 2 deprecated ver1_2_0

robocup

Dependencies:   HMC6352 PID mbed

wordString.cpp@0:13ab960fc61f, 2013-03-08 (annotated)

Committer:
akudohune
Date:
Fri Mar 08 07:13:29 2013 +0000
Revision:
0:13ab960fc61f
ver1_2_0;

Who changed what in which revision?

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