移植与电子模块通信相关代码
This commit is contained in:
andy
435
source/interface/if_can.c
Normal file
435
source/interface/if_can.c
Normal file
@@ -0,0 +1,435 @@
|
||||
#include "if_can.h"
|
||||
#include "rtthread.h"
|
||||
#include "rthw.h"
|
||||
#include "elec_det.h"
|
||||
#include "board.h"
|
||||
CanRxMsg receive_message;
|
||||
static YeCanRxFrame_st canrx_st;
|
||||
static uint8_t Can_Device_ID = 0;
|
||||
static uint32_t GetCanFilter(YeCanID_un yeid);
|
||||
uint32_t ul_exid,ul_can_mask;
|
||||
|
||||
rt_mutex_t can_tx_mutex;
|
||||
|
||||
volatile uint8_t CAN0_TX_BUSY_Flag = 0;
|
||||
/*
|
||||
@brief CAN通讯初始化， 包括CANgpio 过滤器
|
||||
*/
|
||||
void YeCanInit(void)
|
||||
{
|
||||
uint32_t ul_filter,ul_mask;
|
||||
CAN_InitTypeDef CAN_InitStructure;
|
||||
GPIO_InitTypeDef GPIO_InitStructure;
|
||||
YeCanID_un yeid_un;
|
||||
CAN_FilterInitTypeDef CAN_FilterInitStructure;
|
||||
|
||||
RCC_APB1PeriphClockCmd(RCC_APB1Periph_CAN1, ENABLE);
|
||||
RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA,ENABLE);
|
||||
RCC_APB2PeriphClockCmd(RCC_APB2Periph_AFIO,ENABLE);
|
||||
//CAN GPIO 初始化
|
||||
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_11;
|
||||
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPU;
|
||||
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
|
||||
GPIO_Init(GPIOA, &GPIO_InitStructure);
|
||||
|
||||
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_12;
|
||||
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;
|
||||
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
|
||||
GPIO_Init(GPIOA, &GPIO_InitStructure);
|
||||
|
||||
CAN_DeInit(CAN1);
|
||||
CAN_StructInit(&CAN_InitStructure);
|
||||
CAN_InitStructure.CAN_TTCM = DISABLE;
|
||||
CAN_InitStructure.CAN_ABOM = DISABLE;
|
||||
CAN_InitStructure.CAN_AWUM = DISABLE;
|
||||
CAN_InitStructure.CAN_NART = DISABLE;
|
||||
CAN_InitStructure.CAN_RFLM = DISABLE;
|
||||
CAN_InitStructure.CAN_TXFP = ENABLE;
|
||||
CAN_InitStructure.CAN_Mode = CAN_Mode_Normal;
|
||||
CAN_InitStructure.CAN_SJW = CAN_SJW_1tq;
|
||||
CAN_InitStructure.CAN_BS1 = CAN_BS1_3tq;
|
||||
CAN_InitStructure.CAN_BS2 = CAN_BS2_2tq;
|
||||
CAN_InitStructure.CAN_Prescaler = 30;
|
||||
|
||||
CAN_Init(CAN1, &CAN_InitStructure);
|
||||
|
||||
Can_Device_ID = elec_local_addr();
|
||||
|
||||
yeid_un.Exide = 0;
|
||||
yeid_un.yecanid.ACK = 0;
|
||||
yeid_un.yecanid.FunClass = 0;
|
||||
yeid_un.yecanid.Reserve1 = 0;
|
||||
yeid_un.yecanid.Reserve0 = 0;
|
||||
yeid_un.yecanid.SegFlag = 0;
|
||||
yeid_un.yecanid.SegNum = 0;
|
||||
yeid_un.yecanid.srcMACID = 0x00;
|
||||
|
||||
yeid_un.yecanid.destMACID = 0x1F;
|
||||
ul_mask = GetCanFilter(yeid_un);
|
||||
ul_can_mask =ul_mask;
|
||||
yeid_un.yecanid.destMACID = Can_Device_ID;
|
||||
ul_filter = GetCanFilter(yeid_un);
|
||||
|
||||
CAN_FilterInitStructure.CAN_FilterNumber = 0;
|
||||
CAN_FilterInitStructure.CAN_FilterMode = CAN_FilterMode_IdMask;
|
||||
CAN_FilterInitStructure.CAN_FilterScale = CAN_FilterScale_32bit;
|
||||
CAN_FilterInitStructure.CAN_FilterIdHigh = (ul_filter >> 16) & 0x0FFFF;;
|
||||
CAN_FilterInitStructure.CAN_FilterIdLow = ul_filter & 0x0FFFF;;
|
||||
CAN_FilterInitStructure.CAN_FilterMaskIdHigh = (ul_mask >> 16) & 0x0FFFF;;
|
||||
CAN_FilterInitStructure.CAN_FilterMaskIdLow = ul_mask & 0x0FFFF; ;
|
||||
CAN_FilterInitStructure.CAN_FilterFIFOAssignment = CAN_FIFO0;
|
||||
CAN_FilterInitStructure.CAN_FilterActivation = ENABLE;
|
||||
CAN_FilterInit(&CAN_FilterInitStructure);
|
||||
|
||||
yeid_un.yecanid.destMACID = 0x1E;
|
||||
ul_filter = GetCanFilter(yeid_un);
|
||||
CAN_FilterInitStructure.CAN_FilterNumber = 1;
|
||||
CAN_FilterInitStructure.CAN_FilterIdHigh = (ul_filter >> 16) & 0x0FFFF;;
|
||||
CAN_FilterInitStructure.CAN_FilterIdLow = ul_filter & 0x0FFFF;;
|
||||
CAN_FilterInit(&CAN_FilterInitStructure);
|
||||
|
||||
yeid_un.yecanid.destMACID = 0x1F;
|
||||
ul_filter = GetCanFilter(yeid_un);
|
||||
CAN_FilterInitStructure.CAN_FilterNumber = 2;
|
||||
CAN_FilterInitStructure.CAN_FilterIdHigh = (ul_filter >> 16) & 0x0FFFF;;
|
||||
CAN_FilterInitStructure.CAN_FilterIdLow = ul_filter & 0x0FFFF;;
|
||||
CAN_FilterInit(&CAN_FilterInitStructure);
|
||||
|
||||
|
||||
CAN_OperatingModeRequest(CAN1,CAN_OperatingMode_Normal);
|
||||
|
||||
NVIC_InitTypeDef NVIC_InitStructure;
|
||||
|
||||
NVIC_InitStructure.NVIC_IRQChannel = USB_LP_CAN1_RX0_IRQn;
|
||||
NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 0;
|
||||
NVIC_InitStructure.NVIC_IRQChannelSubPriority = 4;
|
||||
NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;
|
||||
NVIC_Init(&NVIC_InitStructure);
|
||||
|
||||
CAN_ClearITPendingBit(CAN1, CAN_IT_FMP0);
|
||||
CAN_ITConfig(CAN1, CAN_IT_FMP0, ENABLE);
|
||||
can_tx_mutex = rt_mutex_create ("can0_tx_mutex",RT_IPC_FLAG_PRIO);
|
||||
|
||||
}
|
||||
/*
|
||||
@brief 根据设置CAN 的ID协议，获取帧过滤值
|
||||
*/
|
||||
static uint32_t GetCanFilter(YeCanID_un yeid)
|
||||
{
|
||||
uint32_t filter = 0;
|
||||
filter = yeid.Exide << 3;
|
||||
filter |= 0x04;//只接收扩展帧
|
||||
filter &= ~((uint32_t)0x003);//不限定帧类型
|
||||
return filter;
|
||||
}
|
||||
/*
|
||||
@brief CAN发送通讯帧
|
||||
@param 源地址
|
||||
@param 主机地址
|
||||
@param 发送数据缓存
|
||||
@param 发送数据长度
|
||||
@rtv 0 成功 1 失败
|
||||
*/
|
||||
uint8_t YeCan_SendFrame(uint8_t srcaddr,uint8_t dstaddr,const uint8_t* txdata, uint16_t len)
|
||||
{
|
||||
CanTxMsg transmit_message;
|
||||
uint8_t mailbox_number;
|
||||
YeCanID_un yeid_un;
|
||||
uint32_t time_out = 0;
|
||||
uint8_t uc_rtv = 0;
|
||||
//can_transmission_stop(CAN1,0);
|
||||
/* initialize transmit message */
|
||||
transmit_message.ExtId = 0x00;
|
||||
transmit_message.StdId = 0x00;
|
||||
transmit_message.RTR = CAN_RTR_DATA;
|
||||
transmit_message.IDE = CAN_ID_EXT;
|
||||
yeid_un.Exide = 0;
|
||||
yeid_un.yecanid.srcMACID = srcaddr;
|
||||
yeid_un.yecanid.destMACID = dstaddr;
|
||||
yeid_un.yecanid.ACK = 0;
|
||||
yeid_un.yecanid.FunClass = 1;
|
||||
yeid_un.yecanid.SegFlag = 0;
|
||||
yeid_un.yecanid.SegNum = 0;
|
||||
if(srcaddr == 0x00 || srcaddr == 0x1f)
|
||||
{
|
||||
time_out = 0;
|
||||
while(time_out < 5)
|
||||
{
|
||||
elec_led1_power(0);
|
||||
rt_thread_mdelay(50);
|
||||
elec_led1_power(1);
|
||||
rt_thread_mdelay(50);
|
||||
time_out++;
|
||||
|
||||
}
|
||||
}
|
||||
if(can_tx_mutex != RT_NULL)
|
||||
{
|
||||
if(RT_EOK != rt_mutex_take (can_tx_mutex,500))
|
||||
{
|
||||
return 1;
|
||||
}
|
||||
}
|
||||
if(len <= 8)
|
||||
{
|
||||
transmit_message.DLC = len;
|
||||
transmit_message.ExtId = yeid_un.Exide;
|
||||
memcpy(transmit_message.Data,txdata,8);
|
||||
|
||||
mailbox_number = CAN_Transmit(CAN1, &transmit_message);
|
||||
time_out = 5000;
|
||||
while( CAN_TxStatus_Ok != CAN_TransmitStatus(CAN1,mailbox_number) && time_out > 0)
|
||||
{
|
||||
time_out --;
|
||||
rt_hw_us_delay(20);
|
||||
}
|
||||
if(time_out == 0)
|
||||
{
|
||||
uc_rtv = 1;
|
||||
goto can0_tx_end;
|
||||
}
|
||||
goto can0_tx_end;
|
||||
}
|
||||
while(len > 8)
|
||||
{
|
||||
memcpy(transmit_message.Data,txdata,8);
|
||||
len -= 8;
|
||||
txdata += 8;
|
||||
|
||||
if(yeid_un.yecanid.SegNum == 0)
|
||||
{
|
||||
yeid_un.yecanid.SegFlag = 0x01;
|
||||
}else
|
||||
{
|
||||
yeid_un.yecanid.SegFlag = 0x02;
|
||||
}
|
||||
transmit_message.ExtId = yeid_un.Exide;
|
||||
transmit_message.DLC = 8;
|
||||
mailbox_number = CAN_Transmit(CAN1, &transmit_message);
|
||||
time_out = 5000;
|
||||
while( CAN_TxStatus_Ok != CAN_TransmitStatus(CAN1,mailbox_number) && time_out > 0)
|
||||
{
|
||||
time_out --;
|
||||
rt_hw_us_delay(20);
|
||||
}
|
||||
if(time_out == 0)
|
||||
{
|
||||
uc_rtv = 1;
|
||||
goto can0_tx_end;
|
||||
}
|
||||
yeid_un.yecanid.SegNum ++;
|
||||
}
|
||||
yeid_un.yecanid.SegFlag = 0x3;
|
||||
memcpy(transmit_message.Data,txdata,len);
|
||||
transmit_message.DLC = len;
|
||||
transmit_message.ExtId = yeid_un.Exide;
|
||||
mailbox_number = CAN_Transmit(CAN1, &transmit_message);
|
||||
time_out = 5000;
|
||||
while(CAN_TxStatus_Ok != CAN_TransmitStatus(CAN1,mailbox_number) && time_out > 0)
|
||||
{
|
||||
|
||||
time_out --;
|
||||
rt_hw_us_delay(20);
|
||||
}
|
||||
if(time_out == 0)
|
||||
{
|
||||
|
||||
uc_rtv = 1;
|
||||
}
|
||||
|
||||
can0_tx_end:
|
||||
CAN0_TX_BUSY_Flag = 0;
|
||||
rt_mutex_release(can_tx_mutex);
|
||||
return uc_rtv;
|
||||
}
|
||||
|
||||
|
||||
typedef struct{
|
||||
void (*end_irq)(void *t,uint32_t len);
|
||||
void *t;
|
||||
uint32_t rx_buff_size;
|
||||
}self_def;
|
||||
|
||||
static self_def g_self;
|
||||
|
||||
|
||||
|
||||
|
||||
static void save_data(void)
|
||||
{
|
||||
YeCanID_un yeid_un;
|
||||
if(receive_message.DLC > 0)
|
||||
{
|
||||
yeid_un.Exide = receive_message.ExtId;
|
||||
ul_exid = yeid_un.Exide << 3;
|
||||
ul_exid &= ul_can_mask;
|
||||
if(yeid_un.yecanid.SegFlag == 00)
|
||||
{
|
||||
memcpy(canrx_st.rx_databuf,receive_message.Data,receive_message.DLC);
|
||||
canrx_st.rx_index = receive_message.DLC;
|
||||
g_self.end_irq(g_self.t,canrx_st.rx_index);
|
||||
}
|
||||
else if(yeid_un.yecanid.SegFlag == 0x01)
|
||||
{
|
||||
canrx_st.seg_num = 0;
|
||||
memcpy(canrx_st.rx_databuf,receive_message.Data,receive_message.DLC);
|
||||
canrx_st.rx_index = receive_message.DLC;
|
||||
}else if(yeid_un.yecanid.SegFlag == 0x02)
|
||||
{
|
||||
if((canrx_st.seg_num+1) == yeid_un.yecanid.SegNum )
|
||||
{
|
||||
canrx_st.seg_num++;
|
||||
memcpy(canrx_st.rx_databuf+canrx_st.rx_index,receive_message.Data,receive_message.DLC);
|
||||
canrx_st.rx_index += receive_message.DLC;
|
||||
|
||||
}else{
|
||||
//error
|
||||
}
|
||||
}else if(yeid_un.yecanid.SegFlag == 0x03)
|
||||
{
|
||||
memcpy(canrx_st.rx_databuf+canrx_st.rx_index,receive_message.Data,receive_message.DLC);
|
||||
canrx_st.rx_index += receive_message.DLC;
|
||||
g_self.end_irq(g_self.t,canrx_st.rx_index);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
|
||||
void USB_LP_CAN1_RX0_IRQHandler(void)
|
||||
{
|
||||
rt_interrupt_enter();
|
||||
CAN_Receive(CAN1, CAN_FIFO0, &receive_message);
|
||||
if(g_self.end_irq&&canrx_st.rx_databuf){
|
||||
save_data();
|
||||
}
|
||||
CAN_ClearITPendingBit(CAN1, CAN_IT_FMP0);
|
||||
rt_interrupt_leave();
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
static int init(uart_def *u,int bsp)
|
||||
{
|
||||
YeCanInit();
|
||||
return 0;
|
||||
}
|
||||
static int deinit(uart_def *u)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
static int set_irq(uart_def *u,void (*irq)(void *t,uint8_t d),void *t)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
static int set_end_irq(uart_def *u,uint8_t *rx_buff,int rx_buff_size,
|
||||
void (*irq)(void *t,uint32_t len),void *t)
|
||||
{
|
||||
irq_disable();
|
||||
g_self.end_irq=irq;
|
||||
canrx_st.rx_databuf=rx_buff;
|
||||
g_self.rx_buff_size=rx_buff_size;
|
||||
g_self.t=t;
|
||||
irq_enable();
|
||||
return 0;
|
||||
}
|
||||
static int read(uart_def *u,uint8_t *b,int len)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
static int write(uart_def *u,const uint8_t *b,int len)
|
||||
{
|
||||
uint8_t src=b[4];
|
||||
uint8_t dst=b[5];
|
||||
uint8_t ret;
|
||||
ret=YeCan_SendFrame(src,dst,b,len);
|
||||
if(ret==0) return len;
|
||||
else return 0;
|
||||
}
|
||||
|
||||
uart_init_export(can,init,deinit,set_irq,set_end_irq,read,write,0)
|
||||
|
||||
|
||||
|
||||
|
||||
typedef struct{
|
||||
uart_def *dev[2];
|
||||
int dev_index;
|
||||
int inited;
|
||||
void (*end_irq)(void *t,uint32_t len);
|
||||
void *t;
|
||||
}h_self_def;
|
||||
|
||||
static h_self_def g_hself;
|
||||
|
||||
static int h_init(uart_def *u,int bsp)
|
||||
{
|
||||
h_self_def *h=&g_hself;
|
||||
if(h->inited) return 0;
|
||||
h->dev[0]=dev_get("uart1");
|
||||
h->dev[1]=dev_get("can");
|
||||
h->dev[0]->init(h->dev[0],0);
|
||||
h->dev[1]->init(h->dev[1],0);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int h_deinit(uart_def *u)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
static int h_set_irq(uart_def *u,void (*irq)(void *t,uint8_t d),void *t)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
static void h_end_irq0(void *t,uint32_t len)
|
||||
{
|
||||
h_self_def *h=&g_hself;
|
||||
h->dev_index=0;
|
||||
if(h->end_irq)
|
||||
{
|
||||
h->end_irq(h->t,len);
|
||||
}
|
||||
}
|
||||
static void h_end_irq1(void *t,uint32_t len)
|
||||
{
|
||||
h_self_def *h=&g_hself;
|
||||
h->dev_index=1;
|
||||
if(h->end_irq)
|
||||
{
|
||||
h->end_irq(h->t,len);
|
||||
}
|
||||
}
|
||||
static int h_set_end_irq(uart_def *u,uint8_t *rx_buff,int rx_buff_size,
|
||||
void (*irq)(void *t,uint32_t len),void *t)
|
||||
{
|
||||
h_self_def *h=&g_hself;
|
||||
irq_disable();
|
||||
h->end_irq=irq;
|
||||
h->t=t;
|
||||
irq_enable();
|
||||
h->dev[0]->set_end_irq(h->dev[0],rx_buff,rx_buff_size,h_end_irq0,h);
|
||||
h->dev[1]->set_end_irq(h->dev[1],rx_buff,rx_buff_size,h_end_irq1,h);
|
||||
return 0;
|
||||
}
|
||||
static int h_read(uart_def *u,uint8_t *b,int len)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
static int h_write(uart_def *u,const uint8_t *b,int len)
|
||||
{
|
||||
h_self_def *h=&g_hself;
|
||||
uart_def *s=h->dev[h->dev_index];
|
||||
return s->write(s,b,len);
|
||||
}
|
||||
|
||||
|
||||
uart_init_export(host,h_init,h_deinit,h_set_irq,h_set_end_irq,h_read,h_write,0)
|
||||
|
||||
|
||||
|
||||
|
||||
50
source/interface/if_can.h
Normal file
50
source/interface/if_can.h
Normal file
@@ -0,0 +1,50 @@
|
||||
#ifndef if_can_h__
|
||||
#define if_can_h__
|
||||
|
||||
//#include "define.h"
|
||||
#include "stm32f10x_can.h"
|
||||
|
||||
typedef struct{
|
||||
uint32_t Reserve1 :3;
|
||||
uint32_t srcMACID :5;
|
||||
uint32_t Reserve0 :2;
|
||||
uint32_t destMACID :5;
|
||||
uint32_t ACK :1;
|
||||
uint32_t FunClass :6;
|
||||
uint32_t SegFlag :2;
|
||||
uint32_t SegNum :8;
|
||||
|
||||
}YeCanID_st;
|
||||
|
||||
typedef union{
|
||||
uint32_t Exide;
|
||||
YeCanID_st yecanid;
|
||||
}YeCanID_un;
|
||||
|
||||
|
||||
|
||||
typedef struct{
|
||||
|
||||
uint8_t *rx_databuf; //接收数据缓存
|
||||
uint8_t seg_num; //分段号
|
||||
uint8_t seg_flag;//分段标志
|
||||
uint16_t rx_index;//接收缓存下标
|
||||
}YeCanRxFrame_st;
|
||||
|
||||
extern volatile uint8_t CAN0_TX_BUSY_Flag;
|
||||
|
||||
/*
|
||||
@brief CAN通讯初始化， 包括CANgpio 过滤器
|
||||
*/
|
||||
void YeCanInit(void);
|
||||
/*
|
||||
@brief CAN发送通讯帧
|
||||
@param 源地址
|
||||
@param 主机地址
|
||||
@param 发送数据缓存
|
||||
@param 发送数据长度
|
||||
@rtv 0 成功 1 失败
|
||||
*/
|
||||
uint8_t YeCan_SendFrame(uint8_t srcaddr,uint8_t dstaddr,const uint8_t* txdata, uint16_t len);
|
||||
|
||||
#endif
|
||||
Reference in New Issue
Block a user