diff --git a/script/RobotSC.py b/script/RobotSC.py index 9ffdc46..2737823 100644 --- a/script/RobotSC.py +++ b/script/RobotSC.py @@ -45,9 +45,12 @@ class jf6(ReadonlyRegisterBase): class jfc(ReadonlyRegisterBase): def doRead(self): if robot.joint_forces == None: + print "*", return None if robot.powered == False: + print ".", return None + print "!", return (robot.joint_forces[1]+74)/4 + (robot.joint_forces[2]+30)/4 + (robot.joint_forces[4]-0.8)/0.2 add_device(jf1(), force = True)