mirror of
https://gitee.com/dlmu-cone/tronone-h7-scaffold
synced 2026-07-24 03:27:45 +08:00
145 lines
4.9 KiB
C
145 lines
4.9 KiB
C
//
|
|
// Created by ASUS on 2025/12/5.
|
|
//
|
|
|
|
|
|
/* USER CODE BEGIN Header */
|
|
/**
|
|
******************************************************************************
|
|
* @file : Image_Transmission.c
|
|
* @brief : Image_Transmission_Info interfaces functions
|
|
* @author :
|
|
* @date : 2025/4/20
|
|
* @version : v1.0
|
|
******************************************************************************
|
|
* @attention : to be tested
|
|
******************************************************************************
|
|
*/
|
|
/* USER CODE END Header */
|
|
#include "videotransmiter.h"
|
|
#include "CRC.h"
|
|
#include "usart.h"
|
|
|
|
__attribute__((section (".AXI_SRAM"))) uint8_t Image_Trans_MultiRx_Buff[2][39];
|
|
|
|
Image_Transmission_Info_TypeDef Image_Transmission_Info;
|
|
VT13_Info_TypeDef VT13_Info;
|
|
|
|
static int16_t bit8TObit16(uint8_t change_info[2]);
|
|
|
|
void Image_Transmission_Info_Update(uint8_t *Buff)
|
|
{
|
|
Image_Transmission_Info.Index = 0;
|
|
Image_Transmission_Info.DataLength = 0;
|
|
/*Check the header frame */
|
|
|
|
if (Buff[0] == 0xA5)
|
|
{
|
|
|
|
if (Verify_CRC8_Check_Sum(&Buff[0], 5) == true)
|
|
{
|
|
|
|
Image_Transmission_Info.DataLength =
|
|
(uint16_t) (Buff[Image_Transmission_Info.Index + 2] << 8 | Buff[Image_Transmission_Info.Index + 1])
|
|
+ FrameHeader_Length + CMDID_Length + CRC16_Length;
|
|
|
|
if (Verify_CRC16_Check_Sum(&Buff[Image_Transmission_Info.Index], Image_Transmission_Info.DataLength) ==
|
|
true)
|
|
{
|
|
|
|
#ifdef CUSTOM_ROBOT_DATA_ID
|
|
|
|
if (Image_Transmission_Info.DataLength == 39)
|
|
{
|
|
for (uint8_t i = 0; i < 30; i++)
|
|
{
|
|
Image_Transmission_Info.custom_robot_data.data[i] = Buff[
|
|
Image_Transmission_Info.Index + FrameHeader_Length + CMDID_Length + i];
|
|
}
|
|
}
|
|
#endif
|
|
|
|
#ifdef REMOTE_CONTROL_ID
|
|
|
|
if (Image_Transmission_Info.DataLength == 21)
|
|
{
|
|
Image_Transmission_Info.remote_control.mouse_x = bit8TObit16(
|
|
&Buff[Image_Transmission_Info.Index + FrameHeader_Length + CMDID_Length]);
|
|
Image_Transmission_Info.remote_control.mouse_y = bit8TObit16(
|
|
&Buff[Image_Transmission_Info.Index + FrameHeader_Length + CMDID_Length + 2]);
|
|
Image_Transmission_Info.remote_control.mouse_z = bit8TObit16(
|
|
&Buff[Image_Transmission_Info.Index + FrameHeader_Length + CMDID_Length + 4]);
|
|
Image_Transmission_Info.remote_control.left_button_down = Buff[
|
|
Image_Transmission_Info.Index + FrameHeader_Length + CMDID_Length + 6];
|
|
Image_Transmission_Info.remote_control.right_button_down = Buff[
|
|
Image_Transmission_Info.Index + FrameHeader_Length + CMDID_Length + 7];
|
|
Image_Transmission_Info.remote_control.Key.keyboard_value = bit8TObit16(
|
|
&Buff[Image_Transmission_Info.Index + FrameHeader_Length + CMDID_Length + 8]);
|
|
}
|
|
#endif
|
|
}
|
|
}
|
|
|
|
}
|
|
else if (Buff[0] == 0xA9)
|
|
{
|
|
|
|
if (Buff[1] == 0x53)
|
|
{
|
|
|
|
VT13_Info_Update(Buff, &VT13_Info);
|
|
|
|
}
|
|
}
|
|
}
|
|
|
|
void VT13_Info_Update(uint8_t *Buff, VT13_Info_TypeDef *VT13_Info)
|
|
{
|
|
|
|
if (Verify_CRC16_Check_Sum(&Buff[0], 21) == true)
|
|
{
|
|
|
|
VT13_Info->RC.Channel[0] = ((Buff[2]) | (Buff[3] << 8)) & 0x07FF;
|
|
VT13_Info->RC.Channel[1] = ((Buff[3] >> 3) | (Buff[4] << 5)) & 0x07FF;
|
|
VT13_Info->RC.Channel[2] = ((Buff[4] >> 6) | (Buff[5] << 2) | (Buff[6] << 10)) & 0x07FF;
|
|
VT13_Info->RC.Channel[3] = ((Buff[6] >> 1) | (Buff[7] << 7)) & 0x07FF;
|
|
VT13_Info->RC.Switch = (Buff[7] >> 4) & 0x03;
|
|
VT13_Info->RC.Stop = (Buff[7] >> 6) & 0x01;
|
|
VT13_Info->RC.Left = (Buff[7] >> 7) & 0x01;
|
|
VT13_Info->RC.Right = (Buff[8]) & 0x01;
|
|
VT13_Info->RC.Wheel = ((Buff[8] >> 1) | (Buff[9] << 7)) & 0x07FF;
|
|
VT13_Info->RC.Trigger = (Buff[9] >> 4) & 0x01;
|
|
|
|
VT13_Info->RC.Channel[0] -= 1024;
|
|
VT13_Info->RC.Channel[1] -= 1024;
|
|
VT13_Info->RC.Channel[2] -= 1024;
|
|
VT13_Info->RC.Channel[3] -= 1024;
|
|
VT13_Info->RC.Wheel -= 1024;
|
|
|
|
VT13_Info->Mouse.X = (Buff[10] | (Buff[11] << 8));
|
|
VT13_Info->Mouse.Y = (Buff[12] | (Buff[13] << 8));
|
|
VT13_Info->Mouse.Z = (Buff[14] | (Buff[15] << 8));
|
|
|
|
VT13_Info->Mouse.Press_L = (Buff[16]) & 0x03;
|
|
VT13_Info->Mouse.Press_R = (Buff[16] >> 2) & 0x03;
|
|
VT13_Info->Mouse.Press_M = (Buff[16] >> 4) & 0x03;
|
|
|
|
VT13_Info->Key.V = (Buff[17] | (Buff[18] << 8));
|
|
}
|
|
|
|
}
|
|
|
|
static int16_t bit8TObit16(uint8_t change_info[2])
|
|
{
|
|
union
|
|
{
|
|
int16_t bit16;
|
|
uint8_t byte[2];
|
|
} u16val;
|
|
|
|
u16val.byte[0] = change_info[0];
|
|
u16val.byte[1] = change_info[1];
|
|
|
|
return u16val.bit16;
|
|
}
|