def main(args):
rospy.init_node('GummiArm', anonymous=True)
r = rospy.Rate(60)
gummi = Gummi()
print('WARNING: Moving joints sequentially to equilibrium positions.')
gummi.doGradualStartup()
print('WARNING: Moving to resting pose, hold arm!')
rospy.sleep(1)
gummi.goRestingPose(True)
for i in range(0,400):
gummi.goRestingPose(False)
r.sleep()
#for i in range(0,100):
# gummi.forearmRoll.servoTo(pi/2)
# r.sleep()
gummi.setCollisionResponses(False, False, False, False, False)
print("GummiArm is live!")
while not rospy.is_shutdown():
if gummi.teleop == 0:
gummi.doUpdate()
gummi.publishJointState()
r.sleep()
def main(args):
record = False
if rospy.get_param("gummi/recording") == 1:
record = True
fileNameBase = rospy.get_param("gummi/name_base_recording")
print("WARNING: Will record in files with base: " + fileNameBase + ".")
rospy.init_node("GummiArm", anonymous=True)
r = rospy.Rate(100)
gummi = Gummi()
gummi.setMaxLoads(10, 10, 10, 10, 10)
print("WARNING: Moving joints sequentially to equilibrium positions.")
gummi.doGradualStartup()
print("WARNING: Moving to resting pose, hold arm!")
rospy.sleep(3)
for i in range(0, 400):
gummi.goRestingPose()
r.sleep()
print("GummiArm is live!")
if record:
print("Recording!")
gummi.prepareRecording(fileNameBase)
gummi.startRecording()
while not rospy.is_shutdown():
gummi.publishJointState()
r.sleep()
def main(args):
rospy.init_node('GummiArm', anonymous=False)
# anonymous=False because doesn't look like a good idea two GummiArm nodes...
r = rospy.Rate(40)
# Tried 100 and rostopic hz said it was working!
# With 600 the elbow PID controller went crazy!
gummi = Gummi()
rospy.logwarn(
'Moving joints sequentially to startup equilibrium positions.')
gummi.doGradualStartup()
# gummi.testLimits()
rospy.logwarn('Moving to resting pose, hold arm!')
rospy.sleep(1)
gummi.goRestingPose(True)
for i in range(0, 400):
gummi.goRestingPose(False)
r.sleep()
gummi.setCollisionResponses(shoulder_yaw=False,
shoulder_roll=False,
shoulder_pitch=False,
elbow=False)
rospy.loginfo("GummiArm is live!")
# name = ['shoulder_yaw','shoulder_roll','shoulder_pitch','upperarm_roll','elbow','forearm_roll','wrist_pitch']
# effort = [0.5,0.5,0.5,100,0.5,100,0.5]
# class Msg:
# def __init__(self, name, effort):
# self.name = name
# self.effort = effort
# msgs = []
# for i, j in zip(name, effort):
# msgs.append(Msg(i, j))
# raw_input('press enter')
# gummi.setCocontraction(msgs)
# gummi.servoTo()
while not rospy.is_shutdown():
try:
rospy.has_param("/dynamixel_manager_arm/namespace")
# rospy.has_param("/dynamixel_manager_arm/namespace") is a way to verify if the manager is running
if gummi.teleop == 0 and gummi.velocity_control == 0:
gummi.doUpdate()
gummi.publishJointState()
r.sleep()
except:
rospy.signal_shutdown(
"gummi dynamixel manager seems to be dead... exiting!")
def main(args):
rospy.init_node('GummiArm', anonymous=False)
# anonymous=False because doesn't look like a good idea two GummiArm nodes...
r = rospy.Rate(60)
# Tried 100 and rostopic hz said it was working!
# With 600 the elbow PID controller went crazy!
gummi = Gummi()
rospy.logwarn(
'Moving joints sequentially to startup equilibrium positions.')
gummi.doGradualStartup()
rospy.logwarn('Moving to resting pose, hold arm!')
rospy.sleep(1)
gummi.goRestingPose(True)
for i in range(0, 400):
gummi.goRestingPose(False)
r.sleep()
#for i in range(0,100):
# gummi.forearmRoll.servoTo(pi/2)
# r.sleep()
gummi.setCollisionResponses(shoulder_yaw=False,
shoulder_roll=False,
shoulder_pitch=False,
elbow=False)
rospy.loginfo("GummiArm is live!")
while not rospy.is_shutdown():
try:
rospy.has_param("/dynamixel_manager_arm/namespace")
# rospy.has_param("/dynamixel_manager_arm/namespace") is a way to verify if the manager is running
if gummi.teleop == 0 and gummi.velocity_control == 0:
gummi.doUpdate()
gummi.publishJointState()
r.sleep()
except:
rospy.signal_shutdown(
"gummi dynamixel manager seems to be dead... exiting!")
