I’ve got a Raspberry Pi tracking an April Tag publishing its pose with ROS and mavros to the landing_target/pose message.
My Cube Orange flight logs show PL topics. Health and TAcq are good, and pX, pY, vX, vY etc. etc. are all recording data.
However the drone doesn’t even try to track the marker in LAND or LOITER modes. When I activate the precland switch in LOITER mode I sometimes see a small twitch, but it doesn’t make any effort to adjust position over the marker.
Moving the drone by hand and watching the rostopic echo /mavros/landing_target/pose, I can see that the pose seems reasonable. When the tag is behind the drone, X is -ve, when the tag is to the left of the drone, Y is -ve, and the other directions are positive.
At first I thought it was because I didn’t have a rangefinder. I installed and enabled a rangefinder and it still doesn’t track.
I’ve tried with PLND_EST_TYPE using both raw data and EKF.
Here are my PLND parameters:
Any idea why this would be happening?
In PX4 is can plot local position and velocity setpoints, so I can compare PL.vX with vehicle_local_position.vX to see that it’s trying to respond to the marker tracker. As far as I have found, in Ardupilot I can only plot global position in Lat/Lon. Am I wrong about this and missing some way to plot local pos/vel?
Thanks in advance!