a

Dependencies:   HMC6352 PID mbed

Committer:
akudohune
Date:
Fri Apr 19 09:13:32 2013 +0000
Revision:
0:8215f0743d86
to yusuke

Who changed what in which revision?

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