KRTMI 2019
/
Inverse_Kine_Lengan3
Boleh bisa langsung dicoba, tap servo base belum dikalibrasi
main.cpp@3:d1860dee0552, 2019-04-16 (annotated)
- Committer:
- harrymunli
- Date:
- Tue Apr 16 12:57:01 2019 +0000
- Revision:
- 3:d1860dee0552
- Parent:
- 2:34ed8b55eba6
- Child:
- 4:3db9524b9b63
rrr;
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
harrymunli | 0:9dfae2e18414 | 1 | #include "mbed.h" |
harrymunli | 0:9dfae2e18414 | 2 | #include "Servo.h" |
harrymunli | 0:9dfae2e18414 | 3 | #include "Motor.h" |
harrymunli | 0:9dfae2e18414 | 4 | |
harrymunli | 0:9dfae2e18414 | 5 | /* Nama servo |
harrymunli | 0:9dfae2e18414 | 6 | 4 |
harrymunli | 0:9dfae2e18414 | 7 | 3 |
harrymunli | 0:9dfae2e18414 | 8 | 21 22 |
harrymunli | 0:9dfae2e18414 | 9 | 1 */ |
harrymunli | 0:9dfae2e18414 | 10 | |
harrymunli | 3:d1860dee0552 | 11 | Servo servo1(D9); |
harrymunli | 3:d1860dee0552 | 12 | //Servo servo2(PB_6); |
harrymunli | 1:9284c57e84da | 13 | Serial pc(D1, D0); |
harrymunli | 0:9dfae2e18414 | 14 | |
harrymunli | 0:9dfae2e18414 | 15 | int main() { |
harrymunli | 1:9284c57e84da | 16 | pc.baud(9600); |
harrymunli | 1:9284c57e84da | 17 | pc.printf("test begin\n"); |
harrymunli | 0:9dfae2e18414 | 18 | |
harrymunli | 1:9284c57e84da | 19 | //tes |
harrymunli | 3:d1860dee0552 | 20 | servo1.calibrate(0.0003,150); |
harrymunli | 3:d1860dee0552 | 21 | //servo2.calibrate(0.001,150); |
harrymunli | 3:d1860dee0552 | 22 | float f=0.8; |
harrymunli | 3:d1860dee0552 | 23 | //servo2.write(1.0); |
harrymunli | 1:9284c57e84da | 24 | while(1){ |
harrymunli | 3:d1860dee0552 | 25 | servo1.write(f); |
harrymunli | 2:34ed8b55eba6 | 26 | pc.printf("input (1..10) bakal dijadiin persen : "); |
harrymunli | 3:d1860dee0552 | 27 | pc.scanf("%f",&f); |
harrymunli | 2:34ed8b55eba6 | 28 | pc.printf("\n"); |
harrymunli | 2:34ed8b55eba6 | 29 | //float f = (float)n/(float)10; |
harrymunli | 2:34ed8b55eba6 | 30 | pc.printf("%f", servo1.read()); |
harrymunli | 2:34ed8b55eba6 | 31 | pc.printf("\n"); |
harrymunli | 1:9284c57e84da | 32 | } |
harrymunli | 0:9dfae2e18414 | 33 | } |