Skip to content
Snippets Groups Projects
Commit 0d7d9ea0 authored by ipa-cmm-mn's avatar ipa-cmm-mn Committed by ipa-fxm
Browse files

beautify

parent a7307a87
Branches
Tags
No related merge requests found
...@@ -16,7 +16,7 @@ def driverProg(): ...@@ -16,7 +16,7 @@ def driverProg():
MSG_SET_TOOL_VOLTAGE = 13 MSG_SET_TOOL_VOLTAGE = 13
MSG_SET_ANALOG_OUT = 14 MSG_SET_ANALOG_OUT = 14
MULT_wrench = 10000.0 MULT_wrench = 10000.0
MULT_PAYLOAD = 1000.0 MULT_payload = 1000.0
MULT_jointstate = 10000.0 MULT_jointstate = 10000.0
MULT_time = 1000000.0 MULT_time = 1000000.0
MULT_blend = 1000.0 MULT_blend = 1000.0
...@@ -225,7 +225,7 @@ def driverProg(): ...@@ -225,7 +225,7 @@ def driverProg():
send_out("Received no parameters for setPayload message") send_out("Received no parameters for setPayload message")
end end
payload = params[1] / MULT_PAYLOAD payload = params[1] / MULT_payload
#send_out(payload) #send_out(payload)
send_out("Received new payload") send_out("Received new payload")
set_payload(payload) set_payload(payload)
......
...@@ -49,12 +49,12 @@ MSG_STOPJ = 6 ...@@ -49,12 +49,12 @@ MSG_STOPJ = 6
MSG_SERVOJ = 7 MSG_SERVOJ = 7
MSG_SET_PAYLOAD = 8 MSG_SET_PAYLOAD = 8
MSG_WRENCH = 9 MSG_WRENCH = 9
MULT_PAYLOAD = 1000.0
MSG_SET_DIGITAL_OUT = 10 MSG_SET_DIGITAL_OUT = 10
MSG_GET_IO = 11 MSG_GET_IO = 11
MSG_SET_FLAG = 12 MSG_SET_FLAG = 12
MSG_SET_TOOL_VOLTAGE = 13 MSG_SET_TOOL_VOLTAGE = 13
MSG_SET_ANALOG_OUT = 14 MSG_SET_ANALOG_OUT = 14
MULT_payload = 1000.0
MULT_wrench = 10000.0 MULT_wrench = 10000.0
MULT_jointstate = 10000.0 MULT_jointstate = 10000.0
MULT_time = 1000000.0 MULT_time = 1000000.0
...@@ -435,7 +435,7 @@ class CommanderTCPHandler(SocketServer.BaseRequestHandler): ...@@ -435,7 +435,7 @@ class CommanderTCPHandler(SocketServer.BaseRequestHandler):
def send_quit(self): def send_quit(self):
with self.socket_lock: with self.socket_lock:
self.request.send(struct.pack("!i", MSG_QUIT)) self.request.send(struct.pack("!i", MSG_QUIT))
def send_servoj(self, waypoint_id, q_actual, t): def send_servoj(self, waypoint_id, q_actual, t):
assert(len(q_actual) == 6) assert(len(q_actual) == 6)
q_robot = [0.0] * 6 q_robot = [0.0] * 6
...@@ -450,7 +450,7 @@ class CommanderTCPHandler(SocketServer.BaseRequestHandler): ...@@ -450,7 +450,7 @@ class CommanderTCPHandler(SocketServer.BaseRequestHandler):
#Experimental set_payload implementation #Experimental set_payload implementation
def send_payload(self,payload): def send_payload(self,payload):
buf = struct.pack('!ii', MSG_SET_PAYLOAD, payload * MULT_PAYLOAD) buf = struct.pack('!ii', MSG_SET_PAYLOAD, payload * MULT_payload)
with self.socket_lock: with self.socket_lock:
self.request.send(buf) self.request.send(buf)
...@@ -603,7 +603,6 @@ def within_tolerance(a_vec, b_vec, tol_vec): ...@@ -603,7 +603,6 @@ def within_tolerance(a_vec, b_vec, tol_vec):
return False return False
return True return True
#HERE
class URServiceProvider(object): class URServiceProvider(object):
def __init__(self, robot): def __init__(self, robot):
self.robot = robot self.robot = robot
...@@ -902,9 +901,9 @@ def main(): ...@@ -902,9 +901,9 @@ def main():
connection.connect() connection.connect()
connection.send_reset_program() connection.send_reset_program()
provider = None
set_io_server() set_io_server()
service_provider = None
action_server = None action_server = None
try: try:
while not rospy.is_shutdown(): while not rospy.is_shutdown():
...@@ -935,10 +934,10 @@ def main(): ...@@ -935,10 +934,10 @@ def main():
rospy.loginfo("Robot connected") rospy.loginfo("Robot connected")
#provider for service calls #provider for service calls
if provider: if service_provider:
provider.set_robot(r) service_provider.set_robot(r)
else: else:
provider = URServiceProvider(r) service_provider = URServiceProvider(r)
if action_server: if action_server:
action_server.set_robot(r) action_server.set_robot(r)
......
0% or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment