Thank you for the answers,
I read the protocol but It seems that is for auto mode, my goal is this: I send a Mission_Item with COMMAND_NAV_WAYPOINT for a specific waypoint, I would the drone tell me that the waypoint is reached,
I work in GUIDED MODE , so I have APM 2.6 and I have found this class in the firmware: AC_WPNav with the metod
reached_wp_destination(). I created a new mavlink message and do the follow code:
if(wp_nav.reached_wp_destination())
send me my message.
But I don't know if this method is good for my goal.
Sorry for my english I am Italian :)