Avoided to orient velocity for joint speedj in robot.py, likely named method from urrobot.py received wrong data
This commit is contained in:
		| @@ -149,9 +149,13 @@ class Robot(URRobot): | |||||||
|         send command to robot formated like speedl or speedj |         send command to robot formated like speedl or speedj | ||||||
|         move at given velocities until minimum min_time seconds |         move at given velocities until minimum min_time seconds | ||||||
|         """ |         """ | ||||||
|  |         if command != "speedj": | ||||||
|             v = self.csys.orient * m3d.Vector(velocities[:3]) |             v = self.csys.orient * m3d.Vector(velocities[:3]) | ||||||
|             w = self.csys.orient * m3d.Vector(velocities[3:]) |             w = self.csys.orient * m3d.Vector(velocities[3:]) | ||||||
|         URRobot.speedx(self, command, np.concatenate((v.array, w.array)), acc, min_time) |             vels = np.concatenate((v.array, w.array)) | ||||||
|  |         else: | ||||||
|  |             vels = velocities | ||||||
|  |         URRobot.speedx(self, command, vels, acc, min_time) | ||||||
|  |  | ||||||
|     def speedl_tool(self, velocities, acc, min_time): |     def speedl_tool(self, velocities, acc, min_time): | ||||||
|         """ |         """ | ||||||
|   | |||||||
		Reference in New Issue
	
	Block a user