Elevator / Mbed 2 deprecated Elevator

The first code

Dependencies:   mbed Motor

main.cpp@4:059832a0c7b9, 2015-02-12 (annotated)

Committer:
m172886
Date:
Thu Feb 12 16:42:25 2015 +0000
Revision:
4:059832a0c7b9
Parent:
3:7b0316e7cabc
Child:
5:47d6ae63a1a3
hey

Who changed what in which revision?

UserRevisionLine numberNew contents of line
170198 0:2f38be5ec9dc 1 #include "mbed.h"
170198 1:a46a378d5561 2 #include "time.h"
m172886 3:7b0316e7cabc 3 #include "Motor.h"
170198 0:2f38be5ec9dc 4
170198 0:2f38be5ec9dc 5 AnalogIn ain(p17);
170198 1:a46a378d5561 6 Serial pc(USBTX, USBRX);
170198 1:a46a378d5561 7 Timer t;
m172886 3:7b0316e7cabc 8 Motor m(p25,p27,p28);
m172886 4:059832a0c7b9 9 float error = Desired_distance - height;
m172886 3:7b0316e7cabc 10 float height;
170198 2:559b5507c580 11
m172886 3:7b0316e7cabc 12 float Lower_distance = 7; // lower floor in inches.
m172886 3:7b0316e7cabc 13
m172886 3:7b0316e7cabc 14 float Upper_distance = 26; // upper floor in inches
m172886 3:7b0316e7cabc 15
m172886 3:7b0316e7cabc 16 float Desired_distance = Lower_distance; // start low
170198 1:a46a378d5561 17 int main(void)
170198 1:a46a378d5561 18 {
170198 1:a46a378d5561 19 t.reset(); //reset timer to zero
170198 1:a46a378d5561 20 t.start(); //start timer data timestamp
m172886 3:7b0316e7cabc 21 m.speed(0.0);
170198 1:a46a378d5561 22 while(1)
170198 1:a46a378d5561 23 {
m172886 3:7b0316e7cabc 24 height = 193.125176919012*(pow(ain.read(),3))-353.927724612106*(pow(ain.read(),2))+218.749286479109*(ain.read())-23.2532105680997;
170198 1:a46a378d5561 25 pc.baud(9600);
170198 1:a46a378d5561 26 pc.format(7,SerialBase::None,1);
m172886 3:7b0316e7cabc 27 pc.printf("%f,",height);
m172886 3:7b0316e7cabc 28 pc.printf("%f,",ain.read()); //this prints the voltage
m172886 3:7b0316e7cabc 29 pc.printf("%f",t.read());
170198 1:a46a378d5561 30 pc.printf("\n");
m172886 4:059832a0c7b9 31 if (error > 0)
m172886 4:059832a0c7b9 32 {
m172886 4:059832a0c7b9 33 m.speed(0.5);
m172886 4:059832a0c7b9 34 }
m172886 4:059832a0c7b9 35 else(error<0)
m172886 4:059832a0c7b9 36 {
m172886 4:059832a0c7b9 37 m.speed(-0.5)
m172886 4:059832a0c7b9 38 }
170198 1:a46a378d5561 39 }
m172886 4:059832a0c7b9 40
170198 0:2f38be5ec9dc 41 }