KRTMI 2019 / Mbed 2 deprecated Inverse_Kine_Lengan3

Boleh bisa langsung dicoba, tap servo base belum dikalibrasi

Dependencies:   mbed Servo

main.cpp

Committer:
D4n1elR
Date:
2019-05-12
Revision:
6:38fb058f5827
Parent:
5:832f5a808578
Child:
7:32fab84c1877

File content as of revision 6:38fb058f5827:

#include "mbed.h"
#include "Servo.h"
#include "Motor.h"

/* Nama servo
    4
    3
  21 22
    1 */
    
//PwmOut servo1(PB_7);
Servo servo1(PB_7);
Serial pc(USBTX,USBRX);

int main() {
    pc.baud(9600);
    pc.printf("test begin\n");
    
    //tes
    servo1.calibrate(0.001,120);
    //servo2.calibrate(0.001,150);
    float f=0;
    //servo2.write(1.0);
    while(1){
        servo1.position((f-51)*1.14);
        //servo1.pulsewidth_ms(f);    //pc.printf("input (1..10) bakal dijadiin persen : ");
        pc.printf("input (1..360) bakal dijadiin derajat : ");
        pc.scanf("%f",&f);
        
        //pc.printf("\n");
//        float f = (float)n/(float)10;
        wait_ms(20);
        pc.printf("%f\n",servo1.read());
        //pc.printf(" \n");
        
    }
}