Mark and Peter / Mbed 2 deprecated 11u68Displaytest

Remote inc coolant nozzle control program

Dependencies:   mbed reScale USBDevice

Dependents:   Nozzle_inputs Nozzle_display

main.cpp@8:6bb07a893f53, 2019-02-19 (annotated)

Committer:
BETZtechnik
Date:
Tue Feb 19 05:56:53 2019 +0000
Revision:
8:6bb07a893f53
Parent:
5:18c6ff1370d0
Child:
18:40499bfc9ab2
Child:
20:8aebc19d9d1d
232 working

Who changed what in which revision?

UserRevisionLine numberNew contents of line
BETZtechnik 0:09419d572e90 1 #include "mbed.h"
BETZtechnik 2:79c03ac27b72 2
BETZtechnik 0:09419d572e90 3 #include "reScale.h"
BETZtechnik 2:79c03ac27b72 4
BETZtechnik 2:79c03ac27b72 5
BETZtechnik 2:79c03ac27b72 6 //Serial pc(USBTX, USBRX);
BETZtechnik 0:09419d572e90 7
BETZtechnik 5:18c6ff1370d0 8 //InterruptIn aux1(P0_7, PullUp); // index pulse
BETZtechnik 0:09419d572e90 9
BETZtechnik 5:18c6ff1370d0 10 DigitalIn aux1(P0_7);
BETZtechnik 5:18c6ff1370d0 11 DigitalIn cw(P1_24);
BETZtechnik 5:18c6ff1370d0 12 DigitalIn ccw(P2_7);
BETZtechnik 5:18c6ff1370d0 13
BETZtechnik 5:18c6ff1370d0 14 int cwRequested = 0;
BETZtechnik 5:18c6ff1370d0 15 int ccwRequested = 0;
BETZtechnik 5:18c6ff1370d0 16
BETZtechnik 5:18c6ff1370d0 17 int aux1State = 0;
BETZtechnik 5:18c6ff1370d0 18
BETZtechnik 5:18c6ff1370d0 19
BETZtechnik 5:18c6ff1370d0 20 DigitalOut dir(P0_15);
BETZtechnik 5:18c6ff1370d0 21
BETZtechnik 8:6bb07a893f53 22 Serial display(P0_14, P0_13, 19200); // RS 485 TX RX?
BETZtechnik 8:6bb07a893f53 23 Serial inputs(P1_23,P0_20, 9600); //rs232 TX RX
BETZtechnik 8:6bb07a893f53 24
BETZtechnik 8:6bb07a893f53 25
BETZtechnik 2:79c03ac27b72 26
BETZtechnik 2:79c03ac27b72 27 reScale servo1Scale(45,0,750,1800); //19850 is 1.0v from voltage divider at 10k.
BETZtechnik 0:09419d572e90 28
BETZtechnik 5:18c6ff1370d0 29 PwmOut servo1(P1_13); //display board
BETZtechnik 0:09419d572e90 30
BETZtechnik 2:79c03ac27b72 31 //char tens = '0';
BETZtechnik 2:79c03ac27b72 32 //char ones = '1';
BETZtechnik 0:09419d572e90 33
BETZtechnik 2:79c03ac27b72 34 int Tens = 0;
BETZtechnik 2:79c03ac27b72 35 int Ones = 0;
BETZtechnik 2:79c03ac27b72 36
BETZtechnik 2:79c03ac27b72 37 int currentNozzle = 0;
BETZtechnik 0:09419d572e90 38
BETZtechnik 2:79c03ac27b72 39 int index = 0; // for parsing serial
BETZtechnik 0:09419d572e90 40
BETZtechnik 2:79c03ac27b72 41 int n1Pos = 0;
BETZtechnik 0:09419d572e90 42
BETZtechnik 2:79c03ac27b72 43 int servo1Pos = 0;
BETZtechnik 0:09419d572e90 44
BETZtechnik 5:18c6ff1370d0 45
BETZtechnik 2:79c03ac27b72 46 DigitalOut servo2(P2_2);
BETZtechnik 0:09419d572e90 47
BETZtechnik 8:6bb07a893f53 48 /*
BETZtechnik 5:18c6ff1370d0 49 void triggered()
BETZtechnik 5:18c6ff1370d0 50 {
BETZtechnik 5:18c6ff1370d0 51 servo2 = 1;
BETZtechnik 5:18c6ff1370d0 52
BETZtechnik 5:18c6ff1370d0 53 if (cw == 0){
BETZtechnik 5:18c6ff1370d0 54 cwRequested = 1;
BETZtechnik 5:18c6ff1370d0 55 }
BETZtechnik 5:18c6ff1370d0 56
BETZtechnik 5:18c6ff1370d0 57 else if (ccw == 0){
BETZtechnik 5:18c6ff1370d0 58 ccwRequested = 1;
BETZtechnik 5:18c6ff1370d0 59 }
BETZtechnik 5:18c6ff1370d0 60
BETZtechnik 5:18c6ff1370d0 61 }
BETZtechnik 5:18c6ff1370d0 62
BETZtechnik 8:6bb07a893f53 63 */
BETZtechnik 5:18c6ff1370d0 64
BETZtechnik 5:18c6ff1370d0 65
BETZtechnik 5:18c6ff1370d0 66
BETZtechnik 0:09419d572e90 67 int main() {
BETZtechnik 4:fa0af3a8e089 68
BETZtechnik 5:18c6ff1370d0 69 cw.mode(PullUp);
BETZtechnik 5:18c6ff1370d0 70 ccw.mode(PullUp);
BETZtechnik 5:18c6ff1370d0 71 aux1.mode(PullUp);
BETZtechnik 2:79c03ac27b72 72
BETZtechnik 0:09419d572e90 73
BETZtechnik 8:6bb07a893f53 74
BETZtechnik 8:6bb07a893f53 75
BETZtechnik 5:18c6ff1370d0 76 //aux1.rise(&triggered);
BETZtechnik 5:18c6ff1370d0 77
BETZtechnik 5:18c6ff1370d0 78
BETZtechnik 5:18c6ff1370d0 79
BETZtechnik 5:18c6ff1370d0 80 servo2 = 0;
BETZtechnik 2:79c03ac27b72 81
BETZtechnik 2:79c03ac27b72 82
BETZtechnik 2:79c03ac27b72 83
BETZtechnik 2:79c03ac27b72 84 uint8_t c = 0; // for 485 link
BETZtechnik 0:09419d572e90 85
BETZtechnik 2:79c03ac27b72 86 while(1) {
BETZtechnik 4:fa0af3a8e089 87
BETZtechnik 5:18c6ff1370d0 88 //************************************ Interrupt response **********************
BETZtechnik 8:6bb07a893f53 89
BETZtechnik 5:18c6ff1370d0 90
BETZtechnik 8:6bb07a893f53 91 if (aux1 == 0 && aux1State == 0)
BETZtechnik 5:18c6ff1370d0 92 {
BETZtechnik 5:18c6ff1370d0 93
BETZtechnik 8:6bb07a893f53 94 if (cw == 1)
BETZtechnik 5:18c6ff1370d0 95 {
BETZtechnik 5:18c6ff1370d0 96 //servo2 = 1;
BETZtechnik 5:18c6ff1370d0 97 dir= 1;
BETZtechnik 5:18c6ff1370d0 98 //wait(0.001);
BETZtechnik 8:6bb07a893f53 99 display.printf("M");
BETZtechnik 5:18c6ff1370d0 100 wait(0.05);
BETZtechnik 8:6bb07a893f53 101 display.printf("-");
BETZtechnik 5:18c6ff1370d0 102 wait(0.001);
BETZtechnik 5:18c6ff1370d0 103 dir=0;
BETZtechnik 5:18c6ff1370d0 104 aux1State = 1;
BETZtechnik 5:18c6ff1370d0 105 //wait(.001);
BETZtechnik 5:18c6ff1370d0 106 }
BETZtechnik 5:18c6ff1370d0 107
BETZtechnik 8:6bb07a893f53 108 if (ccw == 1)
BETZtechnik 5:18c6ff1370d0 109 {
BETZtechnik 5:18c6ff1370d0 110 dir= 1;
BETZtechnik 5:18c6ff1370d0 111 //wait(0.01);
BETZtechnik 8:6bb07a893f53 112 display.printf("M");
BETZtechnik 5:18c6ff1370d0 113 wait(0.05);
BETZtechnik 8:6bb07a893f53 114 display.printf("+");
BETZtechnik 5:18c6ff1370d0 115 wait(0.001);
BETZtechnik 5:18c6ff1370d0 116 dir=0;
BETZtechnik 5:18c6ff1370d0 117 aux1State = 1;
BETZtechnik 5:18c6ff1370d0 118 //wait(.001);
BETZtechnik 5:18c6ff1370d0 119 }
BETZtechnik 5:18c6ff1370d0 120 }
BETZtechnik 5:18c6ff1370d0 121
BETZtechnik 8:6bb07a893f53 122 if (aux1 == 1 && aux1State == 1)
BETZtechnik 5:18c6ff1370d0 123 {
BETZtechnik 5:18c6ff1370d0 124 aux1State = 0;
BETZtechnik 5:18c6ff1370d0 125 //wait(0.1);
BETZtechnik 5:18c6ff1370d0 126 }
BETZtechnik 4:fa0af3a8e089 127
BETZtechnik 5:18c6ff1370d0 128 /*
BETZtechnik 5:18c6ff1370d0 129 if (cwRequested == 1)
BETZtechnik 5:18c6ff1370d0 130 {
BETZtechnik 5:18c6ff1370d0 131 dir= 1;
BETZtechnik 5:18c6ff1370d0 132 //wait(0.001);
BETZtechnik 8:6bb07a893f53 133 display.printf("M");
BETZtechnik 5:18c6ff1370d0 134 wait(0.01);
BETZtechnik 8:6bb07a893f53 135 display.printf("+");
BETZtechnik 5:18c6ff1370d0 136 wait(0.001);
BETZtechnik 5:18c6ff1370d0 137 dir=0;
BETZtechnik 5:18c6ff1370d0 138 cwRequested = 0;
BETZtechnik 5:18c6ff1370d0 139 //wait(.001);
BETZtechnik 5:18c6ff1370d0 140 }
BETZtechnik 5:18c6ff1370d0 141
BETZtechnik 5:18c6ff1370d0 142
BETZtechnik 5:18c6ff1370d0 143 else if (ccwRequested == 1)
BETZtechnik 5:18c6ff1370d0 144 {
BETZtechnik 5:18c6ff1370d0 145 dir= 1;
BETZtechnik 5:18c6ff1370d0 146 //wait(0.01);
BETZtechnik 8:6bb07a893f53 147 display.printf("M");
BETZtechnik 5:18c6ff1370d0 148 wait(0.01);
BETZtechnik 8:6bb07a893f53 149 display.printf("-");
BETZtechnik 5:18c6ff1370d0 150 wait(0.001);
BETZtechnik 5:18c6ff1370d0 151 dir=0;
BETZtechnik 5:18c6ff1370d0 152 ccwRequested = 0;
BETZtechnik 5:18c6ff1370d0 153 //wait(.001);
BETZtechnik 5:18c6ff1370d0 154 }
BETZtechnik 5:18c6ff1370d0 155 */
BETZtechnik 5:18c6ff1370d0 156
BETZtechnik 5:18c6ff1370d0 157
BETZtechnik 8:6bb07a893f53 158 //********************************** Display serial ***************************
BETZtechnik 2:79c03ac27b72 159
BETZtechnik 8:6bb07a893f53 160 while (display.readable())
BETZtechnik 5:18c6ff1370d0 161 {
BETZtechnik 5:18c6ff1370d0 162
BETZtechnik 0:09419d572e90 163
BETZtechnik 2:79c03ac27b72 164
BETZtechnik 8:6bb07a893f53 165 c = display.getc();
BETZtechnik 2:79c03ac27b72 166
BETZtechnik 2:79c03ac27b72 167 if (c == 'N'){
BETZtechnik 2:79c03ac27b72 168
BETZtechnik 2:79c03ac27b72 169 index = 1;
BETZtechnik 2:79c03ac27b72 170
BETZtechnik 2:79c03ac27b72 171 }
BETZtechnik 2:79c03ac27b72 172
BETZtechnik 2:79c03ac27b72 173 if (index == 1){
BETZtechnik 8:6bb07a893f53 174 c = display.getc();
BETZtechnik 2:79c03ac27b72 175 if (c == '1'){ // N1
BETZtechnik 2:79c03ac27b72 176 currentNozzle = 1;
BETZtechnik 2:79c03ac27b72 177 index = 3;
BETZtechnik 2:79c03ac27b72 178
BETZtechnik 2:79c03ac27b72 179
BETZtechnik 2:79c03ac27b72 180 }
BETZtechnik 2:79c03ac27b72 181 else if (c == '2'){ //N2
BETZtechnik 2:79c03ac27b72 182 currentNozzle = 2;
BETZtechnik 2:79c03ac27b72 183 index = 3;
BETZtechnik 2:79c03ac27b72 184
BETZtechnik 2:79c03ac27b72 185 }
BETZtechnik 2:79c03ac27b72 186
BETZtechnik 2:79c03ac27b72 187 }
BETZtechnik 2:79c03ac27b72 188
BETZtechnik 0:09419d572e90 189
BETZtechnik 2:79c03ac27b72 190
BETZtechnik 2:79c03ac27b72 191 if (index == 3){
BETZtechnik 2:79c03ac27b72 192
BETZtechnik 8:6bb07a893f53 193 c = display.getc();
BETZtechnik 2:79c03ac27b72 194
BETZtechnik 2:79c03ac27b72 195 if (c=='0'){
BETZtechnik 2:79c03ac27b72 196 Tens = 0;
BETZtechnik 2:79c03ac27b72 197 index = 4;
BETZtechnik 2:79c03ac27b72 198
BETZtechnik 2:79c03ac27b72 199 }
BETZtechnik 2:79c03ac27b72 200
BETZtechnik 2:79c03ac27b72 201 else if (c=='1'){
BETZtechnik 2:79c03ac27b72 202 Tens = 1;
BETZtechnik 2:79c03ac27b72 203 index = 4;
BETZtechnik 2:79c03ac27b72 204
BETZtechnik 2:79c03ac27b72 205 }
BETZtechnik 2:79c03ac27b72 206
BETZtechnik 2:79c03ac27b72 207 else if (c=='2'){
BETZtechnik 2:79c03ac27b72 208 Tens = 2;
BETZtechnik 2:79c03ac27b72 209 index = 4;
BETZtechnik 2:79c03ac27b72 210
BETZtechnik 2:79c03ac27b72 211 }
BETZtechnik 2:79c03ac27b72 212
BETZtechnik 2:79c03ac27b72 213 else if (c=='3'){
BETZtechnik 2:79c03ac27b72 214 Tens = 3;
BETZtechnik 2:79c03ac27b72 215 index = 4;
BETZtechnik 2:79c03ac27b72 216
BETZtechnik 2:79c03ac27b72 217 }
BETZtechnik 2:79c03ac27b72 218
BETZtechnik 2:79c03ac27b72 219 else if (c=='4'){
BETZtechnik 2:79c03ac27b72 220 Tens = 4;
BETZtechnik 2:79c03ac27b72 221 index = 4;
BETZtechnik 2:79c03ac27b72 222 }
BETZtechnik 2:79c03ac27b72 223
BETZtechnik 2:79c03ac27b72 224
BETZtechnik 2:79c03ac27b72 225 }
BETZtechnik 2:79c03ac27b72 226
BETZtechnik 2:79c03ac27b72 227 if (index == 4){
BETZtechnik 2:79c03ac27b72 228
BETZtechnik 8:6bb07a893f53 229 c = display.getc();
BETZtechnik 2:79c03ac27b72 230
BETZtechnik 2:79c03ac27b72 231 if (c=='0'){
BETZtechnik 2:79c03ac27b72 232 Ones = 0;
BETZtechnik 2:79c03ac27b72 233
BETZtechnik 2:79c03ac27b72 234 }
BETZtechnik 2:79c03ac27b72 235
BETZtechnik 2:79c03ac27b72 236 else if (c=='1'){
BETZtechnik 2:79c03ac27b72 237 Ones = 1;
BETZtechnik 2:79c03ac27b72 238
BETZtechnik 2:79c03ac27b72 239
BETZtechnik 2:79c03ac27b72 240 }
BETZtechnik 2:79c03ac27b72 241
BETZtechnik 2:79c03ac27b72 242 else if (c=='2'){
BETZtechnik 2:79c03ac27b72 243 Ones = 2;
BETZtechnik 2:79c03ac27b72 244
BETZtechnik 2:79c03ac27b72 245 }
BETZtechnik 2:79c03ac27b72 246
BETZtechnik 2:79c03ac27b72 247 else if (c=='3'){
BETZtechnik 2:79c03ac27b72 248 Ones = 3;
BETZtechnik 2:79c03ac27b72 249
BETZtechnik 2:79c03ac27b72 250 }
BETZtechnik 2:79c03ac27b72 251
BETZtechnik 2:79c03ac27b72 252 else if (c=='4'){
BETZtechnik 2:79c03ac27b72 253 Ones = 4;
BETZtechnik 2:79c03ac27b72 254 }
BETZtechnik 2:79c03ac27b72 255
BETZtechnik 2:79c03ac27b72 256 else if (c=='5'){
BETZtechnik 2:79c03ac27b72 257 Ones = 5;
BETZtechnik 2:79c03ac27b72 258 }
BETZtechnik 2:79c03ac27b72 259
BETZtechnik 2:79c03ac27b72 260 else if (c=='6'){
BETZtechnik 2:79c03ac27b72 261 Ones = 6;
BETZtechnik 2:79c03ac27b72 262 }
BETZtechnik 2:79c03ac27b72 263
BETZtechnik 2:79c03ac27b72 264 else if (c=='7'){
BETZtechnik 2:79c03ac27b72 265 Ones = 7;
BETZtechnik 2:79c03ac27b72 266 }
BETZtechnik 2:79c03ac27b72 267
BETZtechnik 2:79c03ac27b72 268 else if (c=='8'){
BETZtechnik 2:79c03ac27b72 269 Ones = 8;
BETZtechnik 2:79c03ac27b72 270 }
BETZtechnik 2:79c03ac27b72 271
BETZtechnik 2:79c03ac27b72 272 else if (c=='9'){
BETZtechnik 2:79c03ac27b72 273 Ones = 9;
BETZtechnik 2:79c03ac27b72 274 }
BETZtechnik 2:79c03ac27b72 275
BETZtechnik 2:79c03ac27b72 276 else if (c=='0'){
BETZtechnik 2:79c03ac27b72 277 Ones = 0;
BETZtechnik 2:79c03ac27b72 278 }
BETZtechnik 2:79c03ac27b72 279
BETZtechnik 2:79c03ac27b72 280
BETZtechnik 2:79c03ac27b72 281
BETZtechnik 5:18c6ff1370d0 282 n1Pos = ((Tens * 10) + Ones);
BETZtechnik 2:79c03ac27b72 283
BETZtechnik 5:18c6ff1370d0 284 if ((n1Pos == 45) && (currentNozzle==1)){
BETZtechnik 5:18c6ff1370d0 285 // servo2=1;
BETZtechnik 5:18c6ff1370d0 286 }
BETZtechnik 2:79c03ac27b72 287
BETZtechnik 5:18c6ff1370d0 288 servo1Pos = servo1Scale.from(n1Pos);
BETZtechnik 0:09419d572e90 289
BETZtechnik 5:18c6ff1370d0 290 servo1.pulsewidth_us(servo1Pos);
BETZtechnik 2:79c03ac27b72 291
BETZtechnik 5:18c6ff1370d0 292 index=0;
BETZtechnik 2:79c03ac27b72 293
BETZtechnik 2:79c03ac27b72 294
BETZtechnik 2:79c03ac27b72 295 }
BETZtechnik 0:09419d572e90 296 }
BETZtechnik 0:09419d572e90 297
BETZtechnik 0:09419d572e90 298
BETZtechnik 8:6bb07a893f53 299 //********************************* Inputs serial *******************************
BETZtechnik 8:6bb07a893f53 300
BETZtechnik 8:6bb07a893f53 301
BETZtechnik 8:6bb07a893f53 302 while (inputs.readable())
BETZtechnik 8:6bb07a893f53 303 {
BETZtechnik 8:6bb07a893f53 304
BETZtechnik 8:6bb07a893f53 305
BETZtechnik 8:6bb07a893f53 306 c = inputs.getc();
BETZtechnik 8:6bb07a893f53 307
BETZtechnik 8:6bb07a893f53 308 if (c == 'T'){
BETZtechnik 8:6bb07a893f53 309
BETZtechnik 8:6bb07a893f53 310 index = 1;
BETZtechnik 8:6bb07a893f53 311 servo2=1;
BETZtechnik 8:6bb07a893f53 312 }
BETZtechnik 8:6bb07a893f53 313
BETZtechnik 8:6bb07a893f53 314
BETZtechnik 8:6bb07a893f53 315 if (index == 1){
BETZtechnik 8:6bb07a893f53 316 c = inputs.getc();
BETZtechnik 8:6bb07a893f53 317
BETZtechnik 8:6bb07a893f53 318
BETZtechnik 8:6bb07a893f53 319 if (c=='0'){
BETZtechnik 8:6bb07a893f53 320 Tens = 0;
BETZtechnik 8:6bb07a893f53 321 servo2=1;
BETZtechnik 8:6bb07a893f53 322 }
BETZtechnik 8:6bb07a893f53 323
BETZtechnik 8:6bb07a893f53 324 else if (c=='1'){
BETZtechnik 8:6bb07a893f53 325 Tens = 1;
BETZtechnik 8:6bb07a893f53 326
BETZtechnik 8:6bb07a893f53 327
BETZtechnik 8:6bb07a893f53 328 }
BETZtechnik 8:6bb07a893f53 329
BETZtechnik 8:6bb07a893f53 330 else if (c=='2'){
BETZtechnik 8:6bb07a893f53 331 Tens = 2;
BETZtechnik 8:6bb07a893f53 332
BETZtechnik 8:6bb07a893f53 333 }
BETZtechnik 8:6bb07a893f53 334
BETZtechnik 8:6bb07a893f53 335 else if (c=='3'){
BETZtechnik 8:6bb07a893f53 336 Tens = 3;
BETZtechnik 8:6bb07a893f53 337
BETZtechnik 8:6bb07a893f53 338 }
BETZtechnik 8:6bb07a893f53 339
BETZtechnik 8:6bb07a893f53 340 else if (c=='4'){
BETZtechnik 8:6bb07a893f53 341 Tens = 4;
BETZtechnik 8:6bb07a893f53 342 }
BETZtechnik 8:6bb07a893f53 343
BETZtechnik 8:6bb07a893f53 344 else if (c=='5'){
BETZtechnik 8:6bb07a893f53 345 Tens = 5;
BETZtechnik 8:6bb07a893f53 346 }
BETZtechnik 8:6bb07a893f53 347
BETZtechnik 8:6bb07a893f53 348 else if (c=='6'){
BETZtechnik 8:6bb07a893f53 349 Tens = 6;
BETZtechnik 8:6bb07a893f53 350 }
BETZtechnik 8:6bb07a893f53 351
BETZtechnik 8:6bb07a893f53 352 else if (c=='7'){
BETZtechnik 8:6bb07a893f53 353 Tens = 7;
BETZtechnik 8:6bb07a893f53 354 }
BETZtechnik 8:6bb07a893f53 355
BETZtechnik 8:6bb07a893f53 356 else if (c=='8'){
BETZtechnik 8:6bb07a893f53 357 Tens = 8;
BETZtechnik 8:6bb07a893f53 358 }
BETZtechnik 8:6bb07a893f53 359
BETZtechnik 8:6bb07a893f53 360 else if (c=='9'){
BETZtechnik 8:6bb07a893f53 361 Tens = 9;
BETZtechnik 8:6bb07a893f53 362 }
BETZtechnik 8:6bb07a893f53 363
BETZtechnik 8:6bb07a893f53 364 else if (c=='0'){
BETZtechnik 8:6bb07a893f53 365 Tens = 0;
BETZtechnik 8:6bb07a893f53 366 }
BETZtechnik 8:6bb07a893f53 367 index = 2;
BETZtechnik 8:6bb07a893f53 368 }
BETZtechnik 8:6bb07a893f53 369
BETZtechnik 8:6bb07a893f53 370
BETZtechnik 8:6bb07a893f53 371 if (index == 2){
BETZtechnik 8:6bb07a893f53 372 c = inputs.getc();
BETZtechnik 8:6bb07a893f53 373 if (c=='0'){
BETZtechnik 8:6bb07a893f53 374 Ones = 0;
BETZtechnik 8:6bb07a893f53 375
BETZtechnik 8:6bb07a893f53 376 }
BETZtechnik 8:6bb07a893f53 377
BETZtechnik 8:6bb07a893f53 378 else if (c=='1'){
BETZtechnik 8:6bb07a893f53 379 Ones = 1;
BETZtechnik 8:6bb07a893f53 380
BETZtechnik 8:6bb07a893f53 381
BETZtechnik 8:6bb07a893f53 382 }
BETZtechnik 8:6bb07a893f53 383
BETZtechnik 8:6bb07a893f53 384 else if (c=='2'){
BETZtechnik 8:6bb07a893f53 385 Ones = 2;
BETZtechnik 8:6bb07a893f53 386
BETZtechnik 8:6bb07a893f53 387 }
BETZtechnik 8:6bb07a893f53 388
BETZtechnik 8:6bb07a893f53 389 else if (c=='3'){
BETZtechnik 8:6bb07a893f53 390 Ones = 3;
BETZtechnik 8:6bb07a893f53 391
BETZtechnik 8:6bb07a893f53 392 }
BETZtechnik 8:6bb07a893f53 393
BETZtechnik 8:6bb07a893f53 394 else if (c=='4'){
BETZtechnik 8:6bb07a893f53 395 Ones = 4;
BETZtechnik 8:6bb07a893f53 396 }
BETZtechnik 8:6bb07a893f53 397
BETZtechnik 8:6bb07a893f53 398 else if (c=='5'){
BETZtechnik 8:6bb07a893f53 399 Ones = 5;
BETZtechnik 8:6bb07a893f53 400 }
BETZtechnik 8:6bb07a893f53 401
BETZtechnik 8:6bb07a893f53 402 else if (c=='6'){
BETZtechnik 8:6bb07a893f53 403 Ones = 6;
BETZtechnik 8:6bb07a893f53 404 }
BETZtechnik 8:6bb07a893f53 405
BETZtechnik 8:6bb07a893f53 406 else if (c=='7'){
BETZtechnik 8:6bb07a893f53 407 Ones = 7;
BETZtechnik 8:6bb07a893f53 408 }
BETZtechnik 8:6bb07a893f53 409
BETZtechnik 8:6bb07a893f53 410 else if (c=='8'){
BETZtechnik 8:6bb07a893f53 411 Ones = 8;
BETZtechnik 8:6bb07a893f53 412 }
BETZtechnik 8:6bb07a893f53 413
BETZtechnik 8:6bb07a893f53 414 else if (c=='9'){
BETZtechnik 8:6bb07a893f53 415 Ones = 9;
BETZtechnik 8:6bb07a893f53 416 }
BETZtechnik 8:6bb07a893f53 417
BETZtechnik 8:6bb07a893f53 418 else if (c=='0'){
BETZtechnik 8:6bb07a893f53 419 Ones = 0;
BETZtechnik 8:6bb07a893f53 420 }
BETZtechnik 8:6bb07a893f53 421 int tempToolNo = (Tens*10)+100+Ones;
BETZtechnik 8:6bb07a893f53 422 dir=1;
BETZtechnik 8:6bb07a893f53 423 display.printf("T");
BETZtechnik 8:6bb07a893f53 424 wait(0.05);
BETZtechnik 8:6bb07a893f53 425 display.printf("%d", tempToolNo);
BETZtechnik 8:6bb07a893f53 426 wait(0.001);
BETZtechnik 8:6bb07a893f53 427 dir=0;
BETZtechnik 8:6bb07a893f53 428 index = 0;
BETZtechnik 8:6bb07a893f53 429 tempToolNo=0;
BETZtechnik 8:6bb07a893f53 430
BETZtechnik 8:6bb07a893f53 431 }
BETZtechnik 8:6bb07a893f53 432
BETZtechnik 8:6bb07a893f53 433
BETZtechnik 8:6bb07a893f53 434 }
BETZtechnik 8:6bb07a893f53 435
BETZtechnik 8:6bb07a893f53 436
BETZtechnik 8:6bb07a893f53 437 // *****************************************************************************
BETZtechnik 5:18c6ff1370d0 438
BETZtechnik 0:09419d572e90 439
BETZtechnik 2:79c03ac27b72 440
BETZtechnik 2:79c03ac27b72 441 }
BETZtechnik 2:79c03ac27b72 442 }