TuxMonkey/bf_original_balance_chassis
1
0
Fork 0
mirror of https://gitee.com/dlmu-cone/bf_original_balance_chassis synced 2026-07-24 03:27:45 +08:00
Code Issues Packages Projects Releases Wiki Activity

add vision protocol

Browse Source
This commit is contained in:
NeoZng
2022-11-03 20:38:55 +08:00
parent 25501650ce
commit 95607668e1
12 changed files with 537 additions and 25 deletions
Download Patch File Download Diff File Expand all files Collapse all files

55
modules/master_machine/master_process.c
View File

@@ -1 +1,54 @@
#include "Master_process.h"
/**
* @file master_process.c
* @author neozng
* @brief module for recv&send vision data
* @version beta
* @date 2022-11-03
*
* @copyright Copyright (c) 2022
*
*/
#include "Master_process.h"
/* use usart1 as vision communication*/
static Vision_Recv_s recv_data;
static usart_instance vision_usart_instance;
/**
* @brief 接收解包回调函数,将在bsp_usart.c中被usart rx callback调用
* @todo 1.提高可读性,将get_protocol_info的第四个参数增加一个float buffer
* 2.添加标志位解码
*/
static void DecodeVision()
{
static uint16_t flag_register;
get_protocol_info(vision_usart_instance.recv_buff, &flag_register, &recv_data.pitch);
// TODO: code to resolve flag_register;
}
/* 视觉通信初始化 */
void VisionInit(UART_HandleTypeDef *handle)
{
vision_usart_instance.module_callback = DecodeVision;
vision_usart_instance.recv_buff_size = VISION_RECV_SIZE;
vision_usart_instance.usart_handle = handle;
USARTRegister(&vision_usart_instance);
}
/**
* @brief 发送函数
* @todo 1.提高可读性,将get_protocol_info的第四个参数增加一个float buffer
* 2.添加标志位解码
*
* @param send 待发送数据
*/
void VisionSend(Vision_Send_s *send)
{
static uint16_t flag_register;
static uint8_t send_buff[VISION_SEND_SIZE];
static uint16_t tx_len;
// TODO: code to set flag_register
get_protocol_send_data(0x02, flag_register, &send->yaw, 3, send_buff, &tx_len);
USARTSend(&vision_usart_instance, send_buff, tx_len);
}

19
modules/master_machine/master_process.h
View File

@@ -2,7 +2,26 @@
#define MASTER_PROCESS_H
#include "bsp_usart.h"
#include "usart.h"
#include "seasky_protocol.h"
#define VISION_RECV_SIZE 36u
#define VISION_SEND_SIZE 36u
/**
* @brief 调用此函数初始化和视觉的串口通信
*
* @param handle 用于和视觉通信的串口handle(C板上一般为USART1,丝印为USART2,4pin)
*/
void VisionInit(UART_HandleTypeDef* handle);
/**
* @brief 发送视觉视觉
*
* @param send 视觉需要的数据
*/
void VisionSend(Vision_Send_s *send);
#endif // !MASTER_PROCESS_H

142
modules/master_machine/seasky_protocol.c Normal file
View File

@@ -0,0 +1,142 @@
/**
* @file seasky_protocol.c
* @author Liu Wei
* @author modified by Neozng
* @brief 湖南大学RoBoMatster串口通信协议
* @version 0.1
* @date 2022-11-03
*
* @copyright Copyright (c) 2022
*
*/
#include "seasky_protocol.h"
#include "crc8.h"
#include "crc16.h"
/*获取CRC8校验码*/
uint8_t Get_CRC8_Check(uint8_t *pchMessage, uint16_t dwLength)
{
return crc_8(pchMessage, dwLength);
}
/*检验CRC8数据段*/
uint8_t CRC8_Check_Sum(uint8_t *pchMessage, uint16_t dwLength)
{
uint8_t ucExpected = 0;
if ((pchMessage == 0) || (dwLength <= 2))
return 0;
ucExpected = Get_CRC8_Check(pchMessage, dwLength - 1);
return (ucExpected == pchMessage[dwLength - 1]);
}
/*获取CRC16校验码*/
uint16_t Get_CRC16_Check(uint8_t *pchMessage, uint32_t dwLength)
{
return crc_16(pchMessage, dwLength);
}
/*检验CRC16数据段*/
uint16_t CRC16_Check_Sum(uint8_t *pchMessage, uint32_t dwLength)
{
uint16_t wExpected = 0;
if ((pchMessage == 0) || (dwLength <= 2))
{
return 0;
}
wExpected = Get_CRC16_Check(pchMessage, dwLength - 2);
return (((wExpected & 0xff) == pchMessage[dwLength - 2]) && (((wExpected >> 8) & 0xff) == pchMessage[dwLength - 1]));
}
/*检验数据帧头*/
uint8_t protocol_heade_Check(protocol_rm_struct *pro,uint8_t *rx_buf)
{
if (rx_buf[0] == PROTOCOL_CMD_ID)
{
pro->header.sof = rx_buf[0];
if (CRC8_Check_Sum(&rx_buf[0], 4))
{
pro->header.data_length = (rx_buf[2] << 8) | rx_buf[1];
pro->header.crc_check = rx_buf[3];
pro->cmd_id = (rx_buf[5] << 8) | rx_buf[4];
return 1;
}
}
return 0;
}
float float_protocol(uint8_t *dat_t)
{
uint8_t f_data[4];
f_data[0] = *(dat_t + 0);
f_data[1] = *(dat_t + 1);
f_data[2] = *(dat_t + 2);
f_data[3] = *(dat_t + 3);
return *(float *)f_data;
}
/*
此函数根据待发送的数据更新数据帧格式以及内容，实现数据的打包操作
后续调用通信接口的发送函数发送tx_buf中的对应数据
*/
void get_protocol_send_data(uint16_t send_id, //信号id
uint16_t flags_register, // 16位寄存器
float *tx_data, //待发送的float数据
uint8_t float_length, // float的数据长度
uint8_t *tx_buf, //待发送的数据帧
uint16_t *tx_buf_len) //待发送的数据帧长度
{
static uint16_t crc16;
static uint16_t data_len;
data_len = float_length * 4 + 2;
/*帧头部分*/
tx_buf[0] = PROTOCOL_CMD_ID;
tx_buf[1] = data_len & 0xff; //低位在前
tx_buf[2] = (data_len >> 8) & 0xff; //低位在前
tx_buf[3] = Get_CRC8_Check(&tx_buf[0], 3); //获取CRC8校验位
/*数据的信号id*/
tx_buf[4] = send_id & 0xff;
tx_buf[5] = (send_id >> 8) & 0xff;
/*建立16位寄存器*/
tx_buf[6] = flags_register & 0xff;
tx_buf[7] = (flags_register >> 8) & 0xff;
/*float数据段*/
for (int i = 0; i < 4 * float_length; i++)
{
tx_buf[i + 8] = ((uint8_t *)(&tx_data[i / 4]))[i % 4];
}
/*整包校验*/
crc16 = Get_CRC16_Check(&tx_buf[0], data_len + 6);
tx_buf[data_len + 6] = crc16 & 0xff;
tx_buf[data_len + 7] = (crc16 >> 8) & 0xff;
*tx_buf_len = data_len + 8;
}
/*
此函数用于处理接收数据，
返回数据内容的id
*/
uint16_t get_protocol_info(uint8_t *rx_buf, //接收到的原始数据
uint16_t *flags_register, //接收数据的16位寄存器地址
float *rx_data) //接收的float数据存储地址
{
static protocol_rm_struct pro;
static uint16_t date_length;
if (protocol_heade_Check(&pro, rx_buf))
{
date_length = OFFSET_BYTE + pro.header.data_length;
while (CRC16_Check_Sum(&rx_buf[0], date_length))
{
*flags_register = (rx_buf[7] << 8) | rx_buf[6];
for (int i = 0; i < (pro.header.data_length - 2) / 4; i++)
{
rx_data[i] = float_protocol(&rx_buf[8 + 4 * i]);
}
for (int i = 0; i < date_length; i++)
{
rx_buf[i] = 0;
}
return pro.cmd_id;
}
}
}

108
modules/master_machine/seasky_protocol.h Normal file
View File

@@ -0,0 +1,108 @@
#ifndef __SEASKY_PROTOCOL_H
#define __SEASKY_PROTOCOL_H
#include <stdio.h>
#include <stdint.h>
#define PROTOCOL_CMD_ID 0XA5
#define OFFSET_BYTE 8 //出数据段外，其他部分所占字节数
typedef enum
{
NO_FIRE = 0,
AUTO_FIRE = 1,
AUTO_AIM = 2
} Fire_Mode_e;
typedef enum
{
NO_TARGET = 0,
TARGET_CONVERGING = 1,
READY_TO_FIRE = 2
} Target_State_e;
typedef enum
{
NONE = 0,
HERO1 = 1,
ENGINEER2 = 2,
INFANTRY3 = 3,
INFANTRY4 = 4,
INFANTRY5 = 5,
OUTPOST = 6,
SENTRY = 7,
BASE = 8
} Target_Type_e;
typedef struct
{
Fire_Mode_e fire_mode;
Target_State_e target_state;
Target_Type_e target_type;
float yaw;
float pitch;
} Vision_Recv_s;
typedef enum
{
BLUE = 0,
RED = 1
} Enemy_Color_e;
typedef enum
{
MODE_AIM = 0,
MODE_SMALL_BUFF = 1,
MODE_BIG_BUFF = 2
} Work_Mode_e;
typedef enum
{
BIG_AMU_10 = 10,
SMALL_AMU_15 = 15,
BIG_AMU_16 = 16,
SMALL_AMU_18 = 18,
SMALL_AMU_30 = 30,
} Bullet_Speed_e;
typedef struct
{
Enemy_Color_e enemy_color;
Work_Mode_e work_mode;
Bullet_Speed_e bullet_speed;
float yaw;
float pitch;
float roll;
// uint32_t time_stamp;
} Vision_Send_s;
typedef struct
{
struct
{
uint8_t sof;
uint16_t data_length;
uint8_t crc_check; //帧头CRC校验
} header; //数据帧头
uint16_t cmd_id; //数据ID
uint16_t frame_tail; //帧尾CRC校验
} protocol_rm_struct;
/*更新发送数据帧，并计算发送数据帧长度*/
void get_protocol_send_data(uint16_t send_id, //信号id
uint16_t flags_register, // 16位寄存器
float *tx_data, //待发送的float数据
uint8_t float_length, // float的数据长度
uint8_t *tx_buf, //待发送的数据帧
uint16_t *tx_buf_len); //待发送的数据帧长度
/*接收数据处理*/
uint16_t get_protocol_info(uint8_t *rx_buf, //接收到的原始数据
uint16_t *flags_register, //接收数据的16位寄存器地址
float *rx_data); //接收的float数据存储地址
#endif