Michiel Van Endert / Mbed 2 deprecated DataAquisitieMisan

Project DataAquisitie

Dependencies:   LM75B MMA7660 Servo mbed

Fork of analogintest3 by Peter Mertens

main.cpp@5:30cf038ccbdf, 2015-05-19 (annotated)

Committer:
mvanendert
Date:
Tue May 19 12:14:56 2015 +0000
Revision:
5:30cf038ccbdf
Parent:
4:9d2e6381b6c5 
Misan

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