
Project DataAquisitie
Dependencies: LM75B MMA7660 Servo mbed
Fork of analogintest3 by
main.cpp@3:194d842b7ba1, 2015-05-19 (annotated)
- Committer:
- mvanendert
- Date:
- Tue May 19 11:18:48 2015 +0000
- Revision:
- 3:194d842b7ba1
- Parent:
- 2:b3eddbd12635
- Child:
- 4:9d2e6381b6c5
Misan;
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
u0068206 | 0:e4782112c3fd | 1 | #include "mbed.h" |
u0068206 | 0:e4782112c3fd | 2 | #include "SerialRPCInterface.h" |
mvanendert | 1:2b6bdf677573 | 3 | #include "LM75B.h" |
mvanendert | 1:2b6bdf677573 | 4 | #include "C12832.h" |
mvanendert | 1:2b6bdf677573 | 5 | #include "MMA7660.h" |
mvanendert | 1:2b6bdf677573 | 6 | #include <time.h> |
mvanendert | 1:2b6bdf677573 | 7 | #include <stdlib.h> |
mvanendert | 1:2b6bdf677573 | 8 | #include "Servo.h" |
mvanendert | 2:b3eddbd12635 | 9 | |
mvanendert | 1:2b6bdf677573 | 10 | // // // // // // // // // // // // // // // // // // // // |
mvanendert | 1:2b6bdf677573 | 11 | // // // // // // //* Pennen defineren voor libs */ // // // // // |
mvanendert | 1:2b6bdf677573 | 12 | C12832 glcd(p5, p7, p6, p8, p11); //Grafische display aangesloten op P5,6,7,8,11 |
mvanendert | 1:2b6bdf677573 | 13 | MMA7660 MMA(p28, p27); //I2C Accelerometer |
mvanendert | 1:2b6bdf677573 | 14 | LM75B LM75(p28,p27); //LM75 Temp Sensor |
mvanendert | 1:2b6bdf677573 | 15 | SerialRPCInterface SerialInterface(USBTX, USBRX); //USB seriele communicatie opzetten |
mvanendert | 2:b3eddbd12635 | 16 | |
mvanendert | 1:2b6bdf677573 | 17 | PwmOut r (p23); //RGB Led op pen 23-25 |
mvanendert | 1:2b6bdf677573 | 18 | PwmOut g (p24); |
mvanendert | 1:2b6bdf677573 | 19 | PwmOut b (p25); |
mvanendert | 1:2b6bdf677573 | 20 | DigitalIn up(p15); //Joystick aangesloten op P12-16 |
mvanendert | 1:2b6bdf677573 | 21 | DigitalIn down(p12); |
mvanendert | 1:2b6bdf677573 | 22 | DigitalIn left(p13); |
mvanendert | 1:2b6bdf677573 | 23 | DigitalIn right(p16); |
mvanendert | 1:2b6bdf677573 | 24 | DigitalIn fire(p14); //Drukknop joystick zit op pen P14 |
mvanendert | 2:b3eddbd12635 | 25 | |
mvanendert | 1:2b6bdf677573 | 26 | DigitalOut connectionLed(LED1); //Accel OK LED |
mvanendert | 2:b3eddbd12635 | 27 | |
mvanendert | 1:2b6bdf677573 | 28 | BusOut leds(LED1,LED2,LED3,LED4); //Leds op MBED zelf defineren |
mvanendert | 2:b3eddbd12635 | 29 | |
mvanendert | 1:2b6bdf677573 | 30 | // // // // // // // // // // // // // // // // // // // // |
mvanendert | 1:2b6bdf677573 | 31 | // // // // // // //*Variabelen aanmaken */ // // // // // // // |
mvanendert | 1:2b6bdf677573 | 32 | float potentiometer1 = 0; |
mvanendert | 1:2b6bdf677573 | 33 | float potentiometer2 = 0; |
mvanendert | 1:2b6bdf677573 | 34 | float Xaxis = 0; |
mvanendert | 1:2b6bdf677573 | 35 | float Yaxis = 0; |
mvanendert | 1:2b6bdf677573 | 36 | float Zaxis = 0; |
mvanendert | 2:b3eddbd12635 | 37 | |
mvanendert | 1:2b6bdf677573 | 38 | int modus = 0; |
mvanendert | 1:2b6bdf677573 | 39 | int kleur = 0; |
mvanendert | 1:2b6bdf677573 | 40 | int rood = 0; |
mvanendert | 1:2b6bdf677573 | 41 | int groen = 0; |
mvanendert | 1:2b6bdf677573 | 42 | int blauw = 0; |
mvanendert | 2:b3eddbd12635 | 43 | |
mvanendert | 3:194d842b7ba1 | 44 | /* |
mvanendert | 1:2b6bdf677573 | 45 | char orientation; |
mvanendert | 3:194d842b7ba1 | 46 | char side; |
mvanendert | 1:2b6bdf677573 | 47 | char Left; |
mvanendert | 1:2b6bdf677573 | 48 | char Right; |
mvanendert | 1:2b6bdf677573 | 49 | char Down; |
mvanendert | 1:2b6bdf677573 | 50 | char Up; |
mvanendert | 1:2b6bdf677573 | 51 | char Front; |
mvanendert | 1:2b6bdf677573 | 52 | char Back; |
mvanendert | 3:194d842b7ba1 | 53 | */ |
mvanendert | 2:b3eddbd12635 | 54 | |
mvanendert | 3:194d842b7ba1 | 55 | RPCVariable<float> rpc_potentiometer1(&potentiometer1,"potentiometer1"); |
mvanendert | 3:194d842b7ba1 | 56 | RPCVariable<float> rpc_potentiometer2(&potentiometer2,"potentiometer2"); |
mvanendert | 3:194d842b7ba1 | 57 | RPCVariable<float> rpc_Xaxis(&Xaxis,"Xaxis"); |
mvanendert | 3:194d842b7ba1 | 58 | RPCVariable<float> rpc_Yaxis(&Yaxis,"Yaxis"); |
mvanendert | 3:194d842b7ba1 | 59 | |
mvanendert | 2:b3eddbd12635 | 60 | RPCVariable<int> rpc_rood(&rood,"rood"); |
mvanendert | 2:b3eddbd12635 | 61 | RPCVariable<int> rpc_groen(&groen,"groen"); |
mvanendert | 2:b3eddbd12635 | 62 | RPCVariable<int> rpc_blauw (&blauw ,"blauw "); |
mvanendert | 2:b3eddbd12635 | 63 | |
mvanendert | 3:194d842b7ba1 | 64 | |
mvanendert | 3:194d842b7ba1 | 65 | |
u0068206 | 0:e4782112c3fd | 66 | AnalogIn pot2(p19); |
mvanendert | 1:2b6bdf677573 | 67 | AnalogIn pot1(p20); |
mvanendert | 2:b3eddbd12635 | 68 | |
u0068206 | 0:e4782112c3fd | 69 | DigitalOut led(LED1); |
u0068206 | 0:e4782112c3fd | 70 | DigitalOut led2(LED2); |
mvanendert | 2:b3eddbd12635 | 71 | |
mvanendert | 1:2b6bdf677573 | 72 | DigitalIn enter(p14); |
mvanendert | 2:b3eddbd12635 | 73 | |
mvanendert | 1:2b6bdf677573 | 74 | PwmOut speaker(p26); |
mvanendert | 2:b3eddbd12635 | 75 | |
mvanendert | 1:2b6bdf677573 | 76 | Servo Servo1(p21); |
mvanendert | 1:2b6bdf677573 | 77 | Servo Servo2(p22); |
mvanendert | 2:b3eddbd12635 | 78 | |
mvanendert | 1:2b6bdf677573 | 79 | void RGB_routine(); |
mvanendert | 1:2b6bdf677573 | 80 | void ReadPot(); |
mvanendert | 1:2b6bdf677573 | 81 | void Accelero(); |
mvanendert | 1:2b6bdf677573 | 82 | void Servosturing(); |
mvanendert | 2:b3eddbd12635 | 83 | |
mvanendert | 1:2b6bdf677573 | 84 | // // // // // // // // // // // // // // // // // // // // |
mvanendert | 1:2b6bdf677573 | 85 | // // // // // // //*Begin van het hoofdprogramma */ // // // // // |
u0068206 | 0:e4782112c3fd | 86 | int main() { |
mvanendert | 2:b3eddbd12635 | 87 | |
mvanendert | 1:2b6bdf677573 | 88 | speaker.period(0.5); |
mvanendert | 1:2b6bdf677573 | 89 | r.period(0.001); |
mvanendert | 1:2b6bdf677573 | 90 | g.period(0.001); |
mvanendert | 1:2b6bdf677573 | 91 | b.period(0.001); |
mvanendert | 1:2b6bdf677573 | 92 | |
mvanendert | 1:2b6bdf677573 | 93 | |
mvanendert | 1:2b6bdf677573 | 94 | glcd.cls(); //Clear het display |
mvanendert | 2:b3eddbd12635 | 95 | glcd.locate(0,0); //Zet de cursor op X = 0 & Y = 0 |
mvanendert | 1:2b6bdf677573 | 96 | glcd.printf("Project Misan"); //Zet "Project Misan" op het LCD |
mvanendert | 2:b3eddbd12635 | 97 | glcd.locate(0,15); //Zet de cursor op X = 0 & Y = 15 |
mvanendert | 2:b3eddbd12635 | 98 | glcd.printf("Use the joystick"); //Zet "Project Misan" op het LCD |
mvanendert | 2:b3eddbd12635 | 99 | wait(1); //Wacht 1 seconde |
mvanendert | 1:2b6bdf677573 | 100 | |
u0068206 | 0:e4782112c3fd | 101 | while (1){ |
mvanendert | 1:2b6bdf677573 | 102 | |
mvanendert | 1:2b6bdf677573 | 103 | if (fire) |
mvanendert | 1:2b6bdf677573 | 104 | { |
mvanendert | 1:2b6bdf677573 | 105 | while(fire){} |
mvanendert | 2:b3eddbd12635 | 106 | |
mvanendert | 2:b3eddbd12635 | 107 | if(modus >= 4) |
mvanendert | 2:b3eddbd12635 | 108 | { |
mvanendert | 2:b3eddbd12635 | 109 | modus = 0; |
mvanendert | 2:b3eddbd12635 | 110 | } |
mvanendert | 2:b3eddbd12635 | 111 | |
mvanendert | 1:2b6bdf677573 | 112 | modus = modus++; |
mvanendert | 2:b3eddbd12635 | 113 | speaker = 0.5; |
mvanendert | 2:b3eddbd12635 | 114 | wait(0.025); |
mvanendert | 2:b3eddbd12635 | 115 | speaker = 0.25; |
mvanendert | 2:b3eddbd12635 | 116 | wait(0.025); |
mvanendert | 2:b3eddbd12635 | 117 | speaker = 0; |
mvanendert | 1:2b6bdf677573 | 118 | } |
mvanendert | 1:2b6bdf677573 | 119 | |
mvanendert | 1:2b6bdf677573 | 120 | switch (modus) |
mvanendert | 1:2b6bdf677573 | 121 | { |
mvanendert | 1:2b6bdf677573 | 122 | //RGB Controller |
mvanendert | 2:b3eddbd12635 | 123 | case 0: |
mvanendert | 2:b3eddbd12635 | 124 | glcd.cls(); //Clear het display |
mvanendert | 1:2b6bdf677573 | 125 | RGB_routine(); |
mvanendert | 1:2b6bdf677573 | 126 | break; |
mvanendert | 1:2b6bdf677573 | 127 | |
mvanendert | 1:2b6bdf677573 | 128 | //ADC Potentiometer |
mvanendert | 1:2b6bdf677573 | 129 | case 1: |
mvanendert | 2:b3eddbd12635 | 130 | glcd.cls(); //Clear het display |
mvanendert | 1:2b6bdf677573 | 131 | ReadPot(); |
mvanendert | 1:2b6bdf677573 | 132 | break; |
mvanendert | 1:2b6bdf677573 | 133 | |
mvanendert | 1:2b6bdf677573 | 134 | //Accelerometer MMA7660 |
mvanendert | 2:b3eddbd12635 | 135 | case 2: |
mvanendert | 2:b3eddbd12635 | 136 | glcd.cls(); //Clear het display |
mvanendert | 1:2b6bdf677573 | 137 | Accelero(); |
mvanendert | 1:2b6bdf677573 | 138 | break; |
mvanendert | 1:2b6bdf677573 | 139 | |
mvanendert | 2:b3eddbd12635 | 140 | case 3: |
mvanendert | 2:b3eddbd12635 | 141 | glcd.cls(); //Clear het display |
mvanendert | 1:2b6bdf677573 | 142 | Servosturing(); |
mvanendert | 1:2b6bdf677573 | 143 | break; |
mvanendert | 1:2b6bdf677573 | 144 | } |
mvanendert | 1:2b6bdf677573 | 145 | } |
mvanendert | 1:2b6bdf677573 | 146 | } |
mvanendert | 2:b3eddbd12635 | 147 | |
mvanendert | 2:b3eddbd12635 | 148 | |
mvanendert | 2:b3eddbd12635 | 149 | |
mvanendert | 2:b3eddbd12635 | 150 | |
mvanendert | 1:2b6bdf677573 | 151 | // // // // // // // // // // // // // // // // // // // // // // // // // |
mvanendert | 1:2b6bdf677573 | 152 | // // // // // // //* RGB routine voor kleurwijzigen met de Joystick */ // // // // // |
mvanendert | 1:2b6bdf677573 | 153 | void RGB_routine() |
mvanendert | 1:2b6bdf677573 | 154 | { |
mvanendert | 1:2b6bdf677573 | 155 | if (up) |
mvanendert | 1:2b6bdf677573 | 156 | { |
mvanendert | 1:2b6bdf677573 | 157 | switch (kleur) |
mvanendert | 1:2b6bdf677573 | 158 | { |
mvanendert | 1:2b6bdf677573 | 159 | case 0: |
mvanendert | 2:b3eddbd12635 | 160 | rood += 0.05; |
mvanendert | 1:2b6bdf677573 | 161 | break; |
mvanendert | 1:2b6bdf677573 | 162 | case 1: |
mvanendert | 2:b3eddbd12635 | 163 | groen += 0.05; |
mvanendert | 1:2b6bdf677573 | 164 | break; |
mvanendert | 1:2b6bdf677573 | 165 | case 2: |
mvanendert | 2:b3eddbd12635 | 166 | blauw += 0.05; |
mvanendert | 1:2b6bdf677573 | 167 | break; |
u0068206 | 0:e4782112c3fd | 168 | } |
mvanendert | 1:2b6bdf677573 | 169 | |
mvanendert | 1:2b6bdf677573 | 170 | } |
mvanendert | 1:2b6bdf677573 | 171 | |
mvanendert | 1:2b6bdf677573 | 172 | if (down) |
mvanendert | 1:2b6bdf677573 | 173 | { |
mvanendert | 1:2b6bdf677573 | 174 | switch (kleur) |
mvanendert | 1:2b6bdf677573 | 175 | { |
mvanendert | 1:2b6bdf677573 | 176 | case 0: |
mvanendert | 2:b3eddbd12635 | 177 | rood -= 0.05; |
mvanendert | 1:2b6bdf677573 | 178 | break; |
mvanendert | 1:2b6bdf677573 | 179 | case 1: |
mvanendert | 2:b3eddbd12635 | 180 | groen -= 0.05; |
mvanendert | 1:2b6bdf677573 | 181 | break; |
mvanendert | 1:2b6bdf677573 | 182 | case 2: |
mvanendert | 2:b3eddbd12635 | 183 | blauw -= 0.05; |
mvanendert | 1:2b6bdf677573 | 184 | break; |
mvanendert | 1:2b6bdf677573 | 185 | } |
mvanendert | 1:2b6bdf677573 | 186 | } |
mvanendert | 1:2b6bdf677573 | 187 | |
mvanendert | 1:2b6bdf677573 | 188 | if (right) |
mvanendert | 1:2b6bdf677573 | 189 | { |
mvanendert | 1:2b6bdf677573 | 190 | switch (kleur) |
mvanendert | 1:2b6bdf677573 | 191 | { |
mvanendert | 1:2b6bdf677573 | 192 | case 0: |
mvanendert | 1:2b6bdf677573 | 193 | kleur += 1; |
mvanendert | 1:2b6bdf677573 | 194 | break; |
mvanendert | 1:2b6bdf677573 | 195 | case 1: |
mvanendert | 1:2b6bdf677573 | 196 | kleur += 1; |
mvanendert | 1:2b6bdf677573 | 197 | break; |
mvanendert | 1:2b6bdf677573 | 198 | case 2: |
mvanendert | 1:2b6bdf677573 | 199 | kleur = 0; |
mvanendert | 1:2b6bdf677573 | 200 | break; |
mvanendert | 1:2b6bdf677573 | 201 | } |
mvanendert | 1:2b6bdf677573 | 202 | |
u0068206 | 0:e4782112c3fd | 203 | } |
mvanendert | 1:2b6bdf677573 | 204 | |
mvanendert | 1:2b6bdf677573 | 205 | if (left) |
mvanendert | 1:2b6bdf677573 | 206 | { |
mvanendert | 1:2b6bdf677573 | 207 | switch (kleur) |
mvanendert | 1:2b6bdf677573 | 208 | { |
mvanendert | 1:2b6bdf677573 | 209 | case 0: |
mvanendert | 1:2b6bdf677573 | 210 | kleur = 2; |
mvanendert | 1:2b6bdf677573 | 211 | break; |
mvanendert | 1:2b6bdf677573 | 212 | case 1: |
mvanendert | 1:2b6bdf677573 | 213 | kleur -= 1; |
mvanendert | 1:2b6bdf677573 | 214 | break; |
mvanendert | 1:2b6bdf677573 | 215 | case 2: |
mvanendert | 1:2b6bdf677573 | 216 | kleur -= 1; |
mvanendert | 1:2b6bdf677573 | 217 | break; |
mvanendert | 1:2b6bdf677573 | 218 | } |
mvanendert | 1:2b6bdf677573 | 219 | |
mvanendert | 2:b3eddbd12635 | 220 | } |
mvanendert | 2:b3eddbd12635 | 221 | |
mvanendert | 2:b3eddbd12635 | 222 | |
mvanendert | 2:b3eddbd12635 | 223 | |
mvanendert | 2:b3eddbd12635 | 224 | |
mvanendert | 2:b3eddbd12635 | 225 | |
mvanendert | 2:b3eddbd12635 | 226 | |
mvanendert | 2:b3eddbd12635 | 227 | |
mvanendert | 2:b3eddbd12635 | 228 | |
mvanendert | 2:b3eddbd12635 | 229 | |
mvanendert | 2:b3eddbd12635 | 230 | |
mvanendert | 2:b3eddbd12635 | 231 | |
mvanendert | 2:b3eddbd12635 | 232 | |
mvanendert | 2:b3eddbd12635 | 233 | |
mvanendert | 2:b3eddbd12635 | 234 | |
mvanendert | 2:b3eddbd12635 | 235 | |
mvanendert | 2:b3eddbd12635 | 236 | glcd.locate(0,0); //Zet de cursor op X = 0 & Y = 0 |
mvanendert | 2:b3eddbd12635 | 237 | glcd.printf("R: %i", r); |
mvanendert | 2:b3eddbd12635 | 238 | glcd.locate(0,9); //Zet de cursor op X = 0 & Y = 10 |
mvanendert | 2:b3eddbd12635 | 239 | glcd.printf("G: %i", g); |
mvanendert | 2:b3eddbd12635 | 240 | glcd.locate(0,18); //Zet de cursor op X = 0 & Y = 18 |
mvanendert | 2:b3eddbd12635 | 241 | glcd.printf("B: %i", b); |
mvanendert | 2:b3eddbd12635 | 242 | wait(0.5); |
mvanendert | 2:b3eddbd12635 | 243 | |
mvanendert | 1:2b6bdf677573 | 244 | } |
mvanendert | 2:b3eddbd12635 | 245 | |
mvanendert | 1:2b6bdf677573 | 246 | // // // // // // // // // // // // // // // // // // // // // // // // // |
mvanendert | 1:2b6bdf677573 | 247 | // // // // // // //* Inlezen en visualiseren van de potentiometers */ // // // // // |
mvanendert | 1:2b6bdf677573 | 248 | void ReadPot() |
mvanendert | 1:2b6bdf677573 | 249 | { |
mvanendert | 1:2b6bdf677573 | 250 | potentiometer1 = pot1; //steek de waarde van de Potentiometer1 in ai1 |
mvanendert | 1:2b6bdf677573 | 251 | potentiometer2 = pot2; //steek de waarde van de Potentiometer2 in ai2 |
mvanendert | 1:2b6bdf677573 | 252 | |
mvanendert | 1:2b6bdf677573 | 253 | glcd.locate(0,0); //Zet de cursor op X = 0 & Y = 0 |
mvanendert | 1:2b6bdf677573 | 254 | glcd.printf("Pot 1: %f ", potentiometer1); //Print de waarde van de potententiometer 1 op het display |
mvanendert | 1:2b6bdf677573 | 255 | glcd.locate(0,10); //Zet de cursor op X = 0 & Y = 10 |
mvanendert | 2:b3eddbd12635 | 256 | glcd.printf("Pot 2: %f ", potentiometer2); //Print de waarde van de potententiometer 2 op het display |
mvanendert | 2:b3eddbd12635 | 257 | wait(0.5); //Wacht 1 seconde |
mvanendert | 1:2b6bdf677573 | 258 | } |
mvanendert | 2:b3eddbd12635 | 259 | |
mvanendert | 2:b3eddbd12635 | 260 | |
mvanendert | 1:2b6bdf677573 | 261 | void Accelero() |
mvanendert | 1:2b6bdf677573 | 262 | { |
mvanendert | 1:2b6bdf677573 | 263 | if (MMA.testConnection()) |
mvanendert | 1:2b6bdf677573 | 264 | { |
mvanendert | 1:2b6bdf677573 | 265 | leds = 1; |
mvanendert | 1:2b6bdf677573 | 266 | } |
mvanendert | 1:2b6bdf677573 | 267 | |
mvanendert | 1:2b6bdf677573 | 268 | Xaxis = MMA.x(); |
mvanendert | 1:2b6bdf677573 | 269 | Yaxis = MMA.y(); |
mvanendert | 1:2b6bdf677573 | 270 | Zaxis = MMA.z(); |
mvanendert | 1:2b6bdf677573 | 271 | |
mvanendert | 1:2b6bdf677573 | 272 | glcd.locate(0,0); //Zet de cursor op X = 0 & Y = 0 |
mvanendert | 1:2b6bdf677573 | 273 | glcd.printf("X-Axis: %f G", Xaxis); |
mvanendert | 1:2b6bdf677573 | 274 | glcd.locate(0,9); //Zet de cursor op X = 0 & Y = 10 |
mvanendert | 1:2b6bdf677573 | 275 | glcd.printf("Y-Axis: %f G", Yaxis); |
mvanendert | 1:2b6bdf677573 | 276 | glcd.locate(0,18); //Zet de cursor op X = 0 & Y = 18 |
mvanendert | 1:2b6bdf677573 | 277 | glcd.printf("Z-Axis: %f G", Zaxis); |
mvanendert | 1:2b6bdf677573 | 278 | wait(1); |
mvanendert | 2:b3eddbd12635 | 279 | |
mvanendert | 1:2b6bdf677573 | 280 | } |
mvanendert | 2:b3eddbd12635 | 281 | |
mvanendert | 2:b3eddbd12635 | 282 | |
mvanendert | 1:2b6bdf677573 | 283 | void Servosturing() |
mvanendert | 1:2b6bdf677573 | 284 | { |
mvanendert | 1:2b6bdf677573 | 285 | |
mvanendert | 1:2b6bdf677573 | 286 | potentiometer1 = pot1; //steek de waarde van de Potentiometer1 in ai1 |
mvanendert | 1:2b6bdf677573 | 287 | potentiometer2 = pot2; //steek de waarde van de Potentiometer2 in ai2 |
mvanendert | 1:2b6bdf677573 | 288 | wait(0.1); |
mvanendert | 1:2b6bdf677573 | 289 | |
mvanendert | 2:b3eddbd12635 | 290 | Servo1.write(potentiometer1); |
mvanendert | 2:b3eddbd12635 | 291 | Servo2.write(potentiometer2); |
mvanendert | 1:2b6bdf677573 | 292 | |
mvanendert | 1:2b6bdf677573 | 293 | glcd.locate(0,0); //Zet de cursor op X = 0 & Y = 0 |
mvanendert | 1:2b6bdf677573 | 294 | glcd.printf("Servo-1: %f", Servo1); |
mvanendert | 1:2b6bdf677573 | 295 | glcd.locate(0,10); //Zet de cursor op X = 0 & Y = 10 |
mvanendert | 3:194d842b7ba1 | 296 | glcd.printf("Servo-2 %f", Servo2); |
mvanendert | 2:b3eddbd12635 | 297 | |
mvanendert | 2:b3eddbd12635 | 298 | wait(0.5); |
mvanendert | 1:2b6bdf677573 | 299 | } |
mvanendert | 2:b3eddbd12635 | 300 | |
mvanendert | 2:b3eddbd12635 | 301 | |
mvanendert | 2:b3eddbd12635 | 302 | |
mvanendert | 2:b3eddbd12635 | 303 | |
mvanendert | 2:b3eddbd12635 | 304 | |
mvanendert | 2:b3eddbd12635 | 305 | |
mvanendert | 2:b3eddbd12635 | 306 | |
mvanendert | 2:b3eddbd12635 | 307 | |
mvanendert | 2:b3eddbd12635 | 308 | |
mvanendert | 2:b3eddbd12635 | 309 | |
mvanendert | 2:b3eddbd12635 | 310 | |
mvanendert | 2:b3eddbd12635 | 311 | |
mvanendert | 2:b3eddbd12635 | 312 | |
mvanendert | 2:b3eddbd12635 | 313 | |
mvanendert | 2:b3eddbd12635 | 314 | |
mvanendert | 2:b3eddbd12635 | 315 | |
mvanendert | 2:b3eddbd12635 | 316 | |
mvanendert | 2:b3eddbd12635 | 317 | |
mvanendert | 2:b3eddbd12635 | 318 | |
mvanendert | 2:b3eddbd12635 | 319 | |
mvanendert | 1:2b6bdf677573 | 320 | /*switch (side) |
mvanendert | 1:2b6bdf677573 | 321 | { |
mvanendert | 1:2b6bdf677573 | 322 | case "Front": |
mvanendert | 1:2b6bdf677573 | 323 | switch (orientation) |
mvanendert | 1:2b6bdf677573 | 324 | { |
mvanendert | 1:2b6bdf677573 | 325 | case "Left": |
mvanendert | 1:2b6bdf677573 | 326 | glcd.locate(0,27); //Zet de cursor op X = 0 & Y = 10 |
mvanendert | 1:2b6bdf677573 | 327 | glcd.printf("Front Left"); |
mvanendert | 1:2b6bdf677573 | 328 | break; |
mvanendert | 1:2b6bdf677573 | 329 | |
mvanendert | 1:2b6bdf677573 | 330 | case "Right": |
mvanendert | 1:2b6bdf677573 | 331 | glcd.locate(0,27); //Zet de cursor op X = 0 & Y = 10 |
mvanendert | 1:2b6bdf677573 | 332 | glcd.printf("Front Right"); |
mvanendert | 1:2b6bdf677573 | 333 | break; |
mvanendert | 1:2b6bdf677573 | 334 | |
mvanendert | 1:2b6bdf677573 | 335 | case "Down": |
mvanendert | 1:2b6bdf677573 | 336 | glcd.locate(0,27); //Zet de cursor op X = 0 & Y = 10 |
mvanendert | 1:2b6bdf677573 | 337 | glcd.printf("Front Down"); |
mvanendert | 1:2b6bdf677573 | 338 | break; |
mvanendert | 1:2b6bdf677573 | 339 | |
mvanendert | 1:2b6bdf677573 | 340 | case "Up": |
mvanendert | 1:2b6bdf677573 | 341 | glcd.locate(0,27); //Zet de cursor op X = 0 & Y = 10 |
mvanendert | 1:2b6bdf677573 | 342 | glcd.printf("Front Up"); |
mvanendert | 1:2b6bdf677573 | 343 | break; |
mvanendert | 1:2b6bdf677573 | 344 | } |
mvanendert | 1:2b6bdf677573 | 345 | break; |
mvanendert | 2:b3eddbd12635 | 346 | |
mvanendert | 1:2b6bdf677573 | 347 | |
mvanendert | 1:2b6bdf677573 | 348 | case "Back": |
mvanendert | 1:2b6bdf677573 | 349 | switch (orientation) |
mvanendert | 1:2b6bdf677573 | 350 | { |
mvanendert | 1:2b6bdf677573 | 351 | case "Left": |
mvanendert | 1:2b6bdf677573 | 352 | glcd.locate(0,27); //Zet de cursor op X = 0 & Y = 10 |
mvanendert | 1:2b6bdf677573 | 353 | glcd.printf("Back Left"); |
mvanendert | 1:2b6bdf677573 | 354 | break; |
mvanendert | 1:2b6bdf677573 | 355 | |
mvanendert | 1:2b6bdf677573 | 356 | case "Right": |
mvanendert | 1:2b6bdf677573 | 357 | glcd.locate(0,27); //Zet de cursor op X = 0 & Y = 10 |
mvanendert | 1:2b6bdf677573 | 358 | glcd.printf("Back Right"); |
mvanendert | 1:2b6bdf677573 | 359 | break; |
mvanendert | 1:2b6bdf677573 | 360 | |
mvanendert | 1:2b6bdf677573 | 361 | case "Down": |
mvanendert | 1:2b6bdf677573 | 362 | glcd.locate(0,27); //Zet de cursor op X = 0 & Y = 10 |
mvanendert | 1:2b6bdf677573 | 363 | glcd.printf("Back Down"); |
mvanendert | 1:2b6bdf677573 | 364 | break; |
mvanendert | 1:2b6bdf677573 | 365 | |
mvanendert | 1:2b6bdf677573 | 366 | case "Up": |
mvanendert | 1:2b6bdf677573 | 367 | glcd.locate(0,27); //Zet de cursor op X = 0 & Y = 10 |
mvanendert | 1:2b6bdf677573 | 368 | glcd.printf("Back Up"); |
mvanendert | 1:2b6bdf677573 | 369 | break; |
mvanendert | 1:2b6bdf677573 | 370 | } |
mvanendert | 1:2b6bdf677573 | 371 | break; |
mvanendert | 2:b3eddbd12635 | 372 | } */ |