def setAngle(ID, Angle): #( _ , 0-1023) return servos.write_pos(ID, Angle)
def writeRawAngle(ID, Angle): #( _ , 0-1023) return servos.write_pos(ID, Angle)
import servo_functions as servos import constants if __name__ == '__main__': # Open port print("Opening Port!") if servos.enable_port(): #take Id for the Servos as Input botId = int(input("Enter The Bot ID(Enter -1 to Quit):")) print("Enabling Torque on the Servo Id [%d]",botId) servos.enable_bot(botId) while True: exAngle = int(input("Enter the Servo Angle(0-1023)")) servos.set_speed(botId,150) servos.write_pos(botId,exAngle) print("------------------------------------------------------------------") print("\n[+] Disabling") servos.closePort(port_num)