1
0
Fork 0
mirror of https://github.com/iNavFlight/inav.git synced 2025-07-24 00:35:34 +03:00

first build

This commit is contained in:
breadoven 2022-08-20 09:46:54 +01:00
parent e3e52c49c6
commit f357482966
8 changed files with 120 additions and 68 deletions

View file

@ -1576,8 +1576,8 @@ static void mspFcWaypointOutCommand(sbuf_t *dst, sbuf_t *src)
{
const uint8_t msp_wp_no = sbufReadU8(src); // get the wp number
navWaypoint_t msp_wp;
getWaypoint(msp_wp_no, &msp_wp);
sbufWriteU8(dst, msp_wp_no); // wp_no
getWaypoint(msp_wp_no + wpMissionStartIndex, &msp_wp); // CR74
sbufWriteU8(dst, msp_wp_no); // wp_no
sbufWriteU8(dst, msp_wp.action); // action (WAYPOINT)
sbufWriteU32(dst, msp_wp.lat); // lat
sbufWriteU32(dst, msp_wp.lon); // lon