The QRCodeEstimation library returns the 'pose' of the camera, to the QR code.
We need to figure out how to talk between pose and dagu arm co-ordinates.
Keep in mind that the pose (calculated from the camera) is relative to the end effectors co-ordinate frame, but the current arm abstraction deals with the world frame.
Turns out that this is actually very straightforward.
Now we just need to figure out how to communicate between this and python (so that we don't have to do the math manually).
The QRCodeEstimation library returns the 'pose' of the camera, to the QR code.
We need to figure out how to talk between pose and dagu arm co-ordinates.
Keep in mind that the pose (calculated from the camera) is relative to the end effectors co-ordinate frame, but the current arm abstraction deals with the world frame.