예제 #1
0
        static void _encode_uavcan_protocol_param_GetSet_req(uint8_t[] buffer, uavcan_protocol_param_GetSet_req msg, dronecan_serializer_chunk_cb_ptr_t chunk_cb, object ctx, bool tao)
        {
            memset(buffer, 0, 8);

            canardEncodeScalar(buffer, 0, 13, msg.index);

            chunk_cb(buffer, 13, ctx);



            _encode_uavcan_protocol_param_Value(buffer, msg.value, chunk_cb, ctx, false);



            if (!tao)
            {
                memset(buffer, 0, 8);
                canardEncodeScalar(buffer, 0, 7, msg.name_len);
                chunk_cb(buffer, 7, ctx);
            }

            for (int i = 0; i < msg.name_len; i++)
            {
                memset(buffer, 0, 8);

                canardEncodeScalar(buffer, 0, 8, msg.name[i]);

                chunk_cb(buffer, 8, ctx);
            }
        }
예제 #2
0
            public static uavcan_protocol_param_GetSet_req ByteArrayToDroneCANMsg(byte[] transfer, int startoffset)
            {
                var ans = new uavcan_protocol_param_GetSet_req();

                ans.decode(new DroneCAN.CanardRxTransfer(transfer.Skip(startoffset).ToArray()));
                return(ans);
            }
        static void _decode_uavcan_protocol_param_GetSet_req(CanardRxTransfer transfer, ref uint32_t bit_ofs, uavcan_protocol_param_GetSet_req msg, bool tao)
        {
            canardDecodeScalar(transfer, bit_ofs, 13, false, ref msg.index);
            bit_ofs += 13;

            _decode_uavcan_protocol_param_Value(transfer, ref bit_ofs, msg.value, false);

            if (!tao)
            {
                canardDecodeScalar(transfer, bit_ofs, 7, false, ref msg.name_len);
                bit_ofs += 7;
            }
            else
            {
                msg.name_len = (uint8_t)(((transfer.payload_len * 8) - bit_ofs) / 8);
            }

            for (int i = 0; i < msg.name_len; i++)
            {
                canardDecodeScalar(transfer, bit_ofs, 8, false, ref msg.name[i]);
                bit_ofs += 8;
            }
        }
        static uint32_t decode_uavcan_protocol_param_GetSet_req(CanardRxTransfer transfer, uavcan_protocol_param_GetSet_req msg)
        {
            uint32_t bit_ofs = 0;

            _decode_uavcan_protocol_param_GetSet_req(transfer, ref bit_ofs, msg, true);
            return((bit_ofs + 7) / 8);
        }
/*
 *
 * static uavcan_message_descriptor_s uavcan_protocol_param_GetSet_req_descriptor = {
 *  UAVCAN_PROTOCOL_PARAM_GETSET_REQ_DT_SIG,
 *  UAVCAN_PROTOCOL_PARAM_GETSET_REQ_DT_ID,
 *  CanardTransferTypeRequest,
 *  sizeof(uavcan_protocol_param_GetSet_req),
 *  UAVCAN_PROTOCOL_PARAM_GETSET_REQ_MAX_PACK_SIZE,
 *  encode_func,
 *  decode_func,
 *  &uavcan_protocol_param_GetSet_res_descriptor
 * };
 */

        static void encode_uavcan_protocol_param_GetSet_req(uavcan_protocol_param_GetSet_req msg, uavcan_serializer_chunk_cb_ptr_t chunk_cb, object ctx)
        {
            uint8_t[] buffer = new uint8_t[8];
            _encode_uavcan_protocol_param_GetSet_req(buffer, msg, chunk_cb, ctx, true);
        }