yusuke takahashi / Mbed 2 deprecated gggggg

gggggg

main.cpp@0:521d2ffbfecf, 2013-03-04 (annotated)

Committer:
yusuke_robocup
Date:
Mon Mar 04 09:10:48 2013 +0000
Revision:
0:521d2ffbfecf
ggggg

Who changed what in which revision?

UserRevisionLine numberNew contents of line
yusuke_robocup 0:521d2ffbfecf 1 #include "mbed.h"
yusuke_robocup 0:521d2ffbfecf 2
yusuke_robocup 0:521d2ffbfecf 3 DigitalOut myled(LED1);
yusuke_robocup 0:521d2ffbfecf 4
yusuke_robocup 0:521d2ffbfecf 5 int main() {
yusuke_robocup 0:521d2ffbfecf 6 while(1) {
yusuke_robocup 0:521d2ffbfecf 7 myled = 1;
yusuke_robocup 0:521d2ffbfecf 8 wait(0.2);
yusuke_robocup 0:521d2ffbfecf 9 myled = 0;
yusuke_robocup 0:521d2ffbfecf 10 wait(0.2);
yusuke_robocup 0:521d2ffbfecf 11 }
yusuke_robocup 0:521d2ffbfecf 12 }
yusuke_robocup 0:521d2ffbfecf 13
yusuke_robocup 0:521d2ffbfecf 14 #include <Wire.h>
yusuke_robocup 0:521d2ffbfecf 15 #include <SoftwareSerial.h>
yusuke_robocup 0:521d2ffbfecf 16
yusuke_robocup 0:521d2ffbfecf 17 SoftwareSerial hexmot(4,5); //rx:4 tx:5
yusuke_robocup 0:521d2ffbfecf 18
yusuke_robocup 0:521d2ffbfecf 19 void setup()
yusuke_robocup 0:521d2ffbfecf 20 {
yusuke_robocup 0:521d2ffbfecf 21 Serial.begin(9600);
yusuke_robocup 0:521d2ffbfecf 22 hexmot.begin(19200);
yusuke_robocup 0:521d2ffbfecf 23 }
yusuke_robocup 0:521d2ffbfecf 24
yusuke_robocup 0:521d2ffbfecf 25 void loop()
yusuke_robocup 0:521d2ffbfecf 26 {
yusuke_robocup 0:521d2ffbfecf 27 serialhexmot(100,-100,0,50,-50,1);
yusuke_robocup 0:521d2ffbfecf 28 delay(500);
yusuke_robocup 0:521d2ffbfecf 29 }
yusuke_robocup 0:521d2ffbfecf 30
yusuke_robocup 0:521d2ffbfecf 31 void serialhexmot(int a,int b,int c,int d,int e,int f)
yusuke_robocup 0:521d2ffbfecf 32 {
yusuke_robocup 0:521d2ffbfecf 33 int z = 0;
yusuke_robocup 0:521d2ffbfecf 34 int input[6] = {a,b,c,d,e,f};
yusuke_robocup 0:521d2ffbfecf 35 int output[6] = {0,0,0,0,0,0};
yusuke_robocup 0:521d2ffbfecf 36 int val = 0;
yusuke_robocup 0:521d2ffbfecf 37 String StringA = 0;
yusuke_robocup 0:521d2ffbfecf 38 String StringB = 0;
yusuke_robocup 0:521d2ffbfecf 39 String StringC = 0;
yusuke_robocup 0:521d2ffbfecf 40 String StringD = 0;
yusuke_robocup 0:521d2ffbfecf 41 String StringE = 0;
yusuke_robocup 0:521d2ffbfecf 42 String StringF = 0;
yusuke_robocup 0:521d2ffbfecf 43 String StringX = 0;
yusuke_robocup 0:521d2ffbfecf 44 String StringY = 0;
yusuke_robocup 0:521d2ffbfecf 45 String StringZ = 0;
yusuke_robocup 0:521d2ffbfecf 46 String String0 = 0;
yusuke_robocup 0:521d2ffbfecf 47
yusuke_robocup 0:521d2ffbfecf 48 StringX = String(1);
yusuke_robocup 0:521d2ffbfecf 49 val = input[0];//*100/255;
yusuke_robocup 0:521d2ffbfecf 50 if(val < 0 && val >= -100)
yusuke_robocup 0:521d2ffbfecf 51 {
yusuke_robocup 0:521d2ffbfecf 52 StringY = String('R');
yusuke_robocup 0:521d2ffbfecf 53 val = abs(val);
yusuke_robocup 0:521d2ffbfecf 54 StringZ = String(val);
yusuke_robocup 0:521d2ffbfecf 55 }
yusuke_robocup 0:521d2ffbfecf 56 else if(val >= 0 && val <= 100)
yusuke_robocup 0:521d2ffbfecf 57 {
yusuke_robocup 0:521d2ffbfecf 58 StringY = String('F');
yusuke_robocup 0:521d2ffbfecf 59 StringZ = String(val);
yusuke_robocup 0:521d2ffbfecf 60 }
yusuke_robocup 0:521d2ffbfecf 61 else
yusuke_robocup 0:521d2ffbfecf 62 {
yusuke_robocup 0:521d2ffbfecf 63 StringY = String('F');
yusuke_robocup 0:521d2ffbfecf 64 StringZ = String(0);
yusuke_robocup 0:521d2ffbfecf 65 }
yusuke_robocup 0:521d2ffbfecf 66 if(val < 10)
yusuke_robocup 0:521d2ffbfecf 67 {
yusuke_robocup 0:521d2ffbfecf 68 String0 = String("00");
yusuke_robocup 0:521d2ffbfecf 69 StringZ = String0 + StringZ;
yusuke_robocup 0:521d2ffbfecf 70 }
yusuke_robocup 0:521d2ffbfecf 71 else if(val < 100)
yusuke_robocup 0:521d2ffbfecf 72 {
yusuke_robocup 0:521d2ffbfecf 73 String0 = String('0');
yusuke_robocup 0:521d2ffbfecf 74 StringZ = String0 + StringZ;
yusuke_robocup 0:521d2ffbfecf 75 }
yusuke_robocup 0:521d2ffbfecf 76 else
yusuke_robocup 0:521d2ffbfecf 77 {
yusuke_robocup 0:521d2ffbfecf 78 String0 = String("");
yusuke_robocup 0:521d2ffbfecf 79 }
yusuke_robocup 0:521d2ffbfecf 80 StringA = StringX + StringY + StringZ;
yusuke_robocup 0:521d2ffbfecf 81
yusuke_robocup 0:521d2ffbfecf 82
yusuke_robocup 0:521d2ffbfecf 83 StringX = String(2);
yusuke_robocup 0:521d2ffbfecf 84 val = input[1];//*100/255;
yusuke_robocup 0:521d2ffbfecf 85 if(val < 0 && val >= -100)
yusuke_robocup 0:521d2ffbfecf 86 {
yusuke_robocup 0:521d2ffbfecf 87 StringY = String('R');
yusuke_robocup 0:521d2ffbfecf 88 val = abs(val);
yusuke_robocup 0:521d2ffbfecf 89 StringZ = String(val);
yusuke_robocup 0:521d2ffbfecf 90 }
yusuke_robocup 0:521d2ffbfecf 91 else if(val >= 0 && val <= 100)
yusuke_robocup 0:521d2ffbfecf 92 {
yusuke_robocup 0:521d2ffbfecf 93 StringY = String('F');
yusuke_robocup 0:521d2ffbfecf 94 StringZ = String(val);
yusuke_robocup 0:521d2ffbfecf 95 }
yusuke_robocup 0:521d2ffbfecf 96 else
yusuke_robocup 0:521d2ffbfecf 97 {
yusuke_robocup 0:521d2ffbfecf 98 StringY = String('F');
yusuke_robocup 0:521d2ffbfecf 99 StringZ = String(0);
yusuke_robocup 0:521d2ffbfecf 100 }
yusuke_robocup 0:521d2ffbfecf 101 if(val < 10)
yusuke_robocup 0:521d2ffbfecf 102 {
yusuke_robocup 0:521d2ffbfecf 103 String0 = String("00");
yusuke_robocup 0:521d2ffbfecf 104 StringZ = String0 + StringZ;
yusuke_robocup 0:521d2ffbfecf 105 }
yusuke_robocup 0:521d2ffbfecf 106 else if(val < 100)
yusuke_robocup 0:521d2ffbfecf 107 {
yusuke_robocup 0:521d2ffbfecf 108 String0 = String('0');
yusuke_robocup 0:521d2ffbfecf 109 StringZ = String0 + StringZ;
yusuke_robocup 0:521d2ffbfecf 110 }
yusuke_robocup 0:521d2ffbfecf 111 else
yusuke_robocup 0:521d2ffbfecf 112 {
yusuke_robocup 0:521d2ffbfecf 113 }
yusuke_robocup 0:521d2ffbfecf 114 StringB = StringX + StringY + StringZ;
yusuke_robocup 0:521d2ffbfecf 115
yusuke_robocup 0:521d2ffbfecf 116
yusuke_robocup 0:521d2ffbfecf 117 StringX = String(3);
yusuke_robocup 0:521d2ffbfecf 118 val = input[2];//*100/255;
yusuke_robocup 0:521d2ffbfecf 119 if(val < 0 && val >= -100)
yusuke_robocup 0:521d2ffbfecf 120 {
yusuke_robocup 0:521d2ffbfecf 121 StringY = String('R');
yusuke_robocup 0:521d2ffbfecf 122 val = abs(val);
yusuke_robocup 0:521d2ffbfecf 123 StringZ = String(val);
yusuke_robocup 0:521d2ffbfecf 124 }
yusuke_robocup 0:521d2ffbfecf 125 else if(val >= 0 && val <= 100)
yusuke_robocup 0:521d2ffbfecf 126 {
yusuke_robocup 0:521d2ffbfecf 127 StringY = String('F');
yusuke_robocup 0:521d2ffbfecf 128 StringZ = String(val);
yusuke_robocup 0:521d2ffbfecf 129 }
yusuke_robocup 0:521d2ffbfecf 130 else
yusuke_robocup 0:521d2ffbfecf 131 {
yusuke_robocup 0:521d2ffbfecf 132 StringY = String('F');
yusuke_robocup 0:521d2ffbfecf 133 StringZ = String(0);
yusuke_robocup 0:521d2ffbfecf 134 }
yusuke_robocup 0:521d2ffbfecf 135 if(val < 10)
yusuke_robocup 0:521d2ffbfecf 136 {
yusuke_robocup 0:521d2ffbfecf 137 String0 = String("00");
yusuke_robocup 0:521d2ffbfecf 138 StringZ = String0 + StringZ;
yusuke_robocup 0:521d2ffbfecf 139 }
yusuke_robocup 0:521d2ffbfecf 140 else if(val < 100)
yusuke_robocup 0:521d2ffbfecf 141 {
yusuke_robocup 0:521d2ffbfecf 142 String0 = String('0');
yusuke_robocup 0:521d2ffbfecf 143 StringZ = String0 + StringZ;
yusuke_robocup 0:521d2ffbfecf 144 }
yusuke_robocup 0:521d2ffbfecf 145 else
yusuke_robocup 0:521d2ffbfecf 146 {
yusuke_robocup 0:521d2ffbfecf 147 }
yusuke_robocup 0:521d2ffbfecf 148 StringC = StringX + StringY + StringZ;
yusuke_robocup 0:521d2ffbfecf 149
yusuke_robocup 0:521d2ffbfecf 150
yusuke_robocup 0:521d2ffbfecf 151 StringX = String(4);
yusuke_robocup 0:521d2ffbfecf 152 val = input[3];//*100/255;
yusuke_robocup 0:521d2ffbfecf 153 if(val < 0 && val >= -100)
yusuke_robocup 0:521d2ffbfecf 154 {
yusuke_robocup 0:521d2ffbfecf 155 StringY = String('R');
yusuke_robocup 0:521d2ffbfecf 156 val = abs(val);
yusuke_robocup 0:521d2ffbfecf 157 StringZ = String(val);
yusuke_robocup 0:521d2ffbfecf 158 }
yusuke_robocup 0:521d2ffbfecf 159 else if(val >= 0 && val <= 100)
yusuke_robocup 0:521d2ffbfecf 160 {
yusuke_robocup 0:521d2ffbfecf 161 StringY = String('F');
yusuke_robocup 0:521d2ffbfecf 162 StringZ = String(val);
yusuke_robocup 0:521d2ffbfecf 163 }
yusuke_robocup 0:521d2ffbfecf 164 else
yusuke_robocup 0:521d2ffbfecf 165 {
yusuke_robocup 0:521d2ffbfecf 166 StringY = String('F');
yusuke_robocup 0:521d2ffbfecf 167 StringZ = String(0);
yusuke_robocup 0:521d2ffbfecf 168 }
yusuke_robocup 0:521d2ffbfecf 169 if(val < 10)
yusuke_robocup 0:521d2ffbfecf 170 {
yusuke_robocup 0:521d2ffbfecf 171 String0 = String("00");
yusuke_robocup 0:521d2ffbfecf 172 StringZ = String0 + StringZ;
yusuke_robocup 0:521d2ffbfecf 173 }
yusuke_robocup 0:521d2ffbfecf 174 else if(val < 100)
yusuke_robocup 0:521d2ffbfecf 175 {
yusuke_robocup 0:521d2ffbfecf 176 String0 = String('0');
yusuke_robocup 0:521d2ffbfecf 177 StringZ = String0 + StringZ;
yusuke_robocup 0:521d2ffbfecf 178 }
yusuke_robocup 0:521d2ffbfecf 179 else
yusuke_robocup 0:521d2ffbfecf 180 {
yusuke_robocup 0:521d2ffbfecf 181 }
yusuke_robocup 0:521d2ffbfecf 182 StringD = StringX + StringY + StringZ;
yusuke_robocup 0:521d2ffbfecf 183
yusuke_robocup 0:521d2ffbfecf 184
yusuke_robocup 0:521d2ffbfecf 185 StringX = String(5);
yusuke_robocup 0:521d2ffbfecf 186 val = input[4];//*100/255;
yusuke_robocup 0:521d2ffbfecf 187 if(val < 0 && val >= -100)
yusuke_robocup 0:521d2ffbfecf 188 {
yusuke_robocup 0:521d2ffbfecf 189 StringY = String('R');
yusuke_robocup 0:521d2ffbfecf 190 val = abs(val);
yusuke_robocup 0:521d2ffbfecf 191 StringZ = String(val);
yusuke_robocup 0:521d2ffbfecf 192 }
yusuke_robocup 0:521d2ffbfecf 193 else if(val >= 0 && val <= 100)
yusuke_robocup 0:521d2ffbfecf 194 {
yusuke_robocup 0:521d2ffbfecf 195 StringY = String('F');
yusuke_robocup 0:521d2ffbfecf 196 StringZ = String(val);
yusuke_robocup 0:521d2ffbfecf 197 }
yusuke_robocup 0:521d2ffbfecf 198 else
yusuke_robocup 0:521d2ffbfecf 199 {
yusuke_robocup 0:521d2ffbfecf 200 StringY = String('F');
yusuke_robocup 0:521d2ffbfecf 201 StringZ = String(0);
yusuke_robocup 0:521d2ffbfecf 202 }
yusuke_robocup 0:521d2ffbfecf 203 if(val < 10)
yusuke_robocup 0:521d2ffbfecf 204 {
yusuke_robocup 0:521d2ffbfecf 205 String0 = String("00");
yusuke_robocup 0:521d2ffbfecf 206 StringZ = String0 + StringZ;
yusuke_robocup 0:521d2ffbfecf 207 }
yusuke_robocup 0:521d2ffbfecf 208 else if(val < 100)
yusuke_robocup 0:521d2ffbfecf 209 {
yusuke_robocup 0:521d2ffbfecf 210 String0 = String('0');
yusuke_robocup 0:521d2ffbfecf 211 StringZ = String0 + StringZ;
yusuke_robocup 0:521d2ffbfecf 212 }
yusuke_robocup 0:521d2ffbfecf 213 else
yusuke_robocup 0:521d2ffbfecf 214 {
yusuke_robocup 0:521d2ffbfecf 215 }
yusuke_robocup 0:521d2ffbfecf 216 StringE = StringX + StringY + StringZ;
yusuke_robocup 0:521d2ffbfecf 217
yusuke_robocup 0:521d2ffbfecf 218
yusuke_robocup 0:521d2ffbfecf 219 StringX = String(6);
yusuke_robocup 0:521d2ffbfecf 220 val = input[5];//*100/255;
yusuke_robocup 0:521d2ffbfecf 221 if(val < 0 && val >= -100)
yusuke_robocup 0:521d2ffbfecf 222 {
yusuke_robocup 0:521d2ffbfecf 223 StringY = String('R');
yusuke_robocup 0:521d2ffbfecf 224 val = abs(val);
yusuke_robocup 0:521d2ffbfecf 225 StringZ = String(val);
yusuke_robocup 0:521d2ffbfecf 226 }
yusuke_robocup 0:521d2ffbfecf 227 else if(val >= 0 && val <= 100)
yusuke_robocup 0:521d2ffbfecf 228 {
yusuke_robocup 0:521d2ffbfecf 229 StringY = String('F');
yusuke_robocup 0:521d2ffbfecf 230 StringZ = String(val);
yusuke_robocup 0:521d2ffbfecf 231 }
yusuke_robocup 0:521d2ffbfecf 232 else
yusuke_robocup 0:521d2ffbfecf 233 {
yusuke_robocup 0:521d2ffbfecf 234 StringY = String('F');
yusuke_robocup 0:521d2ffbfecf 235 StringZ = String(0);
yusuke_robocup 0:521d2ffbfecf 236 }
yusuke_robocup 0:521d2ffbfecf 237 if(val < 10)
yusuke_robocup 0:521d2ffbfecf 238 {
yusuke_robocup 0:521d2ffbfecf 239 String0 = String("00");
yusuke_robocup 0:521d2ffbfecf 240 StringZ = String0 + StringZ;
yusuke_robocup 0:521d2ffbfecf 241 }
yusuke_robocup 0:521d2ffbfecf 242 else if(val < 100)
yusuke_robocup 0:521d2ffbfecf 243 {
yusuke_robocup 0:521d2ffbfecf 244 String0 = String('0');
yusuke_robocup 0:521d2ffbfecf 245 StringZ = String0 + StringZ;
yusuke_robocup 0:521d2ffbfecf 246 }
yusuke_robocup 0:521d2ffbfecf 247 else
yusuke_robocup 0:521d2ffbfecf 248 {
yusuke_robocup 0:521d2ffbfecf 249 }
yusuke_robocup 0:521d2ffbfecf 250 StringF = StringX + StringY + StringZ;
yusuke_robocup 0:521d2ffbfecf 251
yusuke_robocup 0:521d2ffbfecf 252 Serial.println(StringA+StringB+StringC+StringD+StringE+StringF);
yusuke_robocup 0:521d2ffbfecf 253 hexmot.println(StringA+StringB+StringC+StringD+StringE+StringF);
yusuke_robocup 0:521d2ffbfecf 254 }