diff --git a/script/RobotSC.py b/script/RobotSC.py index 5e04f2b..b675289 100644 --- a/script/RobotSC.py +++ b/script/RobotSC.py @@ -45,12 +45,9 @@ class jf6(ReadonlyRegisterBase): class jfc(ReadonlyRegisterBase): def doRead(self): if robot.joint_forces == None: - print "*", return float('NaN') if robot.powered == False: - print ".", return float('NaN') - 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)