sander cuyvers / Mbed 2 deprecated DataAquisitieMisan3

DataAquisitieMisan3

Dependencies:   LM75B MMA7660 Servo mbed

Fork of DataAquisitieMisan by Michiel Van Endert

main.cpp@4:0632609d4862, 2015-05-19 (annotated)

Committer:
sandermbed
Date:
Tue May 19 11:58:45 2015 +0000
Revision:
4:0632609d4862
Parent:
3:194d842b7ba1 
dd

Who changed what in which revision?

UserRevisionLine numberNew 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 */ // // // // // // //
sandermbed 4:0632609d4862 32 int potentiometer1 = 0;
sandermbed 4:0632609d4862 33 int 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;
sandermbed 4:0632609d4862 43 int xas = 0 ;
sandermbed 4:0632609d4862 44 int yas = 0 ;
sandermbed 4:0632609d4862 45 int potmet1 = 0;
sandermbed 4:0632609d4862 46 int potmet2 = 0;
mvanendert 2:b3eddbd12635 47
mvanendert 3:194d842b7ba1 48 /*
mvanendert 1:2b6bdf677573 49 char orientation;
mvanendert 3:194d842b7ba1 50 char side;
mvanendert 1:2b6bdf677573 51 char Left;
mvanendert 1:2b6bdf677573 52 char Right;
mvanendert 1:2b6bdf677573 53 char Down;
mvanendert 1:2b6bdf677573 54 char Up;
mvanendert 1:2b6bdf677573 55 char Front;
mvanendert 1:2b6bdf677573 56 char Back;
mvanendert 3:194d842b7ba1 57 */
mvanendert 2:b3eddbd12635 58
sandermbed 4:0632609d4862 59 RPCVariable<int> rpc_potentiometer1(&potentiometer1,"potentiometer1");
sandermbed 4:0632609d4862 60 RPCVariable<int> rpc_potentiometer2(&potentiometer2,"potentiometer2");
sandermbed 4:0632609d4862 61 RPCVariable<int> rpc_xas(&xas,"xas");
sandermbed 4:0632609d4862 62 RPCVariable<int> rpc_yas(&yas,"yas");
mvanendert 3:194d842b7ba1 63
mvanendert 2:b3eddbd12635 64 RPCVariable<int> rpc_rood(&rood,"rood");
mvanendert 2:b3eddbd12635 65 RPCVariable<int> rpc_groen(&groen,"groen");
mvanendert 2:b3eddbd12635 66 RPCVariable<int> rpc_blauw (&blauw ,"blauw ");
mvanendert 2:b3eddbd12635 67
mvanendert 3:194d842b7ba1 68
mvanendert 3:194d842b7ba1 69
u0068206 0:e4782112c3fd 70 AnalogIn pot2(p19);
mvanendert 1:2b6bdf677573 71 AnalogIn pot1(p20);
mvanendert 2:b3eddbd12635 72
u0068206 0:e4782112c3fd 73 DigitalOut led(LED1);
u0068206 0:e4782112c3fd 74 DigitalOut led2(LED2);
mvanendert 2:b3eddbd12635 75
mvanendert 1:2b6bdf677573 76 DigitalIn enter(p14);
mvanendert 2:b3eddbd12635 77
mvanendert 1:2b6bdf677573 78 PwmOut speaker(p26);
mvanendert 2:b3eddbd12635 79
mvanendert 1:2b6bdf677573 80 Servo Servo1(p21);
mvanendert 1:2b6bdf677573 81 Servo Servo2(p22);
mvanendert 2:b3eddbd12635 82
mvanendert 1:2b6bdf677573 83 void RGB_routine();
mvanendert 1:2b6bdf677573 84 void ReadPot();
mvanendert 1:2b6bdf677573 85 void Accelero();
mvanendert 1:2b6bdf677573 86 void Servosturing();
mvanendert 2:b3eddbd12635 87
mvanendert 1:2b6bdf677573 88 // // // // // // // // // // // // // // // // // // // //
mvanendert 1:2b6bdf677573 89 // // // // // // //*Begin van het hoofdprogramma */ // // // // //
u0068206 0:e4782112c3fd 90 int main() {
mvanendert 2:b3eddbd12635 91
mvanendert 1:2b6bdf677573 92 speaker.period(0.5);
mvanendert 1:2b6bdf677573 93 r.period(0.001);
mvanendert 1:2b6bdf677573 94 g.period(0.001);
mvanendert 1:2b6bdf677573 95 b.period(0.001);
mvanendert 1:2b6bdf677573 96
mvanendert 1:2b6bdf677573 97
mvanendert 1:2b6bdf677573 98 glcd.cls(); //Clear het display
mvanendert 2:b3eddbd12635 99 glcd.locate(0,0); //Zet de cursor op X = 0 & Y = 0
mvanendert 1:2b6bdf677573 100 glcd.printf("Project Misan"); //Zet "Project Misan" op het LCD
mvanendert 2:b3eddbd12635 101 glcd.locate(0,15); //Zet de cursor op X = 0 & Y = 15
mvanendert 2:b3eddbd12635 102 glcd.printf("Use the joystick"); //Zet "Project Misan" op het LCD
mvanendert 2:b3eddbd12635 103 wait(1); //Wacht 1 seconde
mvanendert 1:2b6bdf677573 104
u0068206 0:e4782112c3fd 105 while (1){
mvanendert 1:2b6bdf677573 106
mvanendert 1:2b6bdf677573 107 if (fire)
mvanendert 1:2b6bdf677573 108 {
mvanendert 1:2b6bdf677573 109 while(fire){}
mvanendert 2:b3eddbd12635 110
mvanendert 2:b3eddbd12635 111 if(modus >= 4)
mvanendert 2:b3eddbd12635 112 {
mvanendert 2:b3eddbd12635 113 modus = 0;
mvanendert 2:b3eddbd12635 114 }
mvanendert 2:b3eddbd12635 115
mvanendert 1:2b6bdf677573 116 modus = modus++;
mvanendert 2:b3eddbd12635 117 speaker = 0.5;
mvanendert 2:b3eddbd12635 118 wait(0.025);
mvanendert 2:b3eddbd12635 119 speaker = 0.25;
mvanendert 2:b3eddbd12635 120 wait(0.025);
mvanendert 2:b3eddbd12635 121 speaker = 0;
mvanendert 1:2b6bdf677573 122 }
mvanendert 1:2b6bdf677573 123
mvanendert 1:2b6bdf677573 124 switch (modus)
mvanendert 1:2b6bdf677573 125 {
mvanendert 1:2b6bdf677573 126 //RGB Controller
mvanendert 2:b3eddbd12635 127 case 0:
mvanendert 2:b3eddbd12635 128 glcd.cls(); //Clear het display
mvanendert 1:2b6bdf677573 129 RGB_routine();
mvanendert 1:2b6bdf677573 130 break;
mvanendert 1:2b6bdf677573 131
mvanendert 1:2b6bdf677573 132 //ADC Potentiometer
mvanendert 1:2b6bdf677573 133 case 1:
mvanendert 2:b3eddbd12635 134 glcd.cls(); //Clear het display
mvanendert 1:2b6bdf677573 135 ReadPot();
mvanendert 1:2b6bdf677573 136 break;
mvanendert 1:2b6bdf677573 137
mvanendert 1:2b6bdf677573 138 //Accelerometer MMA7660
mvanendert 2:b3eddbd12635 139 case 2:
mvanendert 2:b3eddbd12635 140 glcd.cls(); //Clear het display
mvanendert 1:2b6bdf677573 141 Accelero();
mvanendert 1:2b6bdf677573 142 break;
mvanendert 1:2b6bdf677573 143
mvanendert 2:b3eddbd12635 144 case 3:
mvanendert 2:b3eddbd12635 145 glcd.cls(); //Clear het display
mvanendert 1:2b6bdf677573 146 Servosturing();
mvanendert 1:2b6bdf677573 147 break;
mvanendert 1:2b6bdf677573 148 }
mvanendert 1:2b6bdf677573 149 }
mvanendert 1:2b6bdf677573 150 }
mvanendert 2:b3eddbd12635 151
mvanendert 2:b3eddbd12635 152
mvanendert 2:b3eddbd12635 153
mvanendert 2:b3eddbd12635 154
mvanendert 1:2b6bdf677573 155 // // // // // // // // // // // // // // // // // // // // // // // // //
mvanendert 1:2b6bdf677573 156 // // // // // // //* RGB routine voor kleurwijzigen met de Joystick */ // // // // //
mvanendert 1:2b6bdf677573 157 void RGB_routine()
mvanendert 1:2b6bdf677573 158 {
sandermbed 4:0632609d4862 159
sandermbed 4:0632609d4862 160
sandermbed 4:0632609d4862 161 if (right)
sandermbed 4:0632609d4862 162 {
sandermbed 4:0632609d4862 163 if (kleur < 2)
sandermbed 4:0632609d4862 164 {
sandermbed 4:0632609d4862 165 kleur = kleur++;
sandermbed 4:0632609d4862 166 }
sandermbed 4:0632609d4862 167 if (kleur == 2)
sandermbed 4:0632609d4862 168 {
sandermbed 4:0632609d4862 169 kleur = 0;
sandermbed 4:0632609d4862 170 }
sandermbed 4:0632609d4862 171 }
sandermbed 4:0632609d4862 172
sandermbed 4:0632609d4862 173 if (left)
sandermbed 4:0632609d4862 174 {
sandermbed 4:0632609d4862 175 if (kleur > 0)
sandermbed 4:0632609d4862 176 {
sandermbed 4:0632609d4862 177 kleur = kleur--;
sandermbed 4:0632609d4862 178 }
sandermbed 4:0632609d4862 179 if (kleur == 0)
sandermbed 4:0632609d4862 180 {
sandermbed 4:0632609d4862 181 kleur = 2;
sandermbed 4:0632609d4862 182 }
sandermbed 4:0632609d4862 183 }
sandermbed 4:0632609d4862 184
mvanendert 1:2b6bdf677573 185 if (up)
mvanendert 1:2b6bdf677573 186 {
sandermbed 4:0632609d4862 187 if(kleur == 0 & rood <1)
sandermbed 4:0632609d4862 188 {
sandermbed 4:0632609d4862 189 rood = rood + 0.05;
sandermbed 4:0632609d4862 190 }
sandermbed 4:0632609d4862 191 if(kleur == 0 && rood == 1)
sandermbed 4:0632609d4862 192 {
sandermbed 4:0632609d4862 193 rood = 0;
sandermbed 4:0632609d4862 194 }
sandermbed 4:0632609d4862 195 if(kleur == 1 && groen <1)
sandermbed 4:0632609d4862 196 {
sandermbed 4:0632609d4862 197 groen = groen + 0.05;
sandermbed 4:0632609d4862 198 }
sandermbed 4:0632609d4862 199 if(kleur == 1 && groen == 1)
sandermbed 4:0632609d4862 200 {
sandermbed 4:0632609d4862 201 groen = 0;
sandermbed 4:0632609d4862 202 }
sandermbed 4:0632609d4862 203 if(kleur == 2 && blauw <1)
sandermbed 4:0632609d4862 204 {
sandermbed 4:0632609d4862 205 blauw = blauw + 0.05;
sandermbed 4:0632609d4862 206 }
sandermbed 4:0632609d4862 207 if(kleur == 2 && blauw == 1)
sandermbed 4:0632609d4862 208 {
sandermbed 4:0632609d4862 209 blauw = 0;
sandermbed 4:0632609d4862 210 }
sandermbed 4:0632609d4862 211 }
sandermbed 4:0632609d4862 212
sandermbed 4:0632609d4862 213 if (down)
sandermbed 4:0632609d4862 214 {
sandermbed 4:0632609d4862 215 if(kleur == 0 && rood <0)
sandermbed 4:0632609d4862 216 {
sandermbed 4:0632609d4862 217 rood = rood - 0.05;
sandermbed 4:0632609d4862 218 }
sandermbed 4:0632609d4862 219 if(kleur == 0 && rood == 0)
sandermbed 4:0632609d4862 220 {
sandermbed 4:0632609d4862 221 rood = 1;
sandermbed 4:0632609d4862 222 }
sandermbed 4:0632609d4862 223 if(kleur == 1 && groen <0)
sandermbed 4:0632609d4862 224 {
sandermbed 4:0632609d4862 225 groen = groen - 0.05;
sandermbed 4:0632609d4862 226 }
sandermbed 4:0632609d4862 227 if(kleur == 1 && groen == 0)
sandermbed 4:0632609d4862 228 {
sandermbed 4:0632609d4862 229 groen = 1;
sandermbed 4:0632609d4862 230 }
sandermbed 4:0632609d4862 231 if(kleur == 2 && blauw <0)
sandermbed 4:0632609d4862 232 {
sandermbed 4:0632609d4862 233 blauw = blauw - 0.05;
sandermbed 4:0632609d4862 234 }
sandermbed 4:0632609d4862 235 if(kleur == 2 && blauw == 0)
sandermbed 4:0632609d4862 236 {
sandermbed 4:0632609d4862 237 blauw = 1;
sandermbed 4:0632609d4862 238 }
sandermbed 4:0632609d4862 239 }
sandermbed 4:0632609d4862 240
sandermbed 4:0632609d4862 241
sandermbed 4:0632609d4862 242
sandermbed 4:0632609d4862 243
sandermbed 4:0632609d4862 244
sandermbed 4:0632609d4862 245 /* if (up)
sandermbed 4:0632609d4862 246 {
mvanendert 1:2b6bdf677573 247 switch (kleur)
mvanendert 1:2b6bdf677573 248 {
mvanendert 1:2b6bdf677573 249 case 0:
mvanendert 2:b3eddbd12635 250 rood += 0.05;
mvanendert 1:2b6bdf677573 251 break;
mvanendert 1:2b6bdf677573 252 case 1:
mvanendert 2:b3eddbd12635 253 groen += 0.05;
mvanendert 1:2b6bdf677573 254 break;
mvanendert 1:2b6bdf677573 255 case 2:
mvanendert 2:b3eddbd12635 256 blauw += 0.05;
mvanendert 1:2b6bdf677573 257 break;
u0068206 0:e4782112c3fd 258 }
mvanendert 1:2b6bdf677573 259
mvanendert 1:2b6bdf677573 260 }
mvanendert 1:2b6bdf677573 261
mvanendert 1:2b6bdf677573 262 if (down)
mvanendert 1:2b6bdf677573 263 {
mvanendert 1:2b6bdf677573 264 switch (kleur)
mvanendert 1:2b6bdf677573 265 {
mvanendert 1:2b6bdf677573 266 case 0:
mvanendert 2:b3eddbd12635 267 rood -= 0.05;
mvanendert 1:2b6bdf677573 268 break;
mvanendert 1:2b6bdf677573 269 case 1:
mvanendert 2:b3eddbd12635 270 groen -= 0.05;
mvanendert 1:2b6bdf677573 271 break;
mvanendert 1:2b6bdf677573 272 case 2:
mvanendert 2:b3eddbd12635 273 blauw -= 0.05;
mvanendert 1:2b6bdf677573 274 break;
mvanendert 1:2b6bdf677573 275 }
mvanendert 1:2b6bdf677573 276 }
mvanendert 1:2b6bdf677573 277
mvanendert 1:2b6bdf677573 278 if (right)
mvanendert 1:2b6bdf677573 279 {
mvanendert 1:2b6bdf677573 280 switch (kleur)
mvanendert 1:2b6bdf677573 281 {
mvanendert 1:2b6bdf677573 282 case 0:
mvanendert 1:2b6bdf677573 283 kleur += 1;
mvanendert 1:2b6bdf677573 284 break;
mvanendert 1:2b6bdf677573 285 case 1:
mvanendert 1:2b6bdf677573 286 kleur += 1;
mvanendert 1:2b6bdf677573 287 break;
mvanendert 1:2b6bdf677573 288 case 2:
mvanendert 1:2b6bdf677573 289 kleur = 0;
mvanendert 1:2b6bdf677573 290 break;
mvanendert 1:2b6bdf677573 291 }
mvanendert 1:2b6bdf677573 292
u0068206 0:e4782112c3fd 293 }
mvanendert 1:2b6bdf677573 294
mvanendert 1:2b6bdf677573 295 if (left)
mvanendert 1:2b6bdf677573 296 {
mvanendert 1:2b6bdf677573 297 switch (kleur)
mvanendert 1:2b6bdf677573 298 {
mvanendert 1:2b6bdf677573 299 case 0:
mvanendert 1:2b6bdf677573 300 kleur = 2;
mvanendert 1:2b6bdf677573 301 break;
mvanendert 1:2b6bdf677573 302 case 1:
mvanendert 1:2b6bdf677573 303 kleur -= 1;
mvanendert 1:2b6bdf677573 304 break;
mvanendert 1:2b6bdf677573 305 case 2:
mvanendert 1:2b6bdf677573 306 kleur -= 1;
mvanendert 1:2b6bdf677573 307 break;
mvanendert 1:2b6bdf677573 308 }
mvanendert 1:2b6bdf677573 309
mvanendert 2:b3eddbd12635 310 }
mvanendert 2:b3eddbd12635 311
mvanendert 2:b3eddbd12635 312
sandermbed 4:0632609d4862 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 2:b3eddbd12635 320
mvanendert 2:b3eddbd12635 321
mvanendert 2:b3eddbd12635 322
mvanendert 2:b3eddbd12635 323
mvanendert 2:b3eddbd12635 324
mvanendert 2:b3eddbd12635 325
mvanendert 2:b3eddbd12635 326 glcd.locate(0,0); //Zet de cursor op X = 0 & Y = 0
sandermbed 4:0632609d4862 327 glcd.printf("R: %i", up);
mvanendert 2:b3eddbd12635 328 glcd.locate(0,9); //Zet de cursor op X = 0 & Y = 10
sandermbed 4:0632609d4862 329 glcd.printf("G: %i", down);
mvanendert 2:b3eddbd12635 330 glcd.locate(0,18); //Zet de cursor op X = 0 & Y = 18
sandermbed 4:0632609d4862 331 glcd.printf("B: %i", blauw);
mvanendert 2:b3eddbd12635 332 wait(0.5);
mvanendert 2:b3eddbd12635 333
mvanendert 1:2b6bdf677573 334 }
mvanendert 2:b3eddbd12635 335
mvanendert 1:2b6bdf677573 336 // // // // // // // // // // // // // // // // // // // // // // // // //
mvanendert 1:2b6bdf677573 337 // // // // // // //* Inlezen en visualiseren van de potentiometers */ // // // // //
mvanendert 1:2b6bdf677573 338 void ReadPot()
mvanendert 1:2b6bdf677573 339 {
sandermbed 4:0632609d4862 340 potentiometer1 = pot1*100; //steek de waarde van de Potentiometer1 in ai1
sandermbed 4:0632609d4862 341 potentiometer2 = pot2*100; //steek de waarde van de Potentiometer2 in ai2
mvanendert 1:2b6bdf677573 342
mvanendert 1:2b6bdf677573 343 glcd.locate(0,0); //Zet de cursor op X = 0 & Y = 0
sandermbed 4:0632609d4862 344 glcd.printf("Pot 1: %i ", potentiometer1); //Print de waarde van de potententiometer 1 op het display
mvanendert 1:2b6bdf677573 345 glcd.locate(0,10); //Zet de cursor op X = 0 & Y = 10
sandermbed 4:0632609d4862 346 glcd.printf("Pot 2: %i ", potentiometer2); //Print de waarde van de potententiometer 2 op het display
mvanendert 2:b3eddbd12635 347 wait(0.5); //Wacht 1 seconde
mvanendert 1:2b6bdf677573 348 }
mvanendert 2:b3eddbd12635 349
mvanendert 2:b3eddbd12635 350
mvanendert 1:2b6bdf677573 351 void Accelero()
mvanendert 1:2b6bdf677573 352 {
mvanendert 1:2b6bdf677573 353 if (MMA.testConnection())
mvanendert 1:2b6bdf677573 354 {
mvanendert 1:2b6bdf677573 355 leds = 1;
mvanendert 1:2b6bdf677573 356 }
mvanendert 1:2b6bdf677573 357
mvanendert 1:2b6bdf677573 358 Xaxis = MMA.x();
mvanendert 1:2b6bdf677573 359 Yaxis = MMA.y();
mvanendert 1:2b6bdf677573 360 Zaxis = MMA.z();
sandermbed 4:0632609d4862 361 xas = Xaxis*100 ;
sandermbed 4:0632609d4862 362 yas = Yaxis*100 ;
mvanendert 1:2b6bdf677573 363
mvanendert 1:2b6bdf677573 364 glcd.locate(0,0); //Zet de cursor op X = 0 & Y = 0
mvanendert 1:2b6bdf677573 365 glcd.printf("X-Axis: %f G", Xaxis);
mvanendert 1:2b6bdf677573 366 glcd.locate(0,9); //Zet de cursor op X = 0 & Y = 10
mvanendert 1:2b6bdf677573 367 glcd.printf("Y-Axis: %f G", Yaxis);
mvanendert 1:2b6bdf677573 368 glcd.locate(0,18); //Zet de cursor op X = 0 & Y = 18
mvanendert 1:2b6bdf677573 369 glcd.printf("Z-Axis: %f G", Zaxis);
mvanendert 1:2b6bdf677573 370 wait(1);
mvanendert 2:b3eddbd12635 371
mvanendert 1:2b6bdf677573 372 }
mvanendert 2:b3eddbd12635 373
mvanendert 2:b3eddbd12635 374
mvanendert 1:2b6bdf677573 375 void Servosturing()
mvanendert 1:2b6bdf677573 376 {
mvanendert 1:2b6bdf677573 377
mvanendert 1:2b6bdf677573 378 potentiometer1 = pot1; //steek de waarde van de Potentiometer1 in ai1
mvanendert 1:2b6bdf677573 379 potentiometer2 = pot2; //steek de waarde van de Potentiometer2 in ai2
mvanendert 1:2b6bdf677573 380 wait(0.1);
mvanendert 1:2b6bdf677573 381
mvanendert 2:b3eddbd12635 382 Servo1.write(potentiometer1);
mvanendert 2:b3eddbd12635 383 Servo2.write(potentiometer2);
mvanendert 1:2b6bdf677573 384
mvanendert 1:2b6bdf677573 385 glcd.locate(0,0); //Zet de cursor op X = 0 & Y = 0
mvanendert 1:2b6bdf677573 386 glcd.printf("Servo-1: %f", Servo1);
mvanendert 1:2b6bdf677573 387 glcd.locate(0,10); //Zet de cursor op X = 0 & Y = 10
sandermbed 4:0632609d4862 388 glcd.printf("Servo-2: %f", Servo2);
mvanendert 2:b3eddbd12635 389
mvanendert 2:b3eddbd12635 390 wait(0.5);
mvanendert 1:2b6bdf677573 391 }
mvanendert 2:b3eddbd12635 392
mvanendert 2:b3eddbd12635 393
mvanendert 2:b3eddbd12635 394
mvanendert 2:b3eddbd12635 395
mvanendert 2:b3eddbd12635 396
mvanendert 2:b3eddbd12635 397
mvanendert 2:b3eddbd12635 398
mvanendert 2:b3eddbd12635 399
mvanendert 2:b3eddbd12635 400
mvanendert 2:b3eddbd12635 401
mvanendert 2:b3eddbd12635 402
mvanendert 2:b3eddbd12635 403
mvanendert 2:b3eddbd12635 404
mvanendert 2:b3eddbd12635 405
mvanendert 2:b3eddbd12635 406
mvanendert 2:b3eddbd12635 407
mvanendert 2:b3eddbd12635 408
mvanendert 2:b3eddbd12635 409
mvanendert 2:b3eddbd12635 410
mvanendert 2:b3eddbd12635 411
mvanendert 1:2b6bdf677573 412 /*switch (side)
mvanendert 1:2b6bdf677573 413 {
mvanendert 1:2b6bdf677573 414 case "Front":
mvanendert 1:2b6bdf677573 415 switch (orientation)
mvanendert 1:2b6bdf677573 416 {
mvanendert 1:2b6bdf677573 417 case "Left":
mvanendert 1:2b6bdf677573 418 glcd.locate(0,27); //Zet de cursor op X = 0 & Y = 10
mvanendert 1:2b6bdf677573 419 glcd.printf("Front Left");
mvanendert 1:2b6bdf677573 420 break;
mvanendert 1:2b6bdf677573 421
mvanendert 1:2b6bdf677573 422 case "Right":
mvanendert 1:2b6bdf677573 423 glcd.locate(0,27); //Zet de cursor op X = 0 & Y = 10
mvanendert 1:2b6bdf677573 424 glcd.printf("Front Right");
mvanendert 1:2b6bdf677573 425 break;
mvanendert 1:2b6bdf677573 426
mvanendert 1:2b6bdf677573 427 case "Down":
mvanendert 1:2b6bdf677573 428 glcd.locate(0,27); //Zet de cursor op X = 0 & Y = 10
mvanendert 1:2b6bdf677573 429 glcd.printf("Front Down");
mvanendert 1:2b6bdf677573 430 break;
mvanendert 1:2b6bdf677573 431
mvanendert 1:2b6bdf677573 432 case "Up":
mvanendert 1:2b6bdf677573 433 glcd.locate(0,27); //Zet de cursor op X = 0 & Y = 10
mvanendert 1:2b6bdf677573 434 glcd.printf("Front Up");
mvanendert 1:2b6bdf677573 435 break;
mvanendert 1:2b6bdf677573 436 }
mvanendert 1:2b6bdf677573 437 break;
mvanendert 2:b3eddbd12635 438
mvanendert 1:2b6bdf677573 439
mvanendert 1:2b6bdf677573 440 case "Back":
mvanendert 1:2b6bdf677573 441 switch (orientation)
mvanendert 1:2b6bdf677573 442 {
mvanendert 1:2b6bdf677573 443 case "Left":
mvanendert 1:2b6bdf677573 444 glcd.locate(0,27); //Zet de cursor op X = 0 & Y = 10
mvanendert 1:2b6bdf677573 445 glcd.printf("Back Left");
mvanendert 1:2b6bdf677573 446 break;
mvanendert 1:2b6bdf677573 447
mvanendert 1:2b6bdf677573 448 case "Right":
mvanendert 1:2b6bdf677573 449 glcd.locate(0,27); //Zet de cursor op X = 0 & Y = 10
mvanendert 1:2b6bdf677573 450 glcd.printf("Back Right");
mvanendert 1:2b6bdf677573 451 break;
mvanendert 1:2b6bdf677573 452
mvanendert 1:2b6bdf677573 453 case "Down":
mvanendert 1:2b6bdf677573 454 glcd.locate(0,27); //Zet de cursor op X = 0 & Y = 10
mvanendert 1:2b6bdf677573 455 glcd.printf("Back Down");
mvanendert 1:2b6bdf677573 456 break;
mvanendert 1:2b6bdf677573 457
mvanendert 1:2b6bdf677573 458 case "Up":
mvanendert 1:2b6bdf677573 459 glcd.locate(0,27); //Zet de cursor op X = 0 & Y = 10
mvanendert 1:2b6bdf677573 460 glcd.printf("Back Up");
mvanendert 1:2b6bdf677573 461 break;
mvanendert 1:2b6bdf677573 462 }
mvanendert 1:2b6bdf677573 463 break;
mvanendert 2:b3eddbd12635 464 } */