UofI-CDACS / fanuc_ros2_drivers

ROS2 Drivers for FANUC
27 stars 3 forks source link

Lack of support for full cartesian coordinates #5

Open tLybeck opened 6 months ago

tLybeck commented 6 months ago

FANUC's Cartesian coordinate system uses xyz-wpr as well as a configuration system that contains joint turn counters and joint placement bits.

flut_screenshot

The driver as is does not support anything but the xyz-wpr. This causes various issues. With the crx-10's, the main problem is swapping between joint and Cartesian coordinates. It can result in the robot attempting to move itself into a configuration you don't want, which can result in limit impacts.

The only way to intentionally choose a configuration is to start the robot in a configuration, so some positions are impossible to force without using joint coordinates, and if you do use joint coordinates and then go back to Cartesian, it just goes right back to the configuration it was in.

This may also be the cause of the problem with the P50ib/10L, where it will crash if joint 4 goes over 180 degrees.