def init():
return servos.enable_port()
import servo_functions as servo
if __name__ == "__main__":
servo.enable_port()
while True:
id = input("Enter Bot ID:")
print(servo.read_torque(id)
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)