import super_servo_functions as super
if __name__ == "__main__":
super.init()
super.enableAll()
while True:
x = float(raw_input("Enter Target x:"))
y = float(raw_input("Enter Target y:"))
z = float(raw_input("Enter Target z:"))
a0, a1, a2, a3, a4, isPossible = super.processIK(x, y, z)
super.setSpeedAll(120)
if isPossible:
print("Output Angles are:", a0, a1, a2, a3, a4)
a = raw_input("Enter Any Key to Move to Angles ")
super.move2angle(a0, a1, a2, a3, a4)
else:
pass
import servo_functions as servos import constants import fk3 as fk import inverseK as ik import time import super_servo_functions as super if __name__=="__main__": super.init() super.enableAll() super.setSpeedAll(200) FINAL_X =9.5 FINAL_Y = -8.9 INITITAL_Z = -7.5 FINAL_Z = -11 while(True): # super.move2angle(0,-90,90,0,0) # time.sleep(1) # super.move2pos(, FINAL_Y+4, 0) # time.sleep(1) # super.move2angle(0,-90,90,0,0) # time.sleep(1) super.move2angle(0,-90,90,0,0) time.sleep(1)
import super_servo_functions as super
import time
if __name__ == "__main__":
super.init()
super.enableAll()
super.setSpeedAll(250)
c2 = 115.461
c1 = -32.1
itr = 0
while itr < 16:
# six = float(raw_input("two?"))
# Nine = float(raw_input("one?"))
# raw_input("")
super.setTransformedAngle(2, c2)
super.setTransformedAngle(1, c1)
if (itr <= 6):
time.sleep(0.7)
else:
time.sleep(0.2)
itr += 1
c2 -= 1
c1 += 1.5
# super.move2angle(0,-90,90,0,0)
# super.move2standard()
import super_servo_functions as super
if __name__=="__main__":
super.init()
super.enableAll()
super.setSpeedAll(130)
super.setAngles_rev(0,-90,90,0,0)