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