def setNeckJoystickPos( self, joystickX, joystickY ):
#print "g"
joystickX, joystickY = self.normaliseJoystickData( joystickX, joystickY )
if debug:
print "Right joy",joystickX, joystickY
print self.speed_r*joystickY
brickpibot.set_right_speed(int(self.speed_r*joystickY))
brickpibot.fwd()
self.lastMotionCommandTime = time.time()
def centreNeck( self ):
brickpibot.set_right_speed(0)