def test_get_key():
keyboard = Keyboard()
key_zero = Key(0)
key_one = Key(1)
key_two = Key(2)
keyboard.add_key(key_zero)
keyboard.add_key(key_one)
keyboard.add_key(key_two)
assert_true(keyboard.get_key(1) == key_one)
self.rosTask(3,1)
self.state.current = max(3.0,self.state.current)
if action and ord(action)>=ord('2') and ord(action)<=ord('8'):
self.rosTask(int(self.state.current),ord(action)-ord('0'))
return done, json.dumps(data,cls=JEnc)
if __name__ == '__main__':
rospy.init_node('Challenge_State')
kb = Keyboard()
mon = SrcState()
mon.init()
kb.init()
try:
rate = rospy.Rate(1) # 1 hz
while not rospy.is_shutdown():
ch = kb.get_key()
done, data = mon.loop(ch)
if done:
rospy.signal_shutdown("Done")
kb.loginfo(data)
rate.sleep()
except rospy.ROSInterruptException:
pass
finally:
kb.fini()
mon.fini()
rospy.loginfo("Exiting")
#lfootWorld = self.tfBuffer.lookup_transform('world', LEFT_FOOT_FRAME_NAME, rospy.Time())
