Interactive Device Design / Mbed 2 deprecated HW5

KL25Z firmware. Responsible for activating the servo based on input from the nRF51822.

Dependencies:   Servo mbed

Fork of HW5_Servo by StepSense

main.cpp@0:9898eeeb7143, 2014-11-07 (annotated)

Committer:
sunitav
Date:
Fri Nov 07 04:08:42 2014 +0000
Revision:
0:9898eeeb7143
Child:
1:19dd18051447
servo and photoresistors

Who changed what in which revision?

UserRevisionLine numberNew contents of line
sunitav 0:9898eeeb7143 1 // Hello World to sweep a servo through its full range
sunitav 0:9898eeeb7143 2
sunitav 0:9898eeeb7143 3 #include "mbed.h"
sunitav 0:9898eeeb7143 4 #include "Servo.h"
sunitav 0:9898eeeb7143 5
sunitav 0:9898eeeb7143 6 Servo myservo(D2); //change digital pin here
sunitav 0:9898eeeb7143 7 bool ServoLogic=true;
sunitav 0:9898eeeb7143 8 AnalogIn pin0(A0);
sunitav 0:9898eeeb7143 9 AnalogIn pin1(A1);
sunitav 0:9898eeeb7143 10 AnalogIn pin2(A2);
sunitav 0:9898eeeb7143 11 AnalogIn pin3(A3);
sunitav 0:9898eeeb7143 12 float photoresistors[4];
sunitav 0:9898eeeb7143 13 #define THRESHOLD .001
sunitav 0:9898eeeb7143 14 int counter = 0;
sunitav 0:9898eeeb7143 15
sunitav 0:9898eeeb7143 16 int main() {
sunitav 0:9898eeeb7143 17 myservo.calibrate(.0006, 75.0);
sunitav 0:9898eeeb7143 18 while(1){
sunitav 0:9898eeeb7143 19 //recieve_data(ServoLogic);
sunitav 0:9898eeeb7143 20 if (ServoLogic)
sunitav 0:9898eeeb7143 21 {
sunitav 0:9898eeeb7143 22 float o = .1;
sunitav 0:9898eeeb7143 23 myservo = o;
sunitav 0:9898eeeb7143 24 }
sunitav 0:9898eeeb7143 25 else{
sunitav 0:9898eeeb7143 26 float f= 0.28;
sunitav 0:9898eeeb7143 27 myservo = f;
sunitav 0:9898eeeb7143 28 }
sunitav 0:9898eeeb7143 29
sunitav 0:9898eeeb7143 30 photoresistors[0] = pin0.read();
sunitav 0:9898eeeb7143 31 photoresistors[1] = pin1.read();
sunitav 0:9898eeeb7143 32 photoresistors[2] = pin2.read();
sunitav 0:9898eeeb7143 33 photoresistors[3] = pin3.read();
sunitav 0:9898eeeb7143 34
sunitav 0:9898eeeb7143 35 for(int p=0; p<3; p += 1)
sunitav 0:9898eeeb7143 36 {
sunitav 0:9898eeeb7143 37 if ((photoresistors[p]) < THRESHOLD)
sunitav 0:9898eeeb7143 38 counter=counter++;
sunitav 0:9898eeeb7143 39 //
sunitav 0:9898eeeb7143 40 }
sunitav 0:9898eeeb7143 41
sunitav 0:9898eeeb7143 42 //send_data(counter)
sunitav 0:9898eeeb7143 43 wait(.2);
sunitav 0:9898eeeb7143 44 }
sunitav 0:9898eeeb7143 45 }