Files
foc_Gimbal/APP/usart_ano.c
2024-01-26 15:31:40 +08:00

40 lines
851 B
C

//
// Created by hu123456 on 2024/1/22.
//
#include "usart_ano.h"
unsigned char Data_Buff[32] ={0XAA,0XFF,0XF1};
//AA FF F1 10 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 AA 37
void Data_send(int32_t _a,int32_t _b)
{
unsigned char i,cnt=4;
unsigned char sc=0,ac=0;
Data_Buff[3]=0x08;
Data_Buff[cnt++] = BYTE0(_a);
Data_Buff[cnt++] = BYTE1(_a);
Data_Buff[cnt++] = BYTE2(_a);
Data_Buff[cnt++] = BYTE3(_a);
Data_Buff[cnt++] = BYTE0(_b);
Data_Buff[cnt++] = BYTE1(_b);
Data_Buff[cnt++] = BYTE2(_b);
Data_Buff[cnt++] = BYTE3(_b);
for(i=0;i<cnt;i++)
{
sc+=Data_Buff[i];
ac+=sc;
}
Data_Buff[cnt++] = sc;
Data_Buff[cnt++] = ac;
for( i = 0 ; i < cnt; i++)
{
USART1->TDR = Data_Buff[i];
while((USART1->ISR & USART_ISR_TC) == 0)
{}
}
}