修改x轴限位
This commit is contained in:
parent
7443670841
commit
8cda2b4c2a
@ -292,7 +292,7 @@ class ArucoIKController(Node):
|
|||||||
self.prev_filtered_pos = curr_pos
|
self.prev_filtered_pos = curr_pos
|
||||||
self.prev_filtered_quat = curr_quat
|
self.prev_filtered_quat = curr_quat
|
||||||
|
|
||||||
curr_pos[0] = np.clip(curr_pos[0], 0, 0.8)
|
curr_pos[0] = np.clip(curr_pos[0], -0.8, 0.8)
|
||||||
curr_pos[1] = np.clip(curr_pos[1], -0.2, 0.2) + 0.15
|
curr_pos[1] = np.clip(curr_pos[1], -0.2, 0.2) + 0.15
|
||||||
curr_pos[2] = np.clip(curr_pos[2], 0.0, 0.3) + 0.27
|
curr_pos[2] = np.clip(curr_pos[2], 0.0, 0.3) + 0.27
|
||||||
# pose.pose.position.x = 0.1
|
# pose.pose.position.x = 0.1
|
||||||
|
|||||||
Loading…
Reference in New Issue
Block a user