Adjust Setpoint

x [m]
y [m]
z [m]
yaw [deg]
 

Measured
Pose
Meas.
Pose
Error Error Current
Setpoint
Curr.
Setp.
x xx.xx xx.xx xx.xx
y xx.xx xx.xx xx.xx
z xx.xx xx.xx xx.xx
yaw xx.xx xx.xx xx.xx
pitch xx.xx
roll xx.xx
NOTES:
(x,y,z) in meters
(roll,pitch,yaw) in degrees
error = measured - setpoint
~2Hz data refresh rate

 

Debug Values

Value 1 xx.xx
Value 2 xx.xx
Value 3 xx.xx
Value 4 xx.xx
Value 5 xx.xx
Value 6 xx.xx
Value 7 xx.xx
Value 8 xx.xx
Value 9 xx.xx
Value 10 xx.xx