461 lines
14 KiB
C
461 lines
14 KiB
C
|
/*
|
||
|
* File : ls1c_can.c
|
||
|
* This file is part of RT-Thread RTOS
|
||
|
* COPYRIGHT (C) 2006 - 2018, RT-Thread Development Team
|
||
|
*
|
||
|
* This program is free software; you can redistribute it and/or modify
|
||
|
* it under the terms of the GNU General Public License as published by
|
||
|
* the Free Software Foundation; either version 2 of the License, or
|
||
|
* (at your option) any later version.
|
||
|
*
|
||
|
* This program is distributed in the hope that it will be useful,
|
||
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||
|
* GNU General Public License for more details.
|
||
|
*
|
||
|
* You should have received a copy of the GNU General Public License along
|
||
|
* with this program; if not, write to the Free Software Foundation, Inc.,
|
||
|
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
|
||
|
*
|
||
|
* Change Logs:
|
||
|
* Date Author Notes
|
||
|
* 2018-01-06 sundm75 first version
|
||
|
*/
|
||
|
|
||
|
#include "ls1c.h"
|
||
|
#include "ls1c_public.h"
|
||
|
#include "ls1c_can.h"
|
||
|
|
||
|
unsigned char set_reset_mode(CAN_TypeDef* CANx)
|
||
|
{
|
||
|
unsigned char status;
|
||
|
int i;
|
||
|
|
||
|
/*检查复位标志*/
|
||
|
status = CANx->MOD;
|
||
|
|
||
|
/* 关闭中断 */
|
||
|
CANx->IER = 0x00;
|
||
|
|
||
|
for (i = 0; i < 100; i++)
|
||
|
{
|
||
|
if((status & CAN_Mode_RM) == CAN_Mode_RM)
|
||
|
return 1;
|
||
|
|
||
|
/* 设置复位*/
|
||
|
CANx->MOD |= ((unsigned char)CAN_Mode_RM);
|
||
|
|
||
|
/*延时*/
|
||
|
delay_us(10);
|
||
|
|
||
|
/*检查复位标志*/
|
||
|
status = CANx->MOD;
|
||
|
}
|
||
|
rt_kprintf("\r\nSetting SJA1000 into reset mode failed!\r\n");
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static unsigned char set_normal_mode(CAN_TypeDef* CANx)
|
||
|
{
|
||
|
unsigned char status;
|
||
|
int i;
|
||
|
|
||
|
/*检查复位标志*/
|
||
|
status = CANx->MOD;
|
||
|
|
||
|
for (i = 0; i < 100; i++)
|
||
|
{
|
||
|
if((status & CAN_Mode_RM) != CAN_Mode_RM)
|
||
|
{
|
||
|
/*开所有中断 (总线错误中断不开)*/
|
||
|
CANx->IER |= (~(unsigned char)CAN_IR_BEI);
|
||
|
return 1;
|
||
|
}
|
||
|
/* 设置正常工作模式*/
|
||
|
CANx->MOD &= (~(unsigned char) CAN_Mode_RM);
|
||
|
/*延时*/
|
||
|
delay_us(10);
|
||
|
status = CANx->MOD;
|
||
|
}
|
||
|
rt_kprintf("\r\nSetting SJA1000 into normal mode failed!\r\n");
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
unsigned char set_start(CAN_TypeDef* CANx)
|
||
|
{
|
||
|
/*复位TX错误计数器*/
|
||
|
CANx->TXERR = 0;
|
||
|
/*复位RX错误计数器*/
|
||
|
CANx->RXERR = 0;
|
||
|
/*时钟分频寄存器: PeliCAN模式; CBP=1,中止输入比较器, RX0激活*/
|
||
|
CANx->CDR = 0xC0;
|
||
|
|
||
|
return set_normal_mode(CANx);
|
||
|
}
|
||
|
|
||
|
unsigned char CAN_Init(CAN_TypeDef* CANx, CAN_InitTypeDef* CAN_InitStruct)
|
||
|
{
|
||
|
unsigned char InitStatus = CAN_InitStatus_Failed;
|
||
|
unsigned long wait_ack = 0x00000000;
|
||
|
unsigned char status;
|
||
|
|
||
|
status = CANx->MOD;
|
||
|
if( status == 0xFF)
|
||
|
{
|
||
|
rt_kprintf("\n Probe can0 failed \r\n");
|
||
|
return CAN_InitStatus_Failed;
|
||
|
}
|
||
|
|
||
|
/* 进入复位模式 */
|
||
|
InitStatus = set_reset_mode(CANx);
|
||
|
|
||
|
if((CAN_InitStruct->CAN_Mode & CAN_Mode_SM) == CAN_Mode_SM)
|
||
|
{
|
||
|
/* 睡眠模式 1: 睡眠 0: 唤醒*/
|
||
|
CANx->MOD|= (unsigned char)CAN_Mode_SM;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
CANx->MOD&=~ (unsigned char)CAN_Mode_SM;
|
||
|
}
|
||
|
|
||
|
if((CAN_InitStruct->CAN_Mode & CAN_Mode_LOM) == CAN_Mode_LOM)
|
||
|
{
|
||
|
/*只听模式 1:只听 0:正常 */
|
||
|
CANx->MOD|= (unsigned char)CAN_Mode_LOM;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
CANx->MOD&=~ (unsigned char)CAN_Mode_LOM;
|
||
|
}
|
||
|
|
||
|
if((CAN_InitStruct->CAN_Mode & CAN_Mode_AFM) == CAN_Mode_AFM)
|
||
|
{
|
||
|
/*单滤波模式 1:单 0: 双*/
|
||
|
CANx->MOD |= (unsigned char)CAN_Mode_AFM;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
CANx->MOD&=~ (unsigned char)CAN_Mode_AFM;
|
||
|
}
|
||
|
|
||
|
if((CAN_InitStruct->CAN_Mode & CAN_Mode_STM) == CAN_Mode_STM)
|
||
|
{
|
||
|
/*自检测模式 1:自检测 0:正常 */
|
||
|
CANx->MOD |= (unsigned char)CAN_Mode_STM;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
CANx->MOD&=~ (unsigned char)CAN_Mode_STM;
|
||
|
}
|
||
|
|
||
|
/* 配置时钟频率 */
|
||
|
CANx->BTR0 = (( unsigned char )( unsigned char )CAN_InitStruct->CAN_Prescaler -1) | \
|
||
|
(unsigned char)CAN_InitStruct->CAN_SJW << 6;
|
||
|
|
||
|
CANx->BTR1 = ((unsigned char)CAN_InitStruct->CAN_BS1) | \
|
||
|
((unsigned char)CAN_InitStruct->CAN_BS2 << 4) | \
|
||
|
((unsigned char)CAN_InitStruct->CAN_SJW<<7);
|
||
|
|
||
|
/* 进入工作模式 */
|
||
|
set_start(CANx);
|
||
|
|
||
|
/* 返回初始化结果 */
|
||
|
return InitStatus;
|
||
|
}
|
||
|
|
||
|
void CAN_FilterInit(CAN_TypeDef* CANx, CAN_FilterInitTypeDef * CAN_FilterInitStruct)
|
||
|
{
|
||
|
unsigned long rtr;
|
||
|
unsigned long fcase;
|
||
|
unsigned long ide;
|
||
|
unsigned long thisid, thisid1, thisid2;
|
||
|
unsigned long thismask, thismask1, thismask2;
|
||
|
unsigned long firstdata;
|
||
|
unsigned long datamask;
|
||
|
unsigned char CAN_FilterId0, CAN_FilterId1, CAN_FilterId2, CAN_FilterId3 ;
|
||
|
unsigned char CAN_FilterMaskId0, CAN_FilterMaskId1, CAN_FilterMaskId2, CAN_FilterMaskId3;
|
||
|
|
||
|
thisid = CAN_FilterInitStruct->ID;
|
||
|
thismask = CAN_FilterInitStruct->IDMASK;
|
||
|
thisid1 = (CAN_FilterInitStruct->ID & 0xFFFF0000 )>>16;
|
||
|
thismask1 = (CAN_FilterInitStruct->IDMASK & 0xFFFF0000 )>>16;
|
||
|
thisid2 = (CAN_FilterInitStruct->ID & 0x0000FFFF );
|
||
|
thismask2 = ( CAN_FilterInitStruct->IDMASK& 0x0000FFFF );
|
||
|
rtr = CAN_FilterInitStruct->RTR;
|
||
|
ide = CAN_FilterInitStruct->IDE;
|
||
|
firstdata = CAN_FilterInitStruct->First_Data;
|
||
|
datamask = CAN_FilterInitStruct->Data_Mask;
|
||
|
fcase = CAN_FilterInitStruct->MODE;
|
||
|
|
||
|
if(ide == 0)//标准帧
|
||
|
{
|
||
|
if(fcase == 0)// 0- 双滤波器模式
|
||
|
{
|
||
|
CAN_FilterId0 = thisid1>>3;
|
||
|
CAN_FilterMaskId0 = thismask1>>3;
|
||
|
CAN_FilterId1 = thisid1<<5 | firstdata>>4| rtr<<4;
|
||
|
CAN_FilterMaskId1 = thismask1<<4 | datamask>>4 ;
|
||
|
CAN_FilterId2 = thisid2 >> 3;
|
||
|
CAN_FilterMaskId2 = thismask2 >>3;
|
||
|
CAN_FilterId3 = firstdata & 0x0F | thisid2 <<5 | rtr<<4;
|
||
|
CAN_FilterMaskId3 = datamask <<4 ;
|
||
|
}
|
||
|
else if(fcase == 1)// 1-单滤波器模式
|
||
|
{
|
||
|
CAN_FilterId0 = thisid>>3;
|
||
|
CAN_FilterMaskId0 = thismask>>3;
|
||
|
CAN_FilterId1 = thisid<<5 | rtr<<4;
|
||
|
CAN_FilterMaskId1 = thismask<<5 ;
|
||
|
CAN_FilterMaskId1 |= 0x0F ;
|
||
|
CAN_FilterId2 = 0x00;
|
||
|
CAN_FilterMaskId2 = 0xFF;
|
||
|
CAN_FilterId3 = 0x00;
|
||
|
CAN_FilterMaskId3 = 0xFF ;
|
||
|
}
|
||
|
}
|
||
|
else if(ide == 1)//扩展帧
|
||
|
{
|
||
|
if(fcase == 0)// 0- 双滤波器模式
|
||
|
{
|
||
|
CAN_FilterId0 = thisid1>>8;
|
||
|
CAN_FilterMaskId0 = thismask1>>8;
|
||
|
CAN_FilterId1 = thisid1 ;
|
||
|
CAN_FilterMaskId1 = thismask1 ;
|
||
|
CAN_FilterId2 = thisid2>>8;
|
||
|
CAN_FilterMaskId2 = thismask2>>8;
|
||
|
CAN_FilterId3 = thisid2 ;
|
||
|
CAN_FilterMaskId3 = thismask2 ;
|
||
|
}
|
||
|
else if(fcase == 1)// 1-单滤波器模式
|
||
|
{
|
||
|
CAN_FilterId0 = thisid>>21;
|
||
|
CAN_FilterMaskId0 = thismask>>21;
|
||
|
CAN_FilterId1 = thisid>>13 ;
|
||
|
CAN_FilterMaskId1 = thismask>>13 ;
|
||
|
CAN_FilterId2 = thisid>>5;
|
||
|
CAN_FilterMaskId2 = thismask>>5;
|
||
|
CAN_FilterId3 = thisid<<3 | rtr<<2;
|
||
|
CAN_FilterMaskId3 = thismask<<3;
|
||
|
CAN_FilterMaskId3 |= 0x03;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* 进入复位模式 */
|
||
|
set_reset_mode(CANx);
|
||
|
|
||
|
if(fcase == 1)// 1-单滤波器模式
|
||
|
{
|
||
|
/*单滤波模式 */
|
||
|
CANx->MOD |= (unsigned char)CAN_Mode_AFM;
|
||
|
}
|
||
|
else if(fcase == 1)// 0- 双滤波器模式
|
||
|
{
|
||
|
/*双滤波模式 */
|
||
|
CANx->MOD &=(~ (unsigned char) CAN_Mode_AFM);
|
||
|
}
|
||
|
|
||
|
CANx->IDE_RTR_DLC = CAN_FilterId0;
|
||
|
CANx->ID[0] = CAN_FilterId1;
|
||
|
CANx->ID[1] = CAN_FilterId2;
|
||
|
CANx->ID[2] = CAN_FilterId3;
|
||
|
CANx->ID[3] = CAN_FilterMaskId0;
|
||
|
CANx->BUF[0] = CAN_FilterMaskId1;
|
||
|
CANx->BUF[1] = CAN_FilterMaskId2;
|
||
|
CANx->BUF[2] = CAN_FilterMaskId3;
|
||
|
/* 进入工作模式 */
|
||
|
set_start(CANx);
|
||
|
}
|
||
|
|
||
|
unsigned char CAN_SetBps(CAN_TypeDef* CANx, Ls1c_CanBPS_t Bps)
|
||
|
{
|
||
|
unsigned char InitStatus = CAN_InitStatus_Failed;
|
||
|
unsigned char CAN_Prescaler, CAN_BS1, CAN_BS2, CAN_SJW;
|
||
|
CAN_SJW = CAN_SJW_1tq;
|
||
|
/* 进入复位模式 */
|
||
|
InitStatus = set_reset_mode(CANx);
|
||
|
if( InitStatus == CAN_InitStatus_Failed)
|
||
|
return CAN_InitStatus_Failed;
|
||
|
|
||
|
/* BaudRate= f(APB)/((1+BS1+BS2)(SJW*2*Prescaler))=126000000/[(1+7+2)*1*2*63]=100000=100K*/
|
||
|
/* BPS PRE BS1 BS2 最低40K
|
||
|
1M 9 4 2
|
||
|
800K 8 7 2
|
||
|
500K 9 11 2
|
||
|
250K 36 4 2
|
||
|
125K 36 11 2
|
||
|
100K 63 7 2
|
||
|
50K 63 16 3`
|
||
|
40K 63 16 8
|
||
|
*/
|
||
|
switch (Bps)
|
||
|
{
|
||
|
case LS1C_CAN1MBaud:
|
||
|
CAN_Prescaler = 9;
|
||
|
CAN_BS1 = CAN_BS1_4tq;
|
||
|
CAN_BS2 = CAN_BS2_2tq;
|
||
|
break;
|
||
|
case LS1C_CAN800kBaud:
|
||
|
CAN_Prescaler = 8;
|
||
|
CAN_BS1 = CAN_BS1_7tq;
|
||
|
CAN_BS2 = CAN_BS2_2tq;
|
||
|
break;
|
||
|
case LS1C_CAN500kBaud:
|
||
|
CAN_Prescaler = 9;
|
||
|
CAN_BS1 = CAN_BS1_11tq;
|
||
|
CAN_BS2 = CAN_BS2_2tq;
|
||
|
break;
|
||
|
case LS1C_CAN250kBaud:
|
||
|
CAN_Prescaler = 36;
|
||
|
CAN_BS1 = CAN_BS1_4tq;
|
||
|
CAN_BS2 = CAN_BS2_2tq;
|
||
|
break;
|
||
|
case LS1C_CAN125kBaud:
|
||
|
CAN_Prescaler = 36;
|
||
|
CAN_BS1 = CAN_BS1_11tq;
|
||
|
CAN_BS2 = CAN_BS2_2tq;
|
||
|
break;
|
||
|
case LS1C_CAN100kBaud:
|
||
|
CAN_Prescaler = 63;
|
||
|
CAN_BS1 = CAN_BS1_7tq;
|
||
|
CAN_BS2 = CAN_BS2_2tq;
|
||
|
break;
|
||
|
case LS1C_CAN50kBaud:
|
||
|
CAN_Prescaler = 63;
|
||
|
CAN_BS1 = CAN_BS1_16tq;
|
||
|
CAN_BS2 = CAN_BS2_3tq;
|
||
|
break;
|
||
|
case LS1C_CAN40kBaud:
|
||
|
CAN_Prescaler = 63;
|
||
|
CAN_BS1 = CAN_BS1_16tq;
|
||
|
CAN_BS2 = CAN_BS2_8tq;
|
||
|
break;
|
||
|
default: //100K
|
||
|
CAN_Prescaler = 63;
|
||
|
CAN_BS1 = CAN_BS1_7tq;
|
||
|
CAN_BS2 = CAN_BS2_2tq;
|
||
|
break;
|
||
|
}
|
||
|
/* 配置时钟频率 */
|
||
|
CANx->BTR0 = (( unsigned char )CAN_Prescaler -1) | \
|
||
|
(unsigned char)CAN_SJW << 6;
|
||
|
|
||
|
CANx->BTR1 = ((unsigned char)CAN_BS1) | \
|
||
|
((unsigned char)CAN_BS2 << 4) | \
|
||
|
((unsigned char)CAN_SJW<<7);
|
||
|
|
||
|
/* 进入工作模式 */
|
||
|
set_start(CANx);
|
||
|
/* 返回初始化结果 */
|
||
|
return CAN_InitStatus_Failed;
|
||
|
}
|
||
|
|
||
|
|
||
|
unsigned char CAN_SetMode(CAN_TypeDef* CANx, unsigned char mode)
|
||
|
{
|
||
|
unsigned char InitStatus = CAN_InitStatus_Failed;
|
||
|
unsigned long wait_ack = 0x00000000;
|
||
|
CAN_InitTypeDef CAN_InitStructure;
|
||
|
|
||
|
/* 进入复位模式 */
|
||
|
InitStatus = set_reset_mode(CANx);
|
||
|
if( InitStatus == CAN_InitStatus_Failed)
|
||
|
return CAN_InitStatus_Failed;
|
||
|
|
||
|
switch( mode )
|
||
|
{
|
||
|
case 0://正常
|
||
|
CANx->MOD &= ~(unsigned char)CAN_Mode_STM;
|
||
|
CANx->MOD &= ~(unsigned char)CAN_Mode_LOM;
|
||
|
break;
|
||
|
case 1://只听
|
||
|
CANx->MOD &= ~(unsigned char)CAN_Mode_STM;
|
||
|
CANx->MOD |= (unsigned char)CAN_Mode_LOM;
|
||
|
break;
|
||
|
case 2://回环
|
||
|
CANx->MOD |= (unsigned char)CAN_Mode_STM;
|
||
|
CANx->MOD &= ~(unsigned char)CAN_Mode_LOM;
|
||
|
break;
|
||
|
case 3://只听回环
|
||
|
CANx->MOD |= (unsigned char)CAN_Mode_STM;
|
||
|
CANx->MOD |= (unsigned char)CAN_Mode_LOM;
|
||
|
break;
|
||
|
}
|
||
|
/* 进入工作模式 */
|
||
|
set_start(CANx);
|
||
|
|
||
|
/* 返回初始化结果 */
|
||
|
return CAN_InitStatus_Failed;
|
||
|
}
|
||
|
|
||
|
unsigned char CAN_Transmit(CAN_TypeDef* CANx, CanTxMsg* TxMessage)
|
||
|
{
|
||
|
int i;
|
||
|
if (TxMessage->IDE == CAN_Id_Extended)
|
||
|
{
|
||
|
CANx->ID[0]= TxMessage ->ExtId>> 21;
|
||
|
CANx->ID[1]= TxMessage ->ExtId>> 13;
|
||
|
CANx->ID[2]= TxMessage ->ExtId>> 5;
|
||
|
CANx->ID[3]= TxMessage ->ExtId<<3;
|
||
|
CANx->IDE_RTR_DLC= (TxMessage ->IDE & 0x01) << 7 |\
|
||
|
(TxMessage ->RTR & 0x01) << 6 |\
|
||
|
(TxMessage ->DLC & 0x0F);
|
||
|
for( i=0;i<TxMessage ->DLC; i++)
|
||
|
{
|
||
|
CANx->BUF[i]= TxMessage->Data[i];
|
||
|
}
|
||
|
}
|
||
|
else if (TxMessage->IDE ==CAN_Id_Standard)
|
||
|
{
|
||
|
CANx->ID[0]= TxMessage ->StdId>> 3;
|
||
|
CANx->ID[1]= TxMessage ->StdId<< 5;
|
||
|
CANx->IDE_RTR_DLC= (TxMessage ->IDE & 0x01) << 7 |\
|
||
|
(TxMessage ->RTR & 0x01) << 6 |\
|
||
|
(TxMessage ->DLC & 0x0F);
|
||
|
CANx->ID[2]= TxMessage ->Data[0];
|
||
|
CANx->ID[3]= TxMessage ->Data[1];
|
||
|
for( i=0;i<TxMessage ->DLC-2; i++)
|
||
|
{
|
||
|
CANx->BUF[i]= TxMessage->Data[i+2];
|
||
|
}
|
||
|
}
|
||
|
CANx->CMR = CAN_CMR_TR ;
|
||
|
}
|
||
|
|
||
|
void CAN_Receive(CAN_TypeDef* CANx, CanRxMsg* RxMessage)
|
||
|
{
|
||
|
/* 获取 IDE */
|
||
|
RxMessage->IDE = (CANx->IDE_RTR_DLC & 0x80)>>7;
|
||
|
/* 获取 RTR */
|
||
|
RxMessage->RTR = (CANx->IDE_RTR_DLC & 0x40)>>4;
|
||
|
/* 获取 DLC */
|
||
|
RxMessage->DLC= (CANx->IDE_RTR_DLC & 0x0F);
|
||
|
if (RxMessage->IDE == CAN_Id_Standard)
|
||
|
{
|
||
|
RxMessage->StdId = CANx->ID[0]<<3 |CANx->ID[1]>>5 ;
|
||
|
/* 获取数据 */
|
||
|
RxMessage->Data[0] = (unsigned char)CANx->ID[2];
|
||
|
RxMessage->Data[1] = (unsigned char)CANx->ID[3];
|
||
|
RxMessage->Data[2] = (unsigned char)CANx->BUF[0];
|
||
|
RxMessage->Data[3] = (unsigned char)CANx->BUF[1];
|
||
|
RxMessage->Data[4] = (unsigned char)CANx->BUF[2];
|
||
|
RxMessage->Data[5] = (unsigned char)CANx->BUF[3];
|
||
|
RxMessage->Data[6] = (unsigned char)CANx->BUF[4];
|
||
|
RxMessage->Data[7] = (unsigned char)CANx->BUF[5];
|
||
|
}
|
||
|
else if (RxMessage->IDE == CAN_Id_Extended)
|
||
|
{
|
||
|
RxMessage->ExtId= CANx->ID[0]<<21 |CANx->ID[1]<<13|CANx->ID[2]<<5|CANx->ID[3]>>3 ;
|
||
|
/* 获取数据 */
|
||
|
RxMessage->Data[0] = (unsigned char)CANx->BUF[0];
|
||
|
RxMessage->Data[1] = (unsigned char)CANx->BUF[1];
|
||
|
RxMessage->Data[2] = (unsigned char)CANx->BUF[2];
|
||
|
RxMessage->Data[3] = (unsigned char)CANx->BUF[3];
|
||
|
RxMessage->Data[4] = (unsigned char)CANx->BUF[4];
|
||
|
RxMessage->Data[5] = (unsigned char)CANx->BUF[5];
|
||
|
RxMessage->Data[6] = (unsigned char)CANx->BUF[6];
|
||
|
RxMessage->Data[7] = (unsigned char)CANx->BUF[7];
|
||
|
}
|
||
|
}
|
||
|
|