[BUG] `RoboticCommanderROS` - Cant move to home with MoveIt2 planner

[macmacal]

Description

There are edge positions where we can't plan trajectory to the home positions. We should do something about it.

References

• Found in Add ROS MoveIt2 Servo control for TCP and joints #32

[macmacal]

There is a chance that this issue is being solved by #58