LAB09_Oppgave3

Dependencies:   mbed

Fork of LAB09_Oppgave2 by EL-POM1001

Committer:
madmonkeyman82
Date:
Thu Oct 29 11:18:45 2015 +0000
Revision:
1:89eecafc3c83
Parent:
0:8f25416dc51e
first;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
rlanghbv 0:8f25416dc51e 1 #include "mbed.h"
rlanghbv 0:8f25416dc51e 2
rlanghbv 0:8f25416dc51e 3 DigitalOut userLed(PA_5);
rlanghbv 0:8f25416dc51e 4
rlanghbv 0:8f25416dc51e 5 DigitalOut Vcc(PA_0);
rlanghbv 0:8f25416dc51e 6 AnalogIn aInn(PA_1);
rlanghbv 0:8f25416dc51e 7 DigitalOut Gnd(PA_4);
rlanghbv 0:8f25416dc51e 8
rlanghbv 0:8f25416dc51e 9 PwmOut servoMotor(PA_7);
rlanghbv 0:8f25416dc51e 10 DigitalOut direction(PA_6);
rlanghbv 0:8f25416dc51e 11
rlanghbv 0:8f25416dc51e 12 int main()
rlanghbv 0:8f25416dc51e 13 {
rlanghbv 0:8f25416dc51e 14 servoMotor.period(.01);
rlanghbv 0:8f25416dc51e 15
rlanghbv 0:8f25416dc51e 16 Vcc=1;
rlanghbv 0:8f25416dc51e 17 Gnd=0;
madmonkeyman82 1:89eecafc3c83 18 direction=0;
madmonkeyman82 1:89eecafc3c83 19
rlanghbv 0:8f25416dc51e 20 while(1) {
madmonkeyman82 1:89eecafc3c83 21 float pot = aInn.read();
madmonkeyman82 1:89eecafc3c83 22 if(pot > 0.45f && pot < 0.55f)
madmonkeyman82 1:89eecafc3c83 23 {
madmonkeyman82 1:89eecafc3c83 24 direction=0;
madmonkeyman82 1:89eecafc3c83 25 servoMotor = 0;
madmonkeyman82 1:89eecafc3c83 26 printf("NULL Pot er: %f Servo er: %f\n\r",pot, servoMotor.read());
madmonkeyman82 1:89eecafc3c83 27 }
madmonkeyman82 1:89eecafc3c83 28 else if (pot < 0.45f)
madmonkeyman82 1:89eecafc3c83 29 {
madmonkeyman82 1:89eecafc3c83 30 direction = 0;
madmonkeyman82 1:89eecafc3c83 31 userLed = 0;
madmonkeyman82 1:89eecafc3c83 32 servoMotor = 1-pot*2;
madmonkeyman82 1:89eecafc3c83 33 printf("CCW Pot er: %f Servo er: %f\n\r",pot, servoMotor.read());
madmonkeyman82 1:89eecafc3c83 34 }
madmonkeyman82 1:89eecafc3c83 35 else if (pot > 0.55f)
madmonkeyman82 1:89eecafc3c83 36 {
madmonkeyman82 1:89eecafc3c83 37 direction = 1;
madmonkeyman82 1:89eecafc3c83 38 userLed = 1;
madmonkeyman82 1:89eecafc3c83 39 servoMotor = 2-pot*2;
madmonkeyman82 1:89eecafc3c83 40 printf("CW Pot er: %f Servo er: %f\n\r",pot, servoMotor.read());
madmonkeyman82 1:89eecafc3c83 41 }
rlanghbv 0:8f25416dc51e 42 }
rlanghbv 0:8f25416dc51e 43
rlanghbv 0:8f25416dc51e 44 }