Init
This commit is contained in:
cfif
parent
c72b2179f5
commit
f4d76d23c8
|
|
@ -9,6 +9,7 @@
|
||||||
#include "at32f435_437.h"
|
#include "at32f435_437.h"
|
||||||
#include "cmsis_os2.h"
|
#include "cmsis_os2.h"
|
||||||
#include "stdbool.h"
|
#include "stdbool.h"
|
||||||
|
#include "LinIO.h"
|
||||||
|
|
||||||
typedef struct {
|
typedef struct {
|
||||||
usart_type *uart;
|
usart_type *uart;
|
||||||
|
|
@ -25,6 +26,12 @@ typedef struct {
|
||||||
uint32_t rxDmaOffset;
|
uint32_t rxDmaOffset;
|
||||||
|
|
||||||
// osMutexId_t dmaAccess;
|
// osMutexId_t dmaAccess;
|
||||||
|
bool linFrameStarted;
|
||||||
|
uint8_t linByteCount;
|
||||||
|
uint8_t linBuffer[12];
|
||||||
|
uint32_t linLastByteTime;
|
||||||
|
uint32_t linFrameTimeoutMs;
|
||||||
|
lin_frame_t rxFrame;
|
||||||
|
|
||||||
osMessageQueueId_t txAccessQueue;
|
osMessageQueueId_t txAccessQueue;
|
||||||
|
|
||||||
|
|
@ -210,4 +217,19 @@ uint16_t vSerialPortBlindTransmit(tSerialPortArtery *env, uint8_t *data, uint16_
|
||||||
|
|
||||||
void SerialPort_IrqProcessing_DmaTxBlind(tSerialPortArtery *env);
|
void SerialPort_IrqProcessing_DmaTxBlind(tSerialPortArtery *env);
|
||||||
|
|
||||||
|
void vSerialPortLinInit(
|
||||||
|
tSerialPortArtery *env,
|
||||||
|
usart_type *uart,
|
||||||
|
bool swap,
|
||||||
|
uint32_t BoundRate,
|
||||||
|
IRQn_Type irq,
|
||||||
|
crm_periph_clock_type uartClock,
|
||||||
|
uint8_t irqPriority,
|
||||||
|
uint32_t rxBufferLength,
|
||||||
|
uint32_t rxSnifferLength
|
||||||
|
);
|
||||||
|
|
||||||
|
void SerialPort_IrqProcessing_UartLin(tSerialPortArtery *env);
|
||||||
|
bool vSerialPortSendLinFrame(tSerialPortArtery *env, const lin_frame_t *pFrame, uint32_t timeout);
|
||||||
|
|
||||||
#endif //SERIALPORT_SERIALPORT_ARTERY_H
|
#endif //SERIALPORT_SERIALPORT_ARTERY_H
|
||||||
|
|
|
||||||
|
|
@ -47,6 +47,61 @@ void vSerialPortInit(
|
||||||
env->uart = uart;
|
env->uart = uart;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
void vSerialPortLinInit(
|
||||||
|
tSerialPortArtery *env,
|
||||||
|
usart_type *uart,
|
||||||
|
bool swap,
|
||||||
|
uint32_t BoundRate,
|
||||||
|
IRQn_Type irq,
|
||||||
|
crm_periph_clock_type uartClock,
|
||||||
|
uint8_t irqPriority,
|
||||||
|
uint32_t rxBufferLength,
|
||||||
|
uint32_t rxSnifferLength
|
||||||
|
) {
|
||||||
|
env->uart = uart;
|
||||||
|
|
||||||
|
env->linLastByteTime = 20;
|
||||||
|
env->linFrameTimeoutMs = 20;
|
||||||
|
|
||||||
|
usart_reset(uart);
|
||||||
|
|
||||||
|
crm_periph_clock_enable(uartClock, TRUE);
|
||||||
|
|
||||||
|
usart_init(uart, BoundRate, USART_DATA_8BITS, USART_STOP_1_BIT);
|
||||||
|
|
||||||
|
// ВКЛЮЧАЕМ LIN РЕЖИМ!!!
|
||||||
|
usart_lin_mode_enable(uart, TRUE);
|
||||||
|
// Настраиваем длину break field (LIN требует 13 бит, выбираем 11)
|
||||||
|
usart_break_bit_num_set(uart, USART_BREAK_11BITS);
|
||||||
|
|
||||||
|
usart_transmitter_enable(uart, TRUE);
|
||||||
|
usart_receiver_enable(uart, TRUE);
|
||||||
|
|
||||||
|
if (swap) {
|
||||||
|
usart_transmit_receive_pin_swap(uart, TRUE);
|
||||||
|
}
|
||||||
|
|
||||||
|
usart_enable(uart, TRUE);
|
||||||
|
|
||||||
|
// Включаем прерывание по break frame
|
||||||
|
usart_interrupt_enable(uart, USART_BF_INT, TRUE);
|
||||||
|
usart_interrupt_enable(uart, USART_RDBF_INT, TRUE);
|
||||||
|
// usart_interrupt_enable(uart, USART_IDLE_INT, TRUE);
|
||||||
|
|
||||||
|
NVIC_EnableIRQ(irq);
|
||||||
|
NVIC_SetPriority(irq, irqPriority);
|
||||||
|
|
||||||
|
env->rxDataQueue = osMessageQueueNew(rxBufferLength, 12, NULL);
|
||||||
|
|
||||||
|
if (rxSnifferLength) {
|
||||||
|
env->rxDataSnifferQueue = osMessageQueueNew(rxSnifferLength, sizeof(lin_frame_t), NULL);
|
||||||
|
} else {
|
||||||
|
env->rxDataSnifferQueue = 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
void vSerialPortInitExt(
|
void vSerialPortInitExt(
|
||||||
tSerialPortArtery *env,
|
tSerialPortArtery *env,
|
||||||
usart_type *uart,
|
usart_type *uart,
|
||||||
|
|
@ -761,6 +816,244 @@ uint16_t vSerialPortBlindTransmit(tSerialPortArtery *env, uint8_t *data, uint16_
|
||||||
return sent;
|
return sent;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
static uint8_t LIN_DrvMakeCheckSum(uint8_t *pBuf, uint8_t u8Size, uint8_t u8Pid) {
|
||||||
|
uint16_t u16Checksum = 0U;
|
||||||
|
uint8_t u8Length = 0U;
|
||||||
|
|
||||||
|
// For PID is 0x3C (ID 0x3C) or 0x7D (ID 0x3D) or 0xFE (ID 0x3E) or 0xBF (ID 0x3F)
|
||||||
|
if ((0x3CU == u8Pid) || (0x7DU == u8Pid) || (0xFEU == u8Pid) || (0xBFU == u8Pid))
|
||||||
|
{
|
||||||
|
u8Pid = 0U;
|
||||||
|
}
|
||||||
|
|
||||||
|
u16Checksum += u8Pid;
|
||||||
|
|
||||||
|
for (u8Length = 0U; u8Length < u8Size; u8Length++)
|
||||||
|
{
|
||||||
|
u16Checksum += *pBuf;
|
||||||
|
pBuf++;
|
||||||
|
if (u16Checksum > 0xFFU)
|
||||||
|
{
|
||||||
|
u16Checksum -= 0xFFU;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
return ~(uint8_t)(u16Checksum);
|
||||||
|
}
|
||||||
|
|
||||||
|
static uint8_t LIN_CalcParity(uint8_t id) {
|
||||||
|
uint8_t p0 = 0;
|
||||||
|
uint8_t p1 = 0;
|
||||||
|
|
||||||
|
// P0 = ID0 ^ ID1 ^ ID2 ^ ID4
|
||||||
|
p0 = ((id >> 0) & 0x01) ^ ((id >> 1) & 0x01) ^
|
||||||
|
((id >> 2) & 0x01) ^ ((id >> 4) & 0x01);
|
||||||
|
|
||||||
|
// P1 = ^(ID1 ^ ID3 ^ ID4 ^ ID5)
|
||||||
|
p1 = 1 ^ ((id >> 1) & 0x01) ^ ((id >> 3) & 0x01) ^
|
||||||
|
((id >> 4) & 0x01) ^ ((id >> 5) & 0x01);
|
||||||
|
|
||||||
|
return (p1 << 7) | (p0 << 6);
|
||||||
|
}
|
||||||
|
|
||||||
|
// Измененный обработчик прерываний (без IDLE):
|
||||||
|
void SerialPort_IrqProcessing_UartLin(tSerialPortArtery *env) {
|
||||||
|
|
||||||
|
// 1. Break frame detection
|
||||||
|
if (usart_flag_get(env->uart, USART_BFF_FLAG)) {
|
||||||
|
usart_flag_clear(env->uart, USART_BFF_FLAG);
|
||||||
|
usart_data_receive(env->uart);
|
||||||
|
|
||||||
|
env->linFrameStarted = true;
|
||||||
|
env->linByteCount = 0;
|
||||||
|
env->linLastByteTime = SystemGetMs(); // Запоминаем время
|
||||||
|
env->rxFrame.event = LIN_RECV_BREAK_FIELD_OK;
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
// 2. Receive data (без IDLE)
|
||||||
|
if (usart_flag_get(env->uart, USART_RDBF_FLAG)) {
|
||||||
|
if (env->linFrameStarted && (env->linByteCount < sizeof(env->linBuffer))) {
|
||||||
|
uint8_t data = usart_data_receive(env->uart);
|
||||||
|
env->linBuffer[env->linByteCount] = data;
|
||||||
|
env->linByteCount++;
|
||||||
|
env->linLastByteTime = SystemGetMs(); // Обновляем время
|
||||||
|
} else {
|
||||||
|
usart_data_receive(env->uart);
|
||||||
|
if (env->linFrameStarted) {
|
||||||
|
env->rxFrame.event = LIN_RX_OVERRUN;
|
||||||
|
osMessageQueuePut(env->rxDataQueue, &env->rxFrame, 0, 0);
|
||||||
|
env->linFrameStarted = false;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
// 3. Error handling
|
||||||
|
if (usart_flag_get(env->uart, USART_FERR_FLAG)) {
|
||||||
|
usart_flag_clear(env->uart, USART_FERR_FLAG);
|
||||||
|
usart_data_receive(env->uart);
|
||||||
|
|
||||||
|
if (env->linFrameStarted) {
|
||||||
|
env->rxFrame.event = LIN_FRAME_ERROR;
|
||||||
|
osMessageQueuePut(env->rxDataQueue, &env->rxFrame, 0, 0);
|
||||||
|
env->linFrameStarted = false;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
if (usart_flag_get(env->uart, USART_ROERR_FLAG)) {
|
||||||
|
usart_flag_clear(env->uart, USART_ROERR_FLAG);
|
||||||
|
usart_data_receive(env->uart);
|
||||||
|
|
||||||
|
if (env->linFrameStarted) {
|
||||||
|
env->rxFrame.event = LIN_RX_OVERRUN;
|
||||||
|
osMessageQueuePut(env->rxDataQueue, &env->rxFrame, 0, 0);
|
||||||
|
env->linFrameStarted = false;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
// Выделенная функция обработки кадра
|
||||||
|
static void LIN_ProcessReceivedFrame(tSerialPortArtery *env) {
|
||||||
|
// Проверка sync field
|
||||||
|
if (env->linBuffer[0] != 0x55) {
|
||||||
|
env->rxFrame.event = LIN_SYNC_ERROR;
|
||||||
|
osMessageQueuePut(env->rxDataQueue, &env->rxFrame, 0, 0);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Проверка PID
|
||||||
|
uint8_t receivedPid = env->linBuffer[1];
|
||||||
|
uint8_t id = receivedPid & 0x3F;
|
||||||
|
uint8_t expectedPid = id | LIN_CalcParity(id);
|
||||||
|
|
||||||
|
if (receivedPid != expectedPid) {
|
||||||
|
env->rxFrame.event = LIN_PID_ERROR;
|
||||||
|
osMessageQueuePut(env->rxDataQueue, &env->rxFrame, 0, 0);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
env->rxFrame.id = id;
|
||||||
|
env->rxFrame.dataLen = env->linByteCount - 3;
|
||||||
|
|
||||||
|
if (env->rxFrame.dataLen > 8) {
|
||||||
|
env->rxFrame.event = LIN_FRAME_ERROR;
|
||||||
|
osMessageQueuePut(env->rxDataQueue, &env->rxFrame, 0, 0);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Копируем данные
|
||||||
|
for (uint8_t i = 0; i < env->rxFrame.dataLen; i++) {
|
||||||
|
env->rxFrame.data[i] = env->linBuffer[2 + i];
|
||||||
|
}
|
||||||
|
|
||||||
|
// Проверка checksum
|
||||||
|
env->rxFrame.checksum = env->linBuffer[env->linByteCount - 1];
|
||||||
|
uint8_t calculatedChecksum = LIN_DrvMakeCheckSum(
|
||||||
|
env->rxFrame.data,
|
||||||
|
env->rxFrame.dataLen,
|
||||||
|
receivedPid
|
||||||
|
);
|
||||||
|
|
||||||
|
if (env->rxFrame.checksum != calculatedChecksum) {
|
||||||
|
env->rxFrame.event = LIN_CHECKSUM_ERROR;
|
||||||
|
} else {
|
||||||
|
env->rxFrame.event = LIN_RX_COMPLETED;
|
||||||
|
}
|
||||||
|
|
||||||
|
osMessageQueuePut(env->rxDataQueue, &env->rxFrame, 0, 0);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
// Функция проверки таймаута (вызывать из таймера, например, каждые 1-5 мс)
|
||||||
|
void LIN_CheckTimeout(tSerialPortArtery *env) {
|
||||||
|
|
||||||
|
if (!env->linFrameStarted) {
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
uint32_t now = SystemGetMs();
|
||||||
|
uint32_t elapsed = now - env->linLastByteTime;
|
||||||
|
|
||||||
|
if (elapsed >= env->linFrameTimeoutMs) {
|
||||||
|
// Таймаут - кадр должен быть завершен
|
||||||
|
if (env->linByteCount >= 3) {
|
||||||
|
// Пытаемся обработать полученные данные
|
||||||
|
LIN_ProcessReceivedFrame(env);
|
||||||
|
} else {
|
||||||
|
// Недостаточно данных
|
||||||
|
env->rxFrame.event = LIN_TIMEOUT;
|
||||||
|
osMessageQueuePut(env->rxDataQueue, &env->rxFrame, 0, 0);
|
||||||
|
}
|
||||||
|
|
||||||
|
env->linFrameStarted = false;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
bool vSerialPortSendLinFrame(tSerialPortArtery *env, const lin_frame_t *pFrame, uint32_t timeout) {
|
||||||
|
uint8_t txBuffer[11]; // Максимальный размер LIN кадра (без break)
|
||||||
|
uint8_t idx = 0;
|
||||||
|
|
||||||
|
if ((!env) || (!pFrame)) {
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Проверка валидности данных
|
||||||
|
if (pFrame->dataLen > 8) {
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
|
||||||
|
// 1. Формирование LIN кадра
|
||||||
|
// Sync field
|
||||||
|
txBuffer[idx++] = 0x55;
|
||||||
|
|
||||||
|
// PID (ID + parity)
|
||||||
|
uint8_t pid = pFrame->id | LIN_CalcParity(pFrame->id);
|
||||||
|
txBuffer[idx++] = pid;
|
||||||
|
|
||||||
|
// Data bytes
|
||||||
|
for (uint8_t i = 0; i < pFrame->dataLen; i++) {
|
||||||
|
txBuffer[idx++] = pFrame->data[i];
|
||||||
|
}
|
||||||
|
|
||||||
|
// Checksum
|
||||||
|
txBuffer[idx++] = pFrame->checksum;
|
||||||
|
|
||||||
|
// 2. Отправка break field
|
||||||
|
usart_break_send(env->uart);
|
||||||
|
|
||||||
|
// Ожидание завершения отправки break
|
||||||
|
uint32_t breakTimeout = SystemGetMs() + 10; // 10мс максимум на break
|
||||||
|
while (usart_flag_get(env->uart, USART_TDBE_FLAG) == RESET) {
|
||||||
|
if (SystemGetMs() > breakTimeout) {
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
// 3. Отправка данных (возвращает количество отправленных байт)
|
||||||
|
uint16_t sent = vSerialPortTransmitOverCore(env, txBuffer, idx, timeout);
|
||||||
|
|
||||||
|
return (sent == idx); // Успех, если все байты отправлены
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
static SerialPortIOTransaction vSerialPortTransmitterGet(tSerialPortArtery *env) {
|
static SerialPortIOTransaction vSerialPortTransmitterGet(tSerialPortArtery *env) {
|
||||||
|
|
||||||
#ifdef UART_DMA_SEND
|
#ifdef UART_DMA_SEND
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue