2

Dependencies:   AQM0802A HMC6352 PID Servo mbed

Committer:
ryuna
Date:
Wed Mar 04 07:01:19 2015 +0000
Revision:
5:dace4f3b6e4a
Parent:
0:dfe81bdcb486
add one function _fool

Who changed what in which revision?

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