Description
Below is the code, where the values in target_pos and target_ori are the same as a real kinovagen3 robot returns to me
target_pos = [0.578613758, 0.00417445553, 0.438761622]
target_ori = [89.1808319, 1.55599177, 90.6496887]
target_ori_r = np.deg2rad(target_ori)
T = SE3(target_pos) * SE3.RPY(target_ori, unit='deg')
sol = ik_solver.robot.ikine_LM(T)
And the error reported is below:
Traceback (most recent call last):
File "/home/kinova/Rekep4Real/test.py", line 77, in
joint_positions_r = ik_solver.solve_ik_r(target_pos, target_ori_r)
File "/home/kinova/Rekep4Real/test.py", line 43, in solve_ik_r
ik_solution = self.robot.ikine_LM(target_transform, q0=q0)
File "/home/kinova/.miniconda/envs/rekep4real/lib/python3.10/site-packages/roboticstoolbox/robot/RobotKinematics.py", line 1181, in ikine_LM
return self.ets(start, end).ikine_LM(
File "/home/kinova/.miniconda/envs/rekep4real/lib/python3.10/site-packages/roboticstoolbox/robot/ETS.py", line 2584, in ikine_LM
return solver.solve(ets=self, Tep=Tep, q0=q0)
File "/home/kinova/.miniconda/envs/rekep4real/lib/python3.10/site-packages/roboticstoolbox/robot/IK.py", line 230, in solve
q0_method[:, ets.jindices] = self._random_q(ets, self.slimit)
File "/home/kinova/.miniconda/envs/rekep4real/lib/python3.10/site-packages/roboticstoolbox/robot/IK.py", line 469, in _random_q
q[j, i] = self._private_random.uniform(
File "_generator.pyx", line 954, in numpy.random._generator.Generator.uniform
OverflowError: high - low range exceeds valid bounds
I will be grateful for your replies