hisyam fs / Mbed 2 deprecated Test_servo

Ngetes

Dependencies:   mbed

main.cpp

Committer:
hisyamfs
Date:
2018-08-31
Revision:
1:2759fc78aa04
Parent:
0:23b97841e8dc
Child:
2:f07401343541

File content as of revision 1:2759fc78aa04:

#include "mbed.h"
#include "AX12.h"

int kosong1, kosong2;
Serial pc(USBTX, USBRX);
int deg1 = 0;
int deg2 = deg1+10;
int id1 = 6;
int id2 = 11;

int main()
{
    AX12 servo1(PC_6, PC_7, PC_8, id1, 1000000); // tx, rx, tx_enable, servo ID, baud rate
//    AX12 servo2(PC_6, PC_7, PC_8, id2, 1000000);
    
    while (1) 
    {        
       servo1.SetTorqueEnable(0);
       pc.printf("TEst \n");
       wait(0.5);
    }    
}