修改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_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[2] = np.clip(curr_pos[2], 0.0, 0.3) + 0.27
|
||||
# pose.pose.position.x = 0.1
|
||||
|
||||
Loading…
Reference in New Issue
Block a user