hpm6750/controller_yy_app/software/soft_payload.c

#include "soft_payload.h"




int payloadCtlMsgDecode(uint16_t ctlID, void *ctlArg, struct payload* pload)
{
    uint16_t *pArg = (uint16_t *)ctlArg;

    switch (ctlID)
    {
    /* 接收到目标跟踪指令 */
    case PAYLOAD_CTL_TARGET_TRACE:
    {
        struct targetTraceArg arg;
        arg.p1x = *pArg * 0.001f;
        arg.p1y = *(pArg + 1) * 0.001f;
        arg.p1y = *(pArg + 2) * 0.001f;
        arg.p1y = *(pArg + 3) * 0.001f;
        if (pload->ops.targetTarceCtlRecevied)
        {
            pload->ops.targetTarceCtlRecevied(&arg);
        }
    }
    break;

    default:
        break;
    }

    return 0;
}