Example #1
0
 def srvMotorSetRotate(self, params):
     # print(params)
     cur_position = Lepi.motor_get_current_position(params.port)
     # print(cur_position,params.value*2+cur_position)
     Lepi.motor_set_target_position(params.port,
                                    params.value * 2 + cur_position)
     return SetInt32Response(params.port, params.value)
Example #2
0
 def srvMotorGetPosition(self, params):
     # print(params)
     position = Lepi.motor_get_current_position(params.port)
     return GetInt32Response(position)
Example #3
0
	def srvMotorGetPosition(self,msg):
		print(msg)
		position = Lepi.motor_get_current_position(msg.port)
		return GetInt32Response(position)
Example #4
0
	def cbMotorGetPosition(self,msg):
		print(msg)
		position = Lepi.motor_get_current_position(msg.port)
		return MotorGetPositionResponse(position)