Closedown

This commit is contained in:
gac-S_Changer
2017-03-01 16:12:30 +01:00
parent dfa9f36979
commit 329d1d91cb

View File

@@ -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)