Elevator
/
Elevator
The first code
main.cpp@3:7b0316e7cabc, 2015-02-12 (annotated)
- Committer:
- m172886
- Date:
- Thu Feb 12 16:31:56 2015 +0000
- Revision:
- 3:7b0316e7cabc
- Parent:
- 2:559b5507c580
- Child:
- 4:059832a0c7b9
hey
Who changed what in which revision?
User | Revision | Line number | New 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 | 3:7b0316e7cabc | 9 | float height; |
170198 | 2:559b5507c580 | 10 | |
m172886 | 3:7b0316e7cabc | 11 | float Lower_distance = 7; // lower floor in inches. |
m172886 | 3:7b0316e7cabc | 12 | |
m172886 | 3:7b0316e7cabc | 13 | float Upper_distance = 26; // upper floor in inches |
m172886 | 3:7b0316e7cabc | 14 | |
m172886 | 3:7b0316e7cabc | 15 | float Desired_distance = Lower_distance; // start low |
170198 | 1:a46a378d5561 | 16 | int main(void) |
170198 | 1:a46a378d5561 | 17 | { |
170198 | 1:a46a378d5561 | 18 | t.reset(); //reset timer to zero |
170198 | 1:a46a378d5561 | 19 | t.start(); //start timer data timestamp |
m172886 | 3:7b0316e7cabc | 20 | m.speed(0.0); |
170198 | 1:a46a378d5561 | 21 | while(1) |
170198 | 1:a46a378d5561 | 22 | { |
m172886 | 3:7b0316e7cabc | 23 | height = 193.125176919012*(pow(ain.read(),3))-353.927724612106*(pow(ain.read(),2))+218.749286479109*(ain.read())-23.2532105680997; |
170198 | 1:a46a378d5561 | 24 | pc.baud(9600); |
170198 | 1:a46a378d5561 | 25 | pc.format(7,SerialBase::None,1); |
m172886 | 3:7b0316e7cabc | 26 | pc.printf("%f,",height); |
m172886 | 3:7b0316e7cabc | 27 | pc.printf("%f,",ain.read()); //this prints the voltage |
m172886 | 3:7b0316e7cabc | 28 | pc.printf("%f",t.read()); |
170198 | 1:a46a378d5561 | 29 | pc.printf("\n"); |
m172886 | 3:7b0316e7cabc | 30 | |
170198 | 1:a46a378d5561 | 31 | } |
170198 | 0:2f38be5ec9dc | 32 | } |