correction IK
This commit is contained in:
parent
bfb9c44dfd
commit
2493e2fe6b
|
|
@ -40,6 +40,8 @@ float get_q1(float x, float y)
|
|||
|
||||
void posCMDCallback(const geometry_msgs::Point& joint_pos)
|
||||
{
|
||||
float pos_x = joint_pos.x;
|
||||
float pos_y = joint_pos.y;
|
||||
if (sqrt(pow(joint_pos.x, 2) + pow(joint_pos.y, 2)) <= 120)
|
||||
{
|
||||
if (hitting_need == true)
|
||||
|
|
|
|||
Loading…
Reference in New Issue