| 12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385 |
- /*
- * Copyright (C) 2022-2024, Xiaohua Semiconductor Co., Ltd.
- *
- * SPDX-License-Identifier: Apache-2.0
- *
- * Change Logs:
- * Date Author Notes
- * 2022-04-28 CDT first version
- * 2022-06-07 xiaoxiaolisunny add hc32f460 series
- * 2022-06-08 CDT fix a bug of RT_CAN_CMD_SET_FILTER
- * 2022-06-15 lianghongquan fix bug, CAN_FILTER_COUNT, RT_CAN_CMD_SET_FILTER, interrupt setup and processing.
- */
- #include "drv_can.h"
- #include <drv_config.h>
- #include <board_config.h>
- #if defined(BSP_USING_CAN)
- #define LOG_TAG "drv_can"
- #if defined(BSP_USING_CAN1) || defined(BSP_USING_CAN2) || defined(BSP_USING_CAN3)
- #if defined(RT_CAN_USING_CANFD) && defined(HC32F460)
- #error "Selected mcu does not support canfd!"
- #endif
- #define TSEG1_MIN_FOR_CAN2_0 (2U)
- #define TSEG1_MAX_FOR_CAN2_0 (65U)
- #define TSEG2_MIN_FOR_CAN2_0 (1U)
- #define TSEG2_MAX_FOR_CAN2_0 (8U)
- #if defined(HC32F4A0) || defined(HC32F472) || defined(HC32F4A8)
- #define TSJW_MIN_FOR_CAN2_0 (1U)
- #define TSJW_MAX_FOR_CAN2_0 (16U)
- #elif defined(HC32F460)
- #define TSJW_MIN_FOR_CAN2_0 (1U)
- #define TSJW_MAX_FOR_CAN2_0 (8U)
- #endif
- #define NUM_TQ_MIN_FOR_CAN2_0 (8U)
- #define NUM_TQ_MAX_FOR_CAN2_0 (TSEG1_MAX_FOR_CAN2_0 + TSEG2_MAX_FOR_CAN2_0)
- #define CAN_BIT_TIMING_CAN2_0 (1U << 0)
- #define IS_VALID_PRIV_MODE(mode) ((mode == RT_CAN_MODE_PRIV) || (mode == RT_CAN_MODE_NOPRIV))
- #define IS_VALID_WORK_MODE(mode) (mode <= RT_CAN_MODE_LOOPBACKANLISTEN)
- #define IS_VALID_BAUD_RATE_CAN2_0(baud) (baud == (CAN10kBaud) || baud == (CAN20kBaud) || \
- baud == (CAN50kBaud) || baud == (CAN100kBaud) || \
- baud == (CAN125kBaud) || baud == (CAN250kBaud) || \
- baud == (CAN500kBaud) || baud == (CAN800kBaud) || \
- baud == (CAN1MBaud))
- #if defined(RT_CAN_USING_CANFD)
- #define TSEG1_MIN_FOR_CANFD_ARBITRATION (2U)
- #define TSEG1_MAX_FOR_CANFD_ARBITRATION (65U)
- #define TSEG2_MIN_FOR_CANFD_ARBITRATION (1U)
- #define TSEG2_MAX_FOR_CANFD_ARBITRATION (32U)
- #define TSJW_MIN_FOR_CANFD_ARBITRATION (1U)
- #define TSJW_MAX_FOR_CANFD_ARBITRATION (16U)
- #define TSEG1_MIN_FOR_CANFD_DATA (2U)
- #define TSEG1_MAX_FOR_CANFD_DATA (17U)
- #define TSEG2_MIN_FOR_CANFD_DATA (1U)
- #define TSEG2_MAX_FOR_CANFD_DATA (8U)
- #define TSJW_MIN_FOR_CANFD_DATA (1U)
- #define TSJW_MAX_FOR_CANFD_DATA (8U)
- #define NUM_TQ_MIN_FOR_CANFD_ARBITRATION (8U)
- #define NUM_TQ_MAX_FOR_CANFD_ARBITRATION (TSEG1_MAX_FOR_CANFD_ARBITRATION + TSEG2_MAX_FOR_CANFD_ARBITRATION)
- #define NUM_TQ_MIN_FOR_CANFD_DATA (8U)
- #define NUM_TQ_MAX_FOR_CANFD_DATA (TSEG1_MAX_FOR_CANFD_DATA + TSEG2_MAX_FOR_CANFD_DATA)
- #define IS_VALID_BAUD_RATE_CANFD_ARBITRATION(baud) IS_VALID_BAUD_RATE_CAN2_0(baud)
- #define IS_VALID_BAUD_RATE_CANFD_DATA(baud) (baud == (CAN10kBaud) || baud == (CAN20kBaud) || \
- baud == (CAN50kBaud) || baud == (CAN100kBaud) || \
- baud == (CAN125kBaud) || baud == (CAN250kBaud) || \
- baud == (CAN500kBaud) || baud == (CAN800kBaud) || \
- baud == (CAN1MBaud) || \
- baud == (CANFD_DATA_BAUD_2M) || \
- baud == (CANFD_DATA_BAUD_4M) || \
- baud == (CANFD_DATA_BAUD_5M) || \
- baud == (CANFD_DATA_BAUD_8M))
- #define IS_CAN_FRAME(frame) ((frame) == CAN_FRAME_CLASSIC || \
- (frame) == CAN_FRAME_ISO_FD || \
- (frame) == CAN_FRAME_NON_ISO_FD)
- #define CAN_BIT_TIMING_CANFD_ARBITRATION (1U << 1)
- #define CAN_BIT_TIMING_CANFD_DATA (1U << 2)
- #define CAN_BIT_TIMING_TABLE_NUM (3U)
- #endif
- #define NUM_PRESCALE_MAX (256U)
- #if defined(HC32F4A0) || defined(HC32F4A8)
- #define CAN_FILTER_COUNT (16U)
- #define CAN1_INT_SRC (INT_SRC_CAN1_HOST)
- #define CAN2_INT_SRC (INT_SRC_CAN2_HOST)
- #elif defined (HC32F460)
- #define CAN_FILTER_COUNT (8U)
- #define CAN1_INT_SRC (INT_SRC_CAN_INT)
- #elif defined (HC32F472)
- #define CAN_FILTER_COUNT (16U)
- #define CAN1_INT_SRC (INT_SRC_CAN1_HOST)
- #define CAN2_INT_SRC (INT_SRC_CAN2_HOST)
- #define CAN3_INT_SRC (INT_SRC_CAN3_HOST)
- #endif
- enum
- {
- #ifdef BSP_USING_CAN1
- CAN1_INDEX,
- #endif
- #ifdef BSP_USING_CAN2
- CAN2_INDEX,
- #endif
- #ifdef BSP_USING_CAN3
- CAN3_INDEX,
- #endif
- CAN_INDEX_MAX,
- };
- struct can_baud_rate_tab
- {
- rt_uint32_t baud_rate;
- stc_can_bit_time_config_t ll_sbt;
- };
- struct canfd_baud_rate_tab
- {
- rt_uint32_t clk_src;
- rt_uint8_t phase;
- rt_uint32_t baud;
- stc_can_bit_time_config_t ll_bt;
- };
- typedef struct
- {
- uint8_t tq_min;
- uint8_t tq_max;
- uint8_t seg1_min;
- uint8_t seg1_max;
- uint8_t seg2_min;
- uint8_t seg2_max;
- uint8_t sjw_min;
- uint8_t sjw_max;
- uint8_t min_diff_seg1_minus_seg2;
- } can_bit_timing_table_t;
- #ifndef RT_CAN_USING_CANFD
- static const struct can_baud_rate_tab _g_baudrate_tab[] =
- {
- {CAN1MBaud, CAN_BIT_TIME_CONFIG_1M_BAUD},
- {CAN800kBaud, CAN_BIT_TIME_CONFIG_800K_BAUD},
- {CAN500kBaud, CAN_BIT_TIME_CONFIG_500K_BAUD},
- {CAN250kBaud, CAN_BIT_TIME_CONFIG_250K_BAUD},
- {CAN125kBaud, CAN_BIT_TIME_CONFIG_125K_BAUD},
- {CAN100kBaud, CAN_BIT_TIME_CONFIG_100K_BAUD},
- {CAN50kBaud, CAN_BIT_TIME_CONFIG_50K_BAUD},
- {CAN20kBaud, CAN_BIT_TIME_CONFIG_20K_BAUD},
- {CAN10kBaud, CAN_BIT_TIME_CONFIG_10K_BAUD},
- };
- #endif
- typedef struct
- {
- struct rt_can_device rt_can;
- struct can_dev_init_params init;
- CM_CAN_TypeDef *instance;
- stc_can_init_t ll_init;
- } can_device;
- #ifdef RT_CAN_USING_CANFD
- static const can_bit_timing_table_t _g_can_bit_timing_tbl[CAN_BIT_TIMING_TABLE_NUM] =
- {
- {
- .tq_min = NUM_TQ_MIN_FOR_CAN2_0,
- .tq_max = NUM_TQ_MAX_FOR_CAN2_0,
- .seg1_min = TSEG1_MIN_FOR_CAN2_0,
- .seg1_max = TSEG1_MAX_FOR_CAN2_0,
- .seg2_min = TSEG2_MIN_FOR_CAN2_0,
- .seg2_max = TSEG2_MAX_FOR_CAN2_0,
- .sjw_min = TSJW_MIN_FOR_CAN2_0,
- .sjw_max = TSJW_MAX_FOR_CAN2_0,
- .min_diff_seg1_minus_seg2 = 2,
- },
- {
- .tq_min = NUM_TQ_MIN_FOR_CANFD_ARBITRATION,
- .tq_max = NUM_TQ_MAX_FOR_CANFD_ARBITRATION,
- .seg1_min = TSEG1_MIN_FOR_CANFD_ARBITRATION,
- .seg1_max = TSEG1_MAX_FOR_CANFD_ARBITRATION,
- .seg2_min = TSEG2_MIN_FOR_CANFD_ARBITRATION,
- .seg2_max = TSEG2_MAX_FOR_CANFD_ARBITRATION,
- .sjw_min = TSJW_MIN_FOR_CANFD_ARBITRATION,
- .sjw_max = TSJW_MAX_FOR_CANFD_ARBITRATION,
- .min_diff_seg1_minus_seg2 = 2,
- },
- {
- .tq_min = NUM_TQ_MIN_FOR_CANFD_DATA,
- .tq_max = NUM_TQ_MAX_FOR_CANFD_DATA,
- .seg1_min = TSEG1_MIN_FOR_CANFD_DATA,
- .seg1_max = TSEG1_MAX_FOR_CANFD_DATA,
- .seg2_min = TSEG2_MIN_FOR_CANFD_DATA,
- .seg2_max = TSEG2_MAX_FOR_CANFD_DATA,
- .sjw_min = TSJW_MIN_FOR_CANFD_DATA,
- .sjw_max = TSJW_MAX_FOR_CANFD_DATA,
- .min_diff_seg1_minus_seg2 = 1,
- }
- };
- static const struct canfd_baud_rate_tab _g_baudrate_fd[] =
- {
- {CAN_CLOCK_SRC_20M, CAN_BIT_TIMING_CANFD_ARBITRATION, CANFD_ARBITRATION_BAUD_250K, 1U, 64U, 16U, 16U},
- {CAN_CLOCK_SRC_20M, CAN_BIT_TIMING_CANFD_ARBITRATION, CANFD_ARBITRATION_BAUD_500K, 1U, 32U, 8U, 8U},
- {CAN_CLOCK_SRC_20M, CAN_BIT_TIMING_CANFD_DATA, CANFD_DATA_BAUD_1M, 1U, 16U, 4U, 4U},
- {CAN_CLOCK_SRC_20M, CAN_BIT_TIMING_CANFD_DATA, CANFD_DATA_BAUD_2M, 1U, 8U, 2U, 2U},
- {CAN_CLOCK_SRC_20M, CAN_BIT_TIMING_CANFD_DATA, CANFD_DATA_BAUD_4M, 1U, 4U, 1U, 1U},
- {CAN_CLOCK_SRC_20M, CAN_BIT_TIMING_CANFD_DATA, CANFD_DATA_BAUD_5M, 1U, 3U, 1U, 1U},
- {CAN_CLOCK_SRC_40M, CAN_BIT_TIMING_CANFD_ARBITRATION, CANFD_ARBITRATION_BAUD_250K, 2U, 64U, 16U, 16U},
- {CAN_CLOCK_SRC_40M, CAN_BIT_TIMING_CANFD_ARBITRATION, CANFD_ARBITRATION_BAUD_500K, 1U, 64U, 16U, 16U},
- {CAN_CLOCK_SRC_40M, CAN_BIT_TIMING_CANFD_DATA, CANFD_DATA_BAUD_1M, 2U, 16U, 4U, 4U},
- {CAN_CLOCK_SRC_40M, CAN_BIT_TIMING_CANFD_DATA, CANFD_DATA_BAUD_2M, 1U, 16U, 4U, 4U},
- {CAN_CLOCK_SRC_40M, CAN_BIT_TIMING_CANFD_DATA, CANFD_DATA_BAUD_4M, 1U, 8U, 2U, 2U},
- {CAN_CLOCK_SRC_40M, CAN_BIT_TIMING_CANFD_DATA, CANFD_DATA_BAUD_5M, 1U, 6U, 2U, 2U},
- {CAN_CLOCK_SRC_40M, CAN_BIT_TIMING_CANFD_DATA, CANFD_DATA_BAUD_8M, 1U, 4U, 1U, 1U},
- {CAN_CLOCK_SRC_80M, CAN_BIT_TIMING_CANFD_ARBITRATION, CANFD_ARBITRATION_BAUD_250K, 4U, 64U, 16U},
- {CAN_CLOCK_SRC_80M, CAN_BIT_TIMING_CANFD_ARBITRATION, CANFD_ARBITRATION_BAUD_500K, 2U, 64U, 16U},
- {CAN_CLOCK_SRC_80M, CAN_BIT_TIMING_CANFD_DATA, CANFD_DATA_BAUD_1M, 4U, 16U, 4U, 4U},
- {CAN_CLOCK_SRC_80M, CAN_BIT_TIMING_CANFD_DATA, CANFD_DATA_BAUD_2M, 2U, 16U, 4U, 4U},
- {CAN_CLOCK_SRC_80M, CAN_BIT_TIMING_CANFD_DATA, CANFD_DATA_BAUD_4M, 1U, 16U, 4U, 4U},
- {CAN_CLOCK_SRC_80M, CAN_BIT_TIMING_CANFD_DATA, CANFD_DATA_BAUD_5M, 1U, 12U, 4U, 4U},
- {CAN_CLOCK_SRC_80M, CAN_BIT_TIMING_CANFD_DATA, CANFD_DATA_BAUD_8M, 1U, 8U, 2U, 2U},
- };
- #endif
- static can_device _g_can_dev_array[] =
- {
- #ifdef BSP_USING_CAN1
- {
- {0},
- CAN1_INIT_PARAMS,
- #if defined(HC32F4A0) || defined(HC32F472) || defined(HC32F4A8)
- .instance = CM_CAN1,
- #elif defined (HC32F460)
- .instance = CM_CAN,
- #endif
- },
- #endif
- #ifdef BSP_USING_CAN2
- {
- {0},
- CAN2_INIT_PARAMS,
- .instance = CM_CAN2,
- },
- #endif
- #ifdef BSP_USING_CAN3
- {
- {0},
- CAN3_INIT_PARAMS,
- .instance = CM_CAN3,
- },
- #endif
- };
- static void _init_ll_struct_filter(can_device *p_can_dev);
- #ifndef RT_CAN_USING_CANFD
- static rt_uint32_t _get_can_baud_index(rt_uint32_t baud)
- {
- rt_uint32_t len, index;
- len = sizeof(_g_baudrate_tab) / sizeof(_g_baudrate_tab[0]);
- for (index = 0; index < len; index++)
- {
- if (_g_baudrate_tab[index].baud_rate == baud)
- return index;
- }
- return 0; /* default baud is CAN1MBaud */
- }
- #endif
- static rt_uint32_t _get_can_work_mode(rt_uint32_t mode)
- {
- rt_uint32_t work_mode;
- switch (mode)
- {
- case RT_CAN_MODE_NORMAL:
- work_mode = CAN_WORK_MD_NORMAL;
- break;
- case RT_CAN_MODE_LISTEN:
- work_mode = CAN_WORK_MD_SILENT;
- break;
- case RT_CAN_MODE_LOOPBACK:
- work_mode = CAN_WORK_MD_ELB;
- break;
- case RT_CAN_MODE_LOOPBACKANLISTEN:
- work_mode = CAN_WORK_MD_ELB_SILENT;
- break;
- default:
- work_mode = CAN_WORK_MD_NORMAL;
- break;
- }
- return work_mode;
- }
- static uint32_t _get_filter_idx(struct rt_can_filter_config *p_filter_in)
- {
- uint32_t filter_selected = 0;
- for (int i = 0; i < p_filter_in->count; i++)
- {
- if (p_filter_in->items[i].hdr_bank != -1)
- {
- filter_selected |= 1 << p_filter_in->items[i].hdr_bank;
- }
- }
- for (int i = 0; i < p_filter_in->count; i++)
- {
- if (p_filter_in->items[i].hdr_bank == -1)
- {
- for (int j = 0; j < CAN_FILTER_COUNT; j++)
- {
- if ((filter_selected & 1 << j) == 0)
- {
- p_filter_in->items[i].hdr_bank = j;
- filter_selected |= 1 << p_filter_in->items[i].hdr_bank;
- break;
- }
- }
- }
- }
- return filter_selected;
- }
- static uint8_t _get_can_data_bytes_len(uint32_t dlc)
- {
- uint8_t data_bytes = 0;
- dlc &= 0xFU;
- if (dlc <= 8U)
- {
- data_bytes = dlc;
- }
- #ifdef RT_CAN_USING_CANFD
- else
- {
- #ifdef RT_CAN_USING_CANFD
- switch (dlc)
- {
- case CAN_DLC12:
- data_bytes = 12U;
- break;
- case CAN_DLC16:
- data_bytes = 16U;
- break;
- case CAN_DLC20:
- data_bytes = 20U;
- break;
- case CAN_DLC24:
- data_bytes = 24U;
- break;
- case CAN_DLC32:
- data_bytes = 32U;
- break;
- case CAN_DLC48:
- data_bytes = 48U;
- break;
- case CAN_DLC64:
- data_bytes = 64U;
- break;
- default:
- /* Code should never touch here */
- break;
- }
- #endif
- }
- #endif
- return data_bytes;
- }
- static rt_bool_t _check_filter_params(struct rt_can_filter_config *p_filter_in)
- {
- RT_ASSERT(p_filter_in != NULL);
- RT_ASSERT(p_filter_in->count <= CAN_FILTER_COUNT);
- for (int i = 0; i < p_filter_in->count; i++)
- {
- if (p_filter_in->items[i].hdr_bank != -1 && p_filter_in->items[i].hdr_bank >= CAN_FILTER_COUNT)
- {
- RT_ASSERT(p_filter_in->items[i].hdr_bank < CAN_FILTER_COUNT);
- return RT_FALSE;
- }
- if (p_filter_in->items[i].mode == 0)
- {
- RT_ASSERT(p_filter_in->items[i].mode == 1);
- return RT_FALSE;
- }
- if (p_filter_in->items[i].rtr == 1)
- {
- RT_ASSERT(p_filter_in->items[i].rtr == 0);
- return RT_FALSE;
- }
- }
- return RT_TRUE;
- }
- #ifdef RT_CAN_USING_CANFD
- static uint32_t _get_can_clk_src(CM_CAN_TypeDef *CANx)
- {
- uint32_t can_clk = 0;
- switch ((rt_uint32_t)CANx)
- {
- #ifdef BSP_USING_CAN1
- case (rt_uint32_t)CM_CAN1:
- can_clk = CAN1_CLOCK_SEL;
- break;
- #endif
- #ifdef BSP_USING_CAN2
- case (rt_uint32_t)CM_CAN2:
- can_clk = CAN2_CLOCK_SEL;
- break;
- #endif
- #ifdef BSP_USING_CAN3
- case (rt_uint32_t)CM_CAN3:
- can_clk = CAN3_CLOCK_SEL;
- break;
- #endif
- default:
- break;
- }
- return can_clk;
- }
- static rt_bool_t _get_can_bit_timing_default(uint32_t can_clk, rt_uint32_t baud, rt_uint32_t option,
- stc_can_bit_time_config_t *p_stc_bit_cfg)
- {
- rt_uint32_t len, index;
- rt_bool_t found = RT_FALSE;
- len = sizeof(_g_baudrate_fd) / sizeof(_g_baudrate_fd[0]);
- for (index = 0; index < len; index++)
- {
- if ((_g_baudrate_fd[index].clk_src == can_clk) && \
- ((_g_baudrate_fd[index].phase & option) == option) \
- )
- {
- if (_g_baudrate_fd[index].baud == baud)
- {
- found = RT_TRUE;
- break;
- }
- }
- }
- if (found)
- {
- rt_memcpy(p_stc_bit_cfg, &_g_baudrate_fd[index].ll_bt, sizeof(stc_can_bit_time_config_t));
- }
- return found;
- }
- static inline void _get_can_bit_timing(stc_can_bit_time_config_t *p_ll_time, struct rt_can_bit_timing *p_cfg_time)
- {
- p_ll_time->u32Prescaler = p_cfg_time->prescaler;
- p_ll_time->u32TimeSeg1 = p_cfg_time->num_seg1;
- p_ll_time->u32TimeSeg2 = p_cfg_time->num_seg2;
- p_ll_time->u32SJW = p_cfg_time->num_sjw;
- }
- static inline void _get_can_bit_timing_fd(stc_canfd_config_t *p_ll_time, struct rt_can_bit_timing *p_cfg_time)
- {
- p_ll_time->stcBitCfg.u32Prescaler = p_cfg_time->prescaler;
- p_ll_time->stcBitCfg.u32TimeSeg1 = p_cfg_time->num_seg1;
- p_ll_time->stcBitCfg.u32TimeSeg2 = p_cfg_time->num_seg2;
- p_ll_time->stcBitCfg.u32SJW = p_cfg_time->num_sjw;
- p_ll_time->u8SSPOffset = p_cfg_time->num_sspoff;
- if (p_cfg_time->num_sspoff)
- {
- p_ll_time->u8TDC = CAN_FD_TDC_ENABLE;
- }
- }
- static rt_err_t _get_can_closest_prescaler(uint32_t num_tq_mul_prescaler, uint32_t start_prescaler,
- uint32_t max_tq, uint32_t min_tq)
- {
- rt_bool_t has_found = RT_FALSE;
- uint32_t prescaler = start_prescaler;
- while (!has_found)
- {
- if ((num_tq_mul_prescaler / prescaler > max_tq) || (num_tq_mul_prescaler % prescaler != 0))
- {
- ++prescaler;
- continue;
- }
- else
- {
- has_found = RT_TRUE;
- break;
- }
- }
- uint32_t tq = num_tq_mul_prescaler / prescaler;
- if (tq * prescaler == num_tq_mul_prescaler)
- {
- has_found = RT_TRUE;
- }
- else if (tq < min_tq)
- {
- has_found = RT_FALSE;
- }
- return has_found ? prescaler : 0U;
- }
- static rt_err_t _calc_can_bit_timing(CM_CAN_TypeDef *CANx, int option, uint32_t baudrate,
- stc_can_bit_time_config_t *p_stc_bit_cfg)
- {
- rt_err_t status = -RT_ERROR;
- uint32_t can_clk = _get_can_clk_src(CANx);
- if (_get_can_bit_timing_default(can_clk, baudrate, option, p_stc_bit_cfg) == RT_TRUE)
- {
- status = RT_EOK;
- return status;
- }
- do
- {
- uint8_t idx = 0;
- for (int i = 0; i < CAN_BIT_TIMING_TABLE_NUM; i++)
- {
- if (option & (1 << i))
- {
- idx = (uint8_t)i;
- break;
- }
- }
- if ((idx >= CAN_BIT_TIMING_TABLE_NUM) || (baudrate == 0U) || (p_stc_bit_cfg == NULL))
- {
- break;
- }
- const can_bit_timing_table_t *tbl = &_g_can_bit_timing_tbl[idx];
- if (can_clk / baudrate < tbl->tq_min)
- {
- break;
- }
- uint32_t num_tq_mul_prescaler = can_clk / baudrate;
- uint32_t start_prescaler = 1U;
- uint32_t num_seg1, num_seg2;
- rt_bool_t has_found = RT_FALSE;
- /* Find out the minimum prescaler */
- uint32_t current_prescaler;
- while (!has_found)
- {
- current_prescaler = _get_can_closest_prescaler(num_tq_mul_prescaler, start_prescaler,
- tbl->tq_max,
- tbl->tq_min);
- if ((current_prescaler < start_prescaler) || (current_prescaler > NUM_PRESCALE_MAX))
- {
- break;
- }
- uint32_t num_tq = num_tq_mul_prescaler / current_prescaler;
- num_seg2 = (num_tq - tbl->min_diff_seg1_minus_seg2) / 2U;
- num_seg1 = num_tq - num_seg2;
- while (num_seg2 > tbl->seg2_max)
- {
- num_seg2--;
- num_seg1++;
- }
- /* Recommended sample point is 75% - 80% */
- while ((num_seg1 * 1000U) / num_tq < CAN_SAMPLEPOINT_MIN)
- {
- ++num_seg1;
- --num_seg2;
- }
- if ((num_seg1 * 1000U) / num_tq > CAN_SAMPLEPOINT_MAX)
- {
- break;
- }
- if ((num_seg2 >= tbl->seg2_min) && (num_seg1 <= tbl->seg1_max))
- {
- has_found = RT_TRUE;
- }
- else
- {
- start_prescaler = current_prescaler + 1U;
- }
- }
- if (has_found)
- {
- uint32_t num_sjw = LL_MIN(tbl->sjw_max, num_seg2);
- p_stc_bit_cfg->u32TimeSeg1 = num_seg1;
- p_stc_bit_cfg->u32TimeSeg2 = num_seg2;
- p_stc_bit_cfg->u32SJW = num_sjw;
- p_stc_bit_cfg->u32Prescaler = current_prescaler;
- status = RT_EOK;
- }
- }
- while (RT_FALSE);
- return status;
- }
- #else
- static rt_err_t _config_can20_baud(can_device *p_can_dev, void *arg)
- {
- rt_uint32_t argval = (rt_uint32_t)arg;
- rt_uint32_t baud_index;
- rt_err_t rt_ret = RT_EOK;
- RT_ASSERT(IS_VALID_BAUD_RATE_CAN2_0(argval));
- if (argval == p_can_dev->rt_can.config.baud_rate)
- {
- return rt_ret;
- }
- baud_index = _get_can_baud_index(argval);
- p_can_dev->ll_init.stcBitCfg = _g_baudrate_tab[baud_index].ll_sbt;
- /* init can */
- CAN_Init(p_can_dev->instance, &p_can_dev->ll_init);
- p_can_dev->rt_can.config.baud_rate = argval;
- return rt_ret;
- }
- #endif
- static rt_err_t _config_can_filter(can_device *p_can_dev, void *arg)
- {
- struct rt_can_filter_config *p_filter_in = (struct rt_can_filter_config *)arg;
- if (_check_filter_params(p_filter_in) == RT_FALSE)
- {
- return -RT_EINVAL;
- }
- _init_ll_struct_filter(p_can_dev);
- uint32_t filter_select = _get_filter_idx(p_filter_in);
- p_can_dev->ll_init.u16FilterSelect = filter_select;
- for (int i = 0; i < p_filter_in->count; i++)
- {
- p_can_dev->ll_init.pstcFilter[i].u32ID = p_filter_in->items[i].id & 0x1FFFFFFF;
- /* rt-thread CAN mask, 1 mean filer, 0 mean ignore. *
- * HDSC HC32 CAN mask, 0 mean filer, 1 mean ignore. */
- p_can_dev->ll_init.pstcFilter[i].u32IDMask = (~p_filter_in->items[i].mask) & 0x1FFFFFFF;
- switch (p_filter_in->items[i].ide)
- {
- case (RT_CAN_STDID):
- p_can_dev->ll_init.pstcFilter[i].u32IDType = CAN_ID_STD;
- break;
- case (RT_CAN_EXTID):
- p_can_dev->ll_init.pstcFilter[i].u32IDType = CAN_ID_EXT;
- break;
- default:
- p_can_dev->ll_init.pstcFilter[i].u32IDType = CAN_ID_STD_EXT;
- break;
- }
- }
- (void)CAN_Init(p_can_dev->instance, &p_can_dev->ll_init);
- return RT_EOK;
- }
- static rt_err_t _config_can_work_mode(can_device *p_can_dev, void *arg)
- {
- rt_err_t rt_ret = RT_EOK;
- rt_uint32_t argval = (rt_uint32_t) arg;
- if (argval == p_can_dev->rt_can.config.mode)
- {
- return rt_ret;
- }
- RT_ASSERT(IS_VALID_WORK_MODE(argval));
- p_can_dev->ll_init.u8WorkMode = _get_can_work_mode(argval);
- CAN_Init(p_can_dev->instance, &p_can_dev->ll_init);
- p_can_dev->rt_can.config.mode = argval;
- return rt_ret;
- }
- static rt_err_t _config_can_priv_mode(can_device *p_can_dev, void *arg)
- {
- rt_err_t rt_ret = RT_EOK;
- rt_uint32_t argval = (rt_uint32_t) arg;
- RT_ASSERT(IS_VALID_PRIV_MODE(argval));
- p_can_dev->rt_can.config.privmode = argval;
- return rt_ret;
- }
- static void _config_can_int(can_device *p_can_dev, int cmd, void *arg)
- {
- en_functional_state_t stat = ENABLE;
- rt_uint32_t flag = (rt_uint32_t)arg;
- if (cmd == RT_DEVICE_CTRL_CLR_INT)
- {
- if (flag == RT_DEVICE_CAN_INT_ERR)
- {
- RT_ASSERT(p_can_dev->init.single_trans_mode == RT_FALSE);
- }
- stat = DISABLE;
- }
- switch (flag)
- {
- case RT_DEVICE_FLAG_INT_RX:
- CAN_IntCmd(p_can_dev->instance, CAN_INT_RX, stat);
- CAN_IntCmd(p_can_dev->instance, CAN_INT_RX_BUF_WARN, stat);
- CAN_IntCmd(p_can_dev->instance, CAN_INT_RX_BUF_FULL, stat);
- CAN_IntCmd(p_can_dev->instance, CAN_INT_RX_OVERRUN, stat);
- break;
- case RT_DEVICE_FLAG_INT_TX:
- CAN_IntCmd(p_can_dev->instance, CAN_INT_STB_TX, stat);
- CAN_IntCmd(p_can_dev->instance, CAN_INT_PTB_TX, stat);
- break;
- case RT_DEVICE_CAN_INT_ERR:
- CAN_IntCmd(p_can_dev->instance, CAN_INT_ERR_INT, stat);
- CAN_IntCmd(p_can_dev->instance, CAN_INT_ARBITR_LOST, stat);
- CAN_IntCmd(p_can_dev->instance, CAN_INT_ERR_PASSIVE, stat);
- CAN_IntCmd(p_can_dev->instance, CAN_INT_BUS_ERR, stat);
- break;
- default:
- break;
- }
- }
- #ifdef RT_CAN_USING_CANFD
- static void _init_ll_struct_canfd(can_device *p_can_dev)
- {
- if (p_can_dev->ll_init.pstcCanFd == NULL)
- {
- p_can_dev->ll_init.pstcCanFd = (stc_canfd_config_t *)rt_malloc(sizeof(stc_canfd_config_t));
- }
- RT_ASSERT((p_can_dev->ll_init.pstcCanFd != RT_NULL));
- CAN_FD_StructInit(p_can_dev->ll_init.pstcCanFd);
- }
- static rt_err_t _config_can_bit_timing(can_device *p_can_dev, void *arg)
- {
- rt_err_t rt_ret = RT_EOK;
- struct rt_can_bit_timing_config *timing_configs = (struct rt_can_bit_timing_config *)arg;
- RT_ASSERT(timing_configs != RT_NULL);
- RT_ASSERT(timing_configs->count == 1 || timing_configs->count == 2);
- RT_ASSERT(timing_configs->items[0].num_sspoff == 0);
- _get_can_bit_timing(&p_can_dev->ll_init.stcBitCfg, &timing_configs->items[0]);
- if (timing_configs->count == 2)
- {
- _get_can_bit_timing_fd(p_can_dev->ll_init.pstcCanFd, &timing_configs->items[1]);
- }
- /* init can */
- CAN_Init(p_can_dev->instance, &p_can_dev->ll_init);
- p_can_dev->rt_can.config.can_timing = timing_configs->items[0];
- if (timing_configs->count == 2)
- {
- p_can_dev->rt_can.config.canfd_timing = timing_configs->items[1];
- }
- return rt_ret;
- }
- static rt_err_t _canfd_control(can_device *p_can_dev, int cmd, void *arg)
- {
- rt_uint32_t argval;
- rt_err_t timing_stat;
- switch (cmd)
- {
- case RT_CAN_CMD_SET_BAUD:
- argval = (rt_uint32_t) arg;
- RT_ASSERT(IS_VALID_BAUD_RATE_CANFD_ARBITRATION(argval));
- if (p_can_dev->rt_can.config.baud_rate == argval)
- {
- break;
- }
- timing_stat = _calc_can_bit_timing(p_can_dev->instance, \
- CAN_BIT_TIMING_CANFD_ARBITRATION, \
- argval, \
- &p_can_dev->ll_init.stcBitCfg);
- if (timing_stat != RT_EOK)
- {
- return timing_stat;
- }
- CAN_Init(p_can_dev->instance, &p_can_dev->ll_init);
- p_can_dev->rt_can.config.baud_rate = argval;
- break;
- case RT_CAN_CMD_SET_CANFD:
- argval = (rt_uint32_t) arg;
- if (p_can_dev->rt_can.config.enable_canfd == argval)
- {
- break;
- }
- RT_ASSERT(IS_CAN_FRAME(argval));
- if (argval != CAN_FRAME_CLASSIC)
- {
- p_can_dev->ll_init.pstcCanFd->u8Mode = (argval == CAN_FRAME_ISO_FD) ? CAN_FD_MD_ISO : CAN_FD_MD_BOSCH;
- }
- CAN_Init(p_can_dev->instance, &p_can_dev->ll_init);
- p_can_dev->rt_can.config.enable_canfd = argval;
- argval = (argval > CAN_FRAME_CLASSIC) ? ENABLE : DISABLE;
- #if defined(HC32F472) || defined(HC32F4A8)
- CAN_FD_Cmd(p_can_dev->instance, (en_functional_state_t)argval);
- #endif
- break;
- case RT_CAN_CMD_SET_BAUD_FD:
- argval = (rt_uint32_t) arg;
- RT_ASSERT(IS_VALID_BAUD_RATE_CANFD_DATA(argval));
- if (p_can_dev->rt_can.config.baud_rate_fd == argval)
- {
- break;
- }
- timing_stat = _calc_can_bit_timing(p_can_dev->instance, \
- CAN_BIT_TIMING_CANFD_DATA, \
- argval, \
- &p_can_dev->ll_init.pstcCanFd->stcBitCfg);
- if (timing_stat != RT_EOK)
- {
- return timing_stat;
- }
- p_can_dev->ll_init.pstcCanFd->u8SSPOffset = p_can_dev->ll_init.pstcCanFd->stcBitCfg.u32TimeSeg1;
- CAN_Init(p_can_dev->instance, &p_can_dev->ll_init);
- p_can_dev->rt_can.config.baud_rate_fd = argval;
- break;
- case RT_CAN_CMD_SET_BITTIMING:
- return _config_can_bit_timing(p_can_dev, arg);
- default:
- break;
- }
- return RT_EOK;
- }
- #endif
- static rt_err_t _can_config(struct rt_can_device *can, struct can_configure *cfg)
- {
- can_device *p_can_dev;
- rt_err_t rt_ret = RT_EOK;
- RT_ASSERT(can);
- RT_ASSERT(cfg);
- p_can_dev = (can_device *)rt_container_of(can, can_device, rt_can);
- RT_ASSERT(p_can_dev);
- RT_ASSERT(IS_VALID_WORK_MODE(cfg->mode));
- p_can_dev->ll_init.u8WorkMode = _get_can_work_mode(cfg->mode);
- #ifdef RT_CAN_USING_CANFD
- if (cfg->use_bit_timing)
- {
- _get_can_bit_timing(&p_can_dev->ll_init.stcBitCfg, &cfg->can_timing);
- _get_can_bit_timing_fd(p_can_dev->ll_init.pstcCanFd, &cfg->canfd_timing);
- }
- else
- {
- RT_ASSERT(IS_VALID_BAUD_RATE_CANFD_ARBITRATION(cfg->baud_rate));
- RT_ASSERT(IS_VALID_BAUD_RATE_CANFD_DATA(cfg->baud_rate_fd));
- rt_ret = _calc_can_bit_timing(p_can_dev->instance, \
- CAN_BIT_TIMING_CANFD_ARBITRATION, \
- cfg->baud_rate, \
- &p_can_dev->ll_init.stcBitCfg);
- if (rt_ret != RT_EOK)
- {
- return rt_ret;
- }
- rt_ret = _calc_can_bit_timing(p_can_dev->instance, \
- CAN_BIT_TIMING_CANFD_DATA, \
- cfg->baud_rate_fd, \
- &p_can_dev->ll_init.pstcCanFd->stcBitCfg);
- if (rt_ret != RT_EOK)
- {
- return rt_ret;
- }
- }
- p_can_dev->ll_init.pstcCanFd->u8SSPOffset = p_can_dev->ll_init.pstcCanFd->stcBitCfg.u32TimeSeg1;
- #else
- RT_ASSERT(IS_VALID_BAUD_RATE_CAN2_0(cfg->baud_rate));
- rt_uint32_t baud_index = _get_can_baud_index(cfg->baud_rate);
- p_can_dev->ll_init.stcBitCfg = _g_baudrate_tab[baud_index].ll_sbt;
- #endif
- /* init can */
- CAN_Init(p_can_dev->instance, &p_can_dev->ll_init);
- struct can_configure pre_config = p_can_dev->rt_can.config;
- rt_memcpy(&p_can_dev->rt_can.config, cfg, sizeof(struct can_configure));
- /* restore unmodifiable member */
- if ((p_can_dev->rt_can.parent.open_flag & RT_DEVICE_OFLAG_OPEN) == RT_DEVICE_OFLAG_OPEN)
- {
- p_can_dev->rt_can.config.msgboxsz = pre_config.msgboxsz;
- p_can_dev->rt_can.config.ticks = pre_config.ticks;
- }
- #ifdef RT_CAN_USING_HDR
- p_can_dev->rt_can.config.maxhdr = pre_config.maxhdr;
- #endif
- p_can_dev->rt_can.config.sndboxnumber = pre_config.sndboxnumber;
- return rt_ret;
- }
- static rt_err_t _can_control(struct rt_can_device *can, int cmd, void *arg)
- {
- can_device *p_can_dev;
- RT_ASSERT(can != RT_NULL);
- p_can_dev = (can_device *)rt_container_of(can, can_device, rt_can);
- RT_ASSERT(p_can_dev);
- switch (cmd)
- {
- case RT_DEVICE_CTRL_CLR_INT:
- case RT_DEVICE_CTRL_SET_INT:
- _config_can_int(p_can_dev, cmd, arg);
- break;
- case RT_CAN_CMD_SET_FILTER:
- return _config_can_filter(p_can_dev, arg);
- case RT_CAN_CMD_SET_MODE:
- return _config_can_work_mode(p_can_dev, arg);
- case RT_CAN_CMD_SET_BAUD:
- #ifdef RT_CAN_USING_CANFD
- return _canfd_control(p_can_dev, cmd, arg);
- #else
- return _config_can20_baud(p_can_dev, arg);
- #endif
- case RT_CAN_CMD_SET_PRIV:
- return _config_can_priv_mode(p_can_dev, arg);
- case RT_CAN_CMD_GET_STATUS:
- {
- struct rt_can_status *rt_can_stat = (struct rt_can_status *)arg;
- stc_can_error_info_t stcErr = {0};
- CAN_GetErrorInfo(p_can_dev->instance, &stcErr);
- rt_can_stat->rcverrcnt = stcErr.u8RxErrorCount;
- rt_can_stat->snderrcnt = stcErr.u8TxErrorCount;
- rt_can_stat->lasterrtype = stcErr.u8ErrorType;
- rt_can_stat->errcode = CAN_GetStatusValue(p_can_dev->instance);
- }
- break;
- #ifdef RT_CAN_USING_CANFD
- case RT_CAN_CMD_SET_CANFD:
- case RT_CAN_CMD_SET_BAUD_FD:
- case RT_CAN_CMD_SET_BITTIMING:
- return _canfd_control(p_can_dev, cmd, arg);
- #endif
- default:
- return -(RT_EINVAL);
- }
- return RT_EOK;
- }
- static rt_ssize_t _can_sendmsg(struct rt_can_device *can, const void *buf, rt_uint32_t box_num)
- {
- struct rt_can_msg *pmsg = (struct rt_can_msg *) buf;
- stc_can_tx_frame_t stc_tx_frame = {0};
- int32_t ll_ret;
- RT_ASSERT(can != RT_NULL);
- can_device *p_can_dev = (can_device *)rt_container_of(can, can_device, rt_can);
- RT_ASSERT(p_can_dev);
- stc_tx_frame.u32ID = pmsg->id;
- if (RT_CAN_DTR == pmsg->rtr)
- {
- stc_tx_frame.RTR = 0;
- }
- else
- {
- stc_tx_frame.RTR = 1;
- }
- #ifdef RT_CAN_USING_CANFD
- if (pmsg->fd_frame != 0)
- {
- RT_ASSERT(pmsg->len <= CAN_DLC64);
- }
- else
- {
- RT_ASSERT(pmsg->len <= CAN_DLC8);
- }
- stc_tx_frame.FDF = pmsg->fd_frame;
- stc_tx_frame.BRS = pmsg->brs;
- #endif
- stc_tx_frame.DLC = pmsg->len & 0x0FU;
- /* Set up the IDE */
- stc_tx_frame.IDE = pmsg->ide;
- /* Set up the data field */
- uint32_t msg_len = _get_can_data_bytes_len(stc_tx_frame.DLC);
- rt_memcpy(&stc_tx_frame.au8Data, pmsg->data, msg_len);
- ll_ret = CAN_FillTxFrame(p_can_dev->instance, CAN_TX_BUF_PTB, &stc_tx_frame);
- if (ll_ret != LL_OK)
- {
- return -RT_ERROR;
- }
- /* Request transmission */
- CAN_StartTx(p_can_dev->instance, CAN_TX_REQ_PTB);
- return RT_EOK;
- }
- static rt_ssize_t _can_recvmsg(struct rt_can_device *can, void *buf, rt_uint32_t fifo)
- {
- int32_t ll_ret;
- struct rt_can_msg *pmsg;
- stc_can_rx_frame_t ll_rx_frame;
- RT_ASSERT(can != RT_NULL);
- can_device *p_can_dev = (can_device *)rt_container_of(can, can_device, rt_can);
- RT_ASSERT(p_can_dev);
- pmsg = (struct rt_can_msg *) buf;
- /* get data */
- ll_ret = CAN_GetRxFrame(p_can_dev->instance, &ll_rx_frame);
- if (ll_ret != LL_OK)
- return -RT_ERROR;
- /* get id */
- if (0 == ll_rx_frame.IDE)
- {
- pmsg->ide = RT_CAN_STDID;
- }
- else
- {
- pmsg->ide = RT_CAN_EXTID;
- }
- pmsg->id = ll_rx_frame.u32ID;
- /* get type */
- if (0 == ll_rx_frame.RTR)
- {
- pmsg->rtr = RT_CAN_DTR;
- }
- else
- {
- pmsg->rtr = RT_CAN_RTR;
- }
- /* get len */
- pmsg->len = ll_rx_frame.DLC;
- /* get hdr_index */
- pmsg->hdr_index = 0;
- pmsg->priv = 0;
- #ifdef RT_CAN_USING_CANFD
- pmsg->fd_frame = ll_rx_frame.FDF;
- pmsg->brs = ll_rx_frame.BRS;
- #endif
- uint32_t msg_len = _get_can_data_bytes_len(ll_rx_frame.DLC);
- rt_memcpy(pmsg->data, &ll_rx_frame.au8Data, msg_len);
- return RT_EOK;
- }
- static const struct rt_can_ops _can_ops =
- {
- _can_config,
- _can_control,
- _can_sendmsg,
- _can_recvmsg,
- };
- rt_inline void _isr_can_rx(can_device *p_can_dev)
- {
- if (CAN_GetStatus(p_can_dev->instance, CAN_FLAG_RX_BUF_OVF) == SET)
- {
- /* RX overflow. */
- rt_hw_can_isr(&p_can_dev->rt_can, RT_CAN_EVENT_RXOF_IND);
- CAN_ClearStatus(p_can_dev->instance, CAN_FLAG_RX_BUF_OVF);
- }
- if (CAN_GetStatus(p_can_dev->instance, CAN_FLAG_RX) == SET)
- {
- /* Received a frame. */
- CAN_ClearStatus(p_can_dev->instance, CAN_FLAG_RX);
- rt_hw_can_isr(&p_can_dev->rt_can, RT_CAN_EVENT_RX_IND);
- }
- if (CAN_GetStatus(p_can_dev->instance, CAN_FLAG_RX_BUF_WARN) == SET)
- {
- /* RX buffer warning. */
- CAN_ClearStatus(p_can_dev->instance, CAN_FLAG_RX_BUF_WARN);
- }
- if (CAN_GetStatus(p_can_dev->instance, CAN_FLAG_RX_BUF_FULL) == SET)
- {
- /* RX buffer full. */
- CAN_ClearStatus(p_can_dev->instance, CAN_FLAG_RX_BUF_FULL);
- }
- if (CAN_GetStatus(p_can_dev->instance, CAN_FLAG_RX_OVERRUN) == SET)
- {
- /* RX buffer overrun. */
- CAN_ClearStatus(p_can_dev->instance, CAN_FLAG_RX_OVERRUN);
- }
- }
- rt_inline void _isr_can_tx(can_device *p_can_dev)
- {
- rt_bool_t is_tx_done = RT_FALSE;
- rt_bool_t need_check_single_trans = RT_FALSE;
- if (CAN_GetStatus(p_can_dev->instance, CAN_FLAG_TX_BUF_FULL) == SET)
- {
- /* TX buffer full. */
- }
- if (CAN_GetStatus(p_can_dev->instance, CAN_FLAG_TX_ABORTED) == SET)
- {
- /* TX aborted. */
- CAN_ClearStatus(p_can_dev->instance, CAN_FLAG_TX_ABORTED);
- }
- if (CAN_GetStatus(p_can_dev->instance, CAN_FLAG_PTB_TX) == SET)
- {
- /* PTB transmitted. */
- CAN_ClearStatus(p_can_dev->instance, CAN_FLAG_PTB_TX);
- if (p_can_dev->ll_init.u8PTBSingleShotTx == CAN_PTB_SINGLESHOT_TX_ENABLE)
- {
- need_check_single_trans = RT_TRUE;
- }
- else
- {
- is_tx_done = RT_TRUE;
- }
- }
- if (CAN_GetStatus(p_can_dev->instance, CAN_FLAG_STB_TX) == SET)
- {
- /* STB transmitted. */
- CAN_ClearStatus(p_can_dev->instance, CAN_FLAG_STB_TX);
- if (p_can_dev->ll_init.u8STBSingleShotTx == CAN_STB_SINGLESHOT_TX_ENABLE)
- {
- need_check_single_trans = RT_TRUE;
- }
- else
- {
- is_tx_done = RT_TRUE;
- }
- }
- if (need_check_single_trans)
- {
- if ((CAN_GetStatus(p_can_dev->instance, CAN_FLAG_BUS_ERR) != SET) \
- || (CAN_GetStatus(p_can_dev->instance, CAN_FLAG_ARBITR_LOST) != SET))
- {
- is_tx_done = RT_TRUE;
- }
- }
- if (is_tx_done)
- {
- rt_hw_can_isr(&p_can_dev->rt_can, RT_CAN_EVENT_TX_DONE);
- }
- if (CAN_GetStatus(p_can_dev->instance, CAN_FLAG_ARBITR_LOST) == SET)
- {
- rt_hw_can_isr(&p_can_dev->rt_can, RT_CAN_EVENT_TX_FAIL);
- CAN_ClearStatus(p_can_dev->instance, CAN_FLAG_ARBITR_LOST);
- }
- }
- rt_inline void _isr_can_err(can_device *p_can_dev)
- {
- if (CAN_GetStatus(p_can_dev->instance, CAN_FLAG_ERR_INT) == SET)
- {
- /* ERROR. */
- CAN_ClearStatus(p_can_dev->instance, CAN_FLAG_ERR_INT);
- }
- if (CAN_GetStatus(p_can_dev->instance, CAN_FLAG_BUS_ERR) == SET)
- {
- /* BUS ERROR. */
- CAN_ClearStatus(p_can_dev->instance, CAN_FLAG_BUS_ERR);
- }
- if (CAN_GetStatus(p_can_dev->instance, CAN_FLAG_ERR_PASSIVE) == SET)
- {
- /* error-passive to error-active or error-active to error-passive. */
- CAN_ClearStatus(p_can_dev->instance, CAN_FLAG_ERR_PASSIVE);
- }
- if (CAN_GetStatus(p_can_dev->instance, CAN_FLAG_TEC_REC_WARN) == SET)
- {
- /* TEC or REC reached warning limit. */
- CAN_ClearStatus(p_can_dev->instance, CAN_FLAG_TEC_REC_WARN);
- }
- if (CAN_GetStatus(p_can_dev->instance, CAN_FLAG_BUS_OFF) == SET)
- {
- /* BUS OFF. */
- }
- }
- rt_inline void _isr_ttcan(can_device *p_can_dev)
- {
- if (CAN_TTC_GetStatus(p_can_dev->instance, CAN_TTC_FLAG_TIME_TRIG) == SET)
- {
- /* Time trigger interrupt. */
- CAN_TTC_ClearStatus(p_can_dev->instance, CAN_TTC_FLAG_TIME_TRIG);
- }
- if (CAN_TTC_GetStatus(p_can_dev->instance, CAN_TTC_FLAG_TRIG_ERR) == SET)
- {
- /* Trigger error interrupt. */
- }
- if (CAN_TTC_GetStatus(p_can_dev->instance, CAN_TTC_FLAG_WATCH_TRIG) == SET)
- {
- /* Watch trigger interrupt. */
- CAN_TTC_ClearStatus(p_can_dev->instance, CAN_TTC_FLAG_WATCH_TRIG);
- }
- }
- static void _isr_can(can_device *p_can_dev)
- {
- stc_can_error_info_t stcErr;
- (void)CAN_GetErrorInfo(p_can_dev->instance, &stcErr);
- _isr_can_rx(p_can_dev);
- _isr_can_tx(p_can_dev);
- _isr_can_err(p_can_dev);
- _isr_ttcan(p_can_dev);
- }
- #if defined(BSP_USING_CAN1)
- static void _irq_handler_can1(void)
- {
- rt_interrupt_enter();
- _isr_can(&_g_can_dev_array[CAN1_INDEX]);
- rt_interrupt_leave();
- }
- #if defined(HC32F472)
- void CAN1_Handler(void)
- {
- _irq_handler_can1();
- }
- #endif
- #endif
- #if defined(BSP_USING_CAN2)
- static void _irq_handler_can2(void)
- {
- rt_interrupt_enter();
- _isr_can(&_g_can_dev_array[CAN2_INDEX]);
- rt_interrupt_leave();
- }
- #if defined(HC32F472)
- void CAN2_Handler(void)
- {
- _irq_handler_can2();
- }
- #endif
- #endif
- #if defined(BSP_USING_CAN3)
- static void _irq_handler_can3(void)
- {
- rt_interrupt_enter();
- _isr_can(&_g_can_dev_array[CAN3_INDEX]);
- rt_interrupt_leave();
- }
- #if defined(HC32F472)
- void CAN3_Handler(void)
- {
- _irq_handler_can3();
- }
- #endif
- #endif
- static void _enable_can_clock(void)
- {
- #if defined(BSP_USING_CAN1)
- #if defined(HC32F4A0) || defined(HC32F472) || defined(HC32F4A8)
- FCG_Fcg1PeriphClockCmd(FCG1_PERIPH_CAN1, ENABLE);
- #elif defined(HC32F460)
- FCG_Fcg1PeriphClockCmd(FCG1_PERIPH_CAN, ENABLE);
- #endif
- #endif
- #if defined(BSP_USING_CAN2)
- FCG_Fcg1PeriphClockCmd(FCG1_PERIPH_CAN2, ENABLE);
- #endif
- #if defined(BSP_USING_CAN3)
- FCG_Fcg1PeriphClockCmd(FCG1_PERIPH_CAN3, ENABLE);
- #endif
- }
- static void _config_can_irq(void)
- {
- struct hc32_irq_config irq_config;
- #if defined(BSP_USING_CAN1)
- irq_config.irq_num = BSP_CAN1_IRQ_NUM;
- irq_config.int_src = CAN1_INT_SRC;
- irq_config.irq_prio = BSP_CAN1_IRQ_PRIO;
- /* register interrupt */
- hc32_install_irq_handler(&irq_config,
- _irq_handler_can1,
- RT_TRUE);
- #endif
- #if defined(BSP_USING_CAN2)
- irq_config.irq_num = BSP_CAN2_IRQ_NUM;
- irq_config.int_src = CAN2_INT_SRC;
- irq_config.irq_prio = BSP_CAN2_IRQ_PRIO;
- /* register interrupt */
- hc32_install_irq_handler(&irq_config,
- _irq_handler_can2,
- RT_TRUE);
- #endif
- #if defined(BSP_USING_CAN3)
- irq_config.irq_num = BSP_CAN3_IRQ_NUM;
- irq_config.int_src = CAN3_INT_SRC;
- irq_config.irq_prio = BSP_CAN3_IRQ_PRIO;
- /* register interrupt */
- hc32_install_irq_handler(&irq_config,
- _irq_handler_can3,
- RT_TRUE);
- #endif
- }
- static void _init_ll_struct_filter(can_device *p_can_dev)
- {
- if (p_can_dev->ll_init.pstcFilter == RT_NULL)
- {
- p_can_dev->ll_init.pstcFilter = (stc_can_filter_config_t *)rt_malloc(sizeof(stc_can_filter_config_t) * CAN_FILTER_COUNT);
- }
- RT_ASSERT((p_can_dev->ll_init.pstcFilter != RT_NULL));
- rt_memset(p_can_dev->ll_init.pstcFilter, 0, sizeof(stc_can_filter_config_t) * CAN_FILTER_COUNT);
- p_can_dev->ll_init.pstcFilter[0].u32ID = 0U;
- p_can_dev->ll_init.pstcFilter[0].u32IDMask = 0x1FFFFFFF;
- p_can_dev->ll_init.pstcFilter[0].u32IDType = CAN_ID_STD_EXT;
- p_can_dev->ll_init.u16FilterSelect = CAN_FILTER1;
- }
- static void _init_default_cfg(can_device *p_can_dev)
- {
- struct can_configure rt_can_config = CANDEFAULTCONFIG;
- rt_can_config.privmode = RT_CAN_MODE_NOPRIV;
- rt_can_config.ticks = 50;
- #ifdef RT_CAN_USING_HDR
- rt_can_config.maxhdr = CAN_FILTER_COUNT;
- #endif
- #ifdef RT_CAN_USING_CANFD
- rt_can_config.baud_rate_fd = CANFD_DATA_BAUD_1M;
- #endif
- rt_can_config.sndboxnumber = 1;
- p_can_dev->rt_can.config = rt_can_config;
- CAN_StructInit(&p_can_dev->ll_init);
- if (p_can_dev->init.single_trans_mode)
- {
- p_can_dev->ll_init.u8PTBSingleShotTx = CAN_PTB_SINGLESHOT_TX_ENABLE;
- }
- #ifdef RT_CAN_USING_CANFD
- _init_ll_struct_canfd(p_can_dev);
- #endif
- _init_ll_struct_filter(p_can_dev);
- }
- extern rt_err_t rt_hw_board_can_init(CM_CAN_TypeDef *CANx);
- extern void CanPhyEnable(void);
- int rt_hw_can_init(void)
- {
- _config_can_irq();
- _enable_can_clock();
- CanPhyEnable();
- int result = RT_EOK;
- uint32_t i = 0;
- for (; i < CAN_INDEX_MAX; i++)
- {
- _init_default_cfg(&_g_can_dev_array[i]);
- /* register CAN device */
- rt_hw_board_can_init(_g_can_dev_array[i].instance);
- rt_hw_can_register(&_g_can_dev_array[i].rt_can, \
- _g_can_dev_array[i].init.name,
- &_can_ops,
- &_g_can_dev_array[i]);
- }
- return result;
- }
- INIT_DEVICE_EXPORT(rt_hw_can_init);
- #endif
- #endif /* BSP_USING_CAN */
- /************************** end of file ******************/
|