def enable(ID):
return servos.enable_bot(ID)
import servo_functions as servo
if __name__ == "__main__":
servo.enable_port()
print("Enabling Torque on All Servos !!")
servo.enable_bot(6)
servo.enable_bot(8)
servo.enable_bot(12)
servo.enable_bot(15)
servo.enable_bot(17)
servo.enable_bot(10)
while True:
id = int(raw_input("Enter Motor ID:"))
tq = servo.read_load(id, 1)
Torque_precent = 0.0
if (tq < 1023):
Torque_precent = float(tq) / 1023 * 100
else:
Torque_precent = float(tq - 1023) / 1023 * 100
print("Torque Precentage:", Torque_precent)
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)