To see correctly synchronised 3D data from moving sensor user needs to setup synchronisation.
Pose synchronisation is currently supported only in setups where the robot controller (RoboKit) and sensor controller (SenseKit) are running on the same embedded computer.
To setup pose synchronisation user needs to:
Enable pose synchronisation using SenseKit firmware settings in AMAS.
Perform eye-in-hand calibration (with pose) in AMAS.
The first step adds pose retrieved from the robot to the 3D data sent to AMAS. For example, we want the pose of the end-effector for the sensor mounted on the end-effector joint.
The second step enables the rendering of the 3D data with respect to the pose and calibrates the sensor position with respect to where it is mounted.
In a typical scenario, the sensor is mounted on the last robot's joint with the end-effector.
We want the pose of this joint with respect to the robot base to be sent with the 3D data.
Setup the SenseKit firmware settings Pose Sync Settings
as described in with:
Reference Frame
set to your robot base (typically link_base
)
Relative Frame
set to joint where sensor is mounted on robot (typically link5
, link6
or link7
)
Example: for arm with 7 joints like xArm 7 and sensor mounted with end effector, reference frame link_base
and relative frame link7
should be setup.
Reminder: reboot the SenseKit after changing firmware settings
In the previous step, we ensured that the pose of the robot joint that the camera is mounted on will be sent with 3D data. We still need to calibrate where the sensor is with respect to this joint.
Calibration board at some fixed position near the robot arm
Mount type End Effector with Pose
Perform the calibration.
After taking 4 samples with the calibration board, initial calibration should be available and further calibration becomes simpler as 3D data will be aligned.
Follow the with:
At the beginning of calibration, it may be helpful to enable 2D video feed from the camera. To enable 2D video feed, see Set the mode to Point Cloud + Video
Setup robot - sensor pose synchronisation for arm mounted sensor.