y w
/
servo_controll_test
Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
main.cpp@0:7460a219f05f, 2013-12-14 (annotated)
- Committer:
- nekoyyy
- Date:
- Sat Dec 14 09:52:37 2013 +0000
- Revision:
- 0:7460a219f05f
- Child:
- 1:757f571d9e14
????????
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| nekoyyy | 0:7460a219f05f | 1 | #include "mbed.h" |
| nekoyyy | 0:7460a219f05f | 2 | |
| nekoyyy | 0:7460a219f05f | 3 | Serial pc(USBTX, USBRX); // tx, rx |
| nekoyyy | 0:7460a219f05f | 4 | PwmOut servo1(p21); |
| nekoyyy | 0:7460a219f05f | 5 | PwmOut servo2(p22); |
| nekoyyy | 0:7460a219f05f | 6 | PwmOut servo3(p23); |
| nekoyyy | 0:7460a219f05f | 7 | |
| nekoyyy | 0:7460a219f05f | 8 | float p = 0.049f; |
| nekoyyy | 0:7460a219f05f | 9 | float q=0.097f; |
| nekoyyy | 0:7460a219f05f | 10 | float r=0.045f; |
| nekoyyy | 0:7460a219f05f | 11 | |
| nekoyyy | 0:7460a219f05f | 12 | int main() { |
| nekoyyy | 0:7460a219f05f | 13 | pc.printf("Press q e a d z c\n"); |
| nekoyyy | 0:7460a219f05f | 14 | servo1=p; |
| nekoyyy | 0:7460a219f05f | 15 | servo2=q; |
| nekoyyy | 0:7460a219f05f | 16 | servo3=r; |
| nekoyyy | 0:7460a219f05f | 17 | while(1) { |
| nekoyyy | 0:7460a219f05f | 18 | char c = pc.getc(); |
| nekoyyy | 0:7460a219f05f | 19 | if(c == 'q'){ |
| nekoyyy | 0:7460a219f05f | 20 | p += 0.001f; |
| nekoyyy | 0:7460a219f05f | 21 | servo1=p; |
| nekoyyy | 0:7460a219f05f | 22 | } |
| nekoyyy | 0:7460a219f05f | 23 | |
| nekoyyy | 0:7460a219f05f | 24 | if(c == 'e'){ |
| nekoyyy | 0:7460a219f05f | 25 | p -= 0.001f; |
| nekoyyy | 0:7460a219f05f | 26 | servo1 = p; |
| nekoyyy | 0:7460a219f05f | 27 | } if(c == 'a'){ |
| nekoyyy | 0:7460a219f05f | 28 | q += 0.001f; |
| nekoyyy | 0:7460a219f05f | 29 | servo2=q; |
| nekoyyy | 0:7460a219f05f | 30 | } |
| nekoyyy | 0:7460a219f05f | 31 | |
| nekoyyy | 0:7460a219f05f | 32 | if(c == 'd'){ |
| nekoyyy | 0:7460a219f05f | 33 | q -= 0.001f; |
| nekoyyy | 0:7460a219f05f | 34 | servo2 = q; |
| nekoyyy | 0:7460a219f05f | 35 | } if(c == 'z'){ |
| nekoyyy | 0:7460a219f05f | 36 | r += 0.001f; |
| nekoyyy | 0:7460a219f05f | 37 | servo3=r; |
| nekoyyy | 0:7460a219f05f | 38 | } |
| nekoyyy | 0:7460a219f05f | 39 | |
| nekoyyy | 0:7460a219f05f | 40 | if(c == 'c'){ |
| nekoyyy | 0:7460a219f05f | 41 | r -= 0.001f; |
| nekoyyy | 0:7460a219f05f | 42 | servo3=r; |
| nekoyyy | 0:7460a219f05f | 43 | } |
| nekoyyy | 0:7460a219f05f | 44 | |
| nekoyyy | 0:7460a219f05f | 45 | pc.printf("p=%f\n", p); |
| nekoyyy | 0:7460a219f05f | 46 | |
| nekoyyy | 0:7460a219f05f | 47 | pc.printf("q=%f\n", q); |
| nekoyyy | 0:7460a219f05f | 48 | |
| nekoyyy | 0:7460a219f05f | 49 | pc.printf("r=%f\n", r); |
| nekoyyy | 0:7460a219f05f | 50 | } |
| nekoyyy | 0:7460a219f05f | 51 | } |