stuff

Dependencies:   mbed Servo Motor

Committer:
m226072
Date:
Tue Oct 15 18:07:33 2019 +0000
Revision:
4:439279a72ef4
Parent:
3:e3b0e591e976
LED's added

Who changed what in which revision?

UserRevisionLine numberNew contents of line
m226072 3:e3b0e591e976 1 #include "mbed.h"
m226072 3:e3b0e591e976 2 #include "Motor.h"
m226072 3:e3b0e591e976 3 #include "Servo.h"
m226072 2:5b599e8e7e8c 4
m226072 2:5b599e8e7e8c 5
m226072 3:e3b0e591e976 6 DigitalIn switches [5] = {p15, p16, p17, p18, p19};
m226072 4:439279a72ef4 7 DigitalOut lights [5] = {p10, p11, p12, p13, p14};
m226072 3:e3b0e591e976 8 Servo gun (p24);
m226072 3:e3b0e591e976 9 Servo spin (p23);
m226072 3:e3b0e591e976 10 Motor jeff (p26, p29, p30);
m226072 3:e3b0e591e976 11 int h [5];
m226072 3:e3b0e591e976 12 float i;
m226072 3:e3b0e591e976 13
m226072 3:e3b0e591e976 14 int main ()
m226072 3:e3b0e591e976 15 {
m226072 3:e3b0e591e976 16 i=0.5;
m226072 3:e3b0e591e976 17 while (1) {
m226072 3:e3b0e591e976 18 h [0] = switches [0];
m226072 3:e3b0e591e976 19 h [1] = switches [1];
m226072 3:e3b0e591e976 20 h [2] = switches [2];
m226072 3:e3b0e591e976 21 h [3] = switches [3];
m226072 3:e3b0e591e976 22 h [4] = switches [4];
m226072 2:5b599e8e7e8c 23
m226072 3:e3b0e591e976 24 // switch 1 on and 2 off
m226072 3:e3b0e591e976 25 if ((h [0] == 1) && (h [1] ==0)) {
m226072 3:e3b0e591e976 26 jeff.speed (0.5);
m226072 4:439279a72ef4 27 lights[0] = 1;
m226072 3:e3b0e591e976 28 }
m226072 3:e3b0e591e976 29 // switch 1 off and 2 on
m226072 3:e3b0e591e976 30 if ((h [0] == 0) && (h [1] == 1)) {
m226072 3:e3b0e591e976 31 jeff.speed (-0.5);
m226072 4:439279a72ef4 32 lights[1] = 1;
m226072 3:e3b0e591e976 33 }
m226072 3:e3b0e591e976 34 // switch 1 off and 2 off
m226072 4:439279a72ef4 35 if (((h [0] == 0) && (h [1] == 0)) || ((h [0] == 1) && (h [1] == 1)) ) {
m226072 3:e3b0e591e976 36 jeff.speed (0);
m226072 4:439279a72ef4 37 lights[2] = 1;
m226072 3:e3b0e591e976 38 }
m226072 3:e3b0e591e976 39 // switch 3 on and 4 off
m226072 3:e3b0e591e976 40 if ((h [2] == 1) && (h [3] ==0)) {
m226072 3:e3b0e591e976 41 if (i>1.0) {
m226072 3:e3b0e591e976 42 i=1.0;
m226072 3:e3b0e591e976 43 }
m226072 3:e3b0e591e976 44 spin = i;
m226072 3:e3b0e591e976 45 wait (0.1);
m226072 3:e3b0e591e976 46 i = i + 0.02;
m226072 4:439279a72ef4 47 lights[3] = 1;
m221770 0:54b247669e8c 48
m226072 3:e3b0e591e976 49 }
m226072 3:e3b0e591e976 50 // switch 3 off and 4 on
m226072 3:e3b0e591e976 51 if ((h [2] == 0) && (h [3] ==1)) {
m226072 3:e3b0e591e976 52 if (i<0.0) {
m226072 3:e3b0e591e976 53 i=0.0;
m226072 3:e3b0e591e976 54 }
m226072 3:e3b0e591e976 55 spin = i;
m226072 3:e3b0e591e976 56 wait (0.1);
m226072 3:e3b0e591e976 57 i = i - 0.02;
m226072 4:439279a72ef4 58 lights[4] = 1;
m226072 3:e3b0e591e976 59 }
m226072 3:e3b0e591e976 60 // switch 3 off and 4 off
m226072 3:e3b0e591e976 61 if (((h [2] == 0) && (h [3] ==0))|| ((h [2] == 1) && (h [3] ==1))) {
m226072 3:e3b0e591e976 62 spin = i ;
m226072 3:e3b0e591e976 63 }
m226072 3:e3b0e591e976 64 // switch 5 on
m226072 3:e3b0e591e976 65 if (h [4] == 1) {
m226072 3:e3b0e591e976 66 gun = 1.0;
m226072 3:e3b0e591e976 67 wait (1.0);
m226072 3:e3b0e591e976 68 gun = 0.0;
m226072 3:e3b0e591e976 69 wait (1.0);
m226072 3:e3b0e591e976 70 }
m226072 3:e3b0e591e976 71
m226072 3:e3b0e591e976 72
m226072 3:e3b0e591e976 73
m226072 3:e3b0e591e976 74 }
m226072 3:e3b0e591e976 75 }