aboutsummaryrefslogtreecommitdiffstats
path: root/os
diff options
context:
space:
mode:
Diffstat (limited to 'os')
-rw-r--r--os/hal/platforms/LPC17xx/can_lld.c657
-rw-r--r--os/hal/platforms/LPC17xx/can_lld.h645
-rw-r--r--os/hal/platforms/LPC17xx/platform.mk3
3 files changed, 1304 insertions, 1 deletions
diff --git a/os/hal/platforms/LPC17xx/can_lld.c b/os/hal/platforms/LPC17xx/can_lld.c
new file mode 100644
index 000000000..1e789d9b9
--- /dev/null
+++ b/os/hal/platforms/LPC17xx/can_lld.c
@@ -0,0 +1,657 @@
+/*
+ ChibiOS/RT - Copyright (C) 2006-2013 Giovanni Di Sirio
+
+ Licensed under the Apache License, Version 2.0 (the "License");
+ you may not use this file except in compliance with the License.
+ You may obtain a copy of the License at
+
+ http://www.apache.org/licenses/LICENSE-2.0
+
+ Unless required by applicable law or agreed to in writing, software
+ distributed under the License is distributed on an "AS IS" BASIS,
+ WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ See the License for the specific language governing permissions and
+ limitations under the License.
+*/
+
+/**
+ * @file LPC17xx/can_lld.c
+ * @brief LPC17xx CAN subsystem low level driver source.
+ *
+ * @addtogroup CAN
+ * @{
+ */
+
+/*
+ This file has been contributed by:
+ Marcin Jokel.
+*/
+
+#include "ch.h"
+#include "hal.h"
+
+#if HAL_USE_CAN || defined(__DOXYGEN__)
+/* TODO: FullCAN mode. */
+/*===========================================================================*/
+/* Driver local definitions. */
+/*===========================================================================*/
+
+/*===========================================================================*/
+/* Driver exported variables. */
+/*===========================================================================*/
+
+/** @brief CAN1 driver identifier.*/
+#if LPC17xx_CAN_USE_CAN1 || defined(__DOXYGEN__)
+CANDriver CAND1;
+#endif
+
+/** @brief CAN2 driver identifier.*/
+#if LPC17xx_CAN_USE_CAN2 || defined(__DOXYGEN__)
+CANDriver CAND2;
+#endif
+
+/*===========================================================================*/
+/* Driver local variables and types. */
+/*===========================================================================*/
+
+/*===========================================================================*/
+/* Driver local functions. */
+/*===========================================================================*/
+
+#if LPC17xx_CAN_USE_FILTER
+/**
+ * @brief Copy table to filter ram.
+ *
+ * @param[in] reg
+ * @param[in] ptable
+ * @param[in] addr_start
+ * @param[in] addr_end
+ *
+ * @notapi
+ */
+
+static void can_lld_copy_table_to_ram(volatile uint32_t * reg,
+ const uint32_t * ptable,
+ uint32_t addr_start,
+ uint32_t addr_end) {
+
+ uint32_t i;
+
+ if (reg != NULL) {
+ *reg = ((addr_start * 4) << 2);
+ }
+ for (i = addr_start; i < addr_end; i++) {
+ LPC_CANAF_RAM->mask[i] = ptable[i];
+ }
+}
+
+/**
+ * @brief Programs the filters.
+ *
+ * @param[in] cfc pointer to the can filter configuration structure
+ *
+ * @notapi
+ */
+static void can_lld_set_filter( const CANFilterConfig *cfc) {
+
+ uint32_t addr_start;
+ uint32_t addr_end;
+
+ LPC_CANAF->AFMR = AFMR_ACC_OFF; /* Acceptance filter off mode. */
+
+ addr_start = cfc->fc_id_table_n;
+
+ if (addr_start > 0) {
+ can_lld_copy_table_to_ram(NULL, cfc->fc_id_table, 0, addr_start);
+ }
+
+ addr_start = cfc->fc_id_table_n;
+ addr_end = cfc->std_id_table_n;
+
+ can_lld_copy_table_to_ram(&LPC_CANAF->SFF_sa, cfc->std_id_table, addr_start, addr_end);
+
+ addr_start = addr_end;
+ addr_end += cfc->std_range_id_table_n;
+
+ can_lld_copy_table_to_ram(&LPC_CANAF->SFF_GRP_sa, cfc->std_range_id_table, addr_start, addr_end);
+
+ addr_start = addr_end;
+ addr_end += cfc->ext_id_table_n;
+
+ can_lld_copy_table_to_ram(&LPC_CANAF->EFF_sa, cfc->ext_id_table, addr_start, addr_end);
+
+ addr_start = addr_end;
+ addr_end += cfc->ext_range_id_table_n;
+
+ can_lld_copy_table_to_ram(&LPC_CANAF->EFF_GRP_sa, cfc->ext_range_id_table, addr_start, addr_end);
+
+ LPC_CANAF->ENDofTable = (addr_end * 4) << 2;
+
+ LPC_CANAF->AFMR = cfc->afmr;
+}
+#endif
+
+/**
+ * @brief Common TX ISR handler.
+ *
+ * @param[in] canp pointer to the @p CANDriver object
+ *
+ * @notapi
+ */
+static void can_lld_tx_handler(CANDriver *canp) {
+
+ /* All transmit buffers are available.*/
+ if (canp->can->GSR & CANGSR_TBS) {
+ chSysLockFromIsr();
+ while (chSemGetCounterI(&canp->txsem) < 0)
+ chSemSignalI(&canp->txsem);
+ chEvtBroadcastFlagsI(&canp->txempty_event, CAN_MAILBOX_TO_MASK(1));
+ chSysUnlockFromIsr();
+ }
+}
+
+/**
+ * @brief Common RX ISR handler.
+ *
+ * @param[in] canp pointer to the @p CANDriver object
+ * @param[in] status
+ * @notapi
+ */
+static void can_lld_rx_handler(CANDriver *canp, uint32_t status) {
+
+ /* No more receive events until the queue 0 has been emptied.*/
+ canp->can->IER &= ~CANIER_RIE;
+ chSysLockFromIsr();
+ while (chSemGetCounterI(&canp->rxsem) < 0)
+ chSemSignalI(&canp->rxsem);
+ chEvtBroadcastFlagsI(&canp->rxfull_event, CAN_MAILBOX_TO_MASK(1));
+ chSysUnlockFromIsr();
+
+ if (( status & CANICR_DOI) > 0) {
+ /* Overflow events handling.*/
+ canp->can->CMR = CANCMR_CDO;
+ chSysLockFromIsr();
+ chEvtBroadcastFlagsI(&canp->error_event, CAN_OVERFLOW_ERROR);
+ chSysUnlockFromIsr();
+ }
+}
+
+/**
+ * @brief Error ISR handler.
+ *
+ * @param[in] canp pointer to the @p CANDriver object
+ * @param[in] flags
+ *
+ * @notapi
+ */
+static void can_lld_error_handler(CANDriver *canp, uint32_t status) {
+
+ uint32_t flags;
+
+ /* Error event.*/
+ /* The high 16-bits of the ICR register (error codes for bus error)
+ is copied unchanged in the upper half word of the listener flags mask.*/
+ flags = status & 0xFFFF0000;
+ if (status & CANICR_EI)
+ flags |= CAN_WARNING_ERROR;
+ if (status & CANICR_EPI)
+ flags |= CAN_PASSIVE_ERROR;
+ if (status & CANICR_BEI)
+ flags |= CAN_BUS_ERROR;
+
+ chSysLockFromIsr();
+ chEvtBroadcastFlagsI(&canp->error_event, flags);
+ chSysUnlockFromIsr();
+}
+
+
+#if CAN_USE_SLEEP_MODE
+/**
+ * @brief Wake up ISR handler.
+ *
+ * @param[in] canp pointer to the @p CANDriver object
+ *
+ * @notapi
+ */
+static void can_lld_wakeup_handler(CANDriver *canp) {
+
+ /* Wakeup event.*/
+ canp->state = CAN_READY;
+ can_lld_wakeup(canp);
+ chSysLockFromIsr();
+ chEvtBroadcastI(&canp->wakeup_event);
+ chSysUnlockFromIsr();
+
+}
+#endif /* CAN_USE_SLEEP_MODE */
+
+/*===========================================================================*/
+/* Driver interrupt handlers. */
+/*===========================================================================*/
+
+#if LPC17xx_CAN_USE_CAN1 || LPC17xx_CAN_USE_CAN2 ||defined(__DOXYGEN__)
+/**
+ * @brief CAN Common, CAN 1 Tx, CAN 1 Rx, CAN 2 Tx, CAN 2 Rx.
+ *
+ * @isr
+ */
+CH_IRQ_HANDLER(VectorA4) {
+
+#if LPC17xx_CAN_USE_CAN1
+ volatile uint32_t can1_status;
+#endif
+#if LPC17xx_CAN_USE_CAN2
+ volatile uint32_t can2_status;
+#endif
+
+ CH_IRQ_PROLOGUE();
+
+#if LPC17xx_CAN_USE_CAN1
+ can1_status = LPC_CAN1->ICR;
+#endif
+#if LPC17xx_CAN_USE_CAN2
+ can2_status = LPC_CAN2->ICR;
+#endif
+
+#if LPC17xx_CAN_USE_CAN1
+ if (can1_status & 0x000007FF) {
+
+ if (can1_status & (CANICR_EI | CANICR_EPI | CANICR_BEI)) {
+ can_lld_error_handler(&CAND1, can1_status);
+ }
+
+ if (can1_status & (CANICR_RI | CANICR_DOI)) {
+ can_lld_rx_handler(&CAND1, can1_status);
+ }
+
+ if (can1_status & (CANICR_TI1 | CANICR_TI2 | CANICR_TI3)){
+ can_lld_tx_handler(&CAND1);
+ }
+ }
+#endif
+
+#if LPC17xx_CAN_USE_CAN2
+ if (can2_status & 0x000007FF) {
+
+ if (can2_status & CANICR_EI) {
+ can_lld_error_handler(&CAND2, can2_status);
+ }
+
+ if (can2_status & (CANICR_RI | CANICR_DOI)) {
+ can_lld_rx_handler(&CAND2, can2_status);
+ }
+
+ if (can2_status & (CANICR_TI1 | CANICR_TI2 | CANICR_TI3)){
+ can_lld_tx_handler(&CAND2);
+ }
+ }
+#endif
+ CH_IRQ_EPILOGUE();
+}
+
+#if CAN_USE_SLEEP_MODE
+/**
+ * @brief CAN Common, CAN 1 Tx, CAN 1 Rx, CAN 2 Tx, CAN 2 Rx.
+ *
+ * @isr
+ */
+CH_IRQ_HANDLER(VectorC8) {
+
+#if LPC17xx_CAN_USE_CAN1
+ uint32_t can1_status;
+#endif
+#if LPC17xx_CAN_USE_CAN2
+ uint32_t can2_status;
+#endif
+
+ CH_IRQ_PROLOGUE();
+
+#if LPC17xx_CAN_USE_CAN1
+ can1_status = LPC_CAN1->ICR;
+#endif
+#if LPC17xx_CAN_USE_CAN2
+ can2_status = LPC_CAN2->ICR;
+#endif
+
+#if LPC17xx_CAN_USE_CAN1
+ if (can1_status & CANICR_WUI) {
+ can_lld_wakeup_handler(&CAND1);
+ }
+#endif
+
+#if LPC17xx_CAN_USE_CAN2
+ if (can2_status & CANICR_WUI) {
+ can_lld_wakeup_handler(&CAND2);
+ }
+#endif
+
+ CH_IRQ_EPILOGUE();
+}
+#endif /* CAN_USE_SLEEP_MODE */
+
+#endif /* LPC17xx_CAN_USE_CAN1 || LPC17xx_CAN_USE_CAN2 */
+
+/*===========================================================================*/
+/* Driver exported functions. */
+/*===========================================================================*/
+
+/**
+ * @brief Low level CAN driver initialization.
+ *
+ * @notapi
+ */
+void can_lld_init(void) {
+
+#if LPC17xx_CAN_USE_CAN1
+ /* Driver initialization.*/
+ canObjectInit(&CAND1);
+ CAND1.can = LPC_CAN1;
+#endif
+#if LPC17xx_CAN_USE_CAN2
+ /* Driver initialization.*/
+ canObjectInit(&CAND2);
+ CAND2.can = LPC_CAN2;
+#endif
+
+}
+
+/**
+ * @brief Configures and activates the CAN peripheral.
+ *
+ * @param[in] canp pointer to the @p CANDriver object
+ *
+ * @notapi
+ */
+void can_lld_start(CANDriver *canp) {
+
+#if LPC17xx_CAN_USE_CAN1
+ if (&CAND1 == canp) {
+ LPC_SC->PCONP |= (1UL << 13);
+ }
+#endif
+#if LPC17xx_CAN_USE_CAN2
+ if (&CAND2 == canp) {
+ LPC_SC->PCONP |= (1UL << 14);
+ }
+#endif
+
+ canp->can->MOD = CANMOD_RM; /* Reset mode. */
+
+#if !LPC17xx_CAN_USE_FILTER
+ LPC_CANAF->AFMR = AFMR_ACC_BP; /* Bypass can filter. */
+#endif
+
+ /* Entering initialization mode. */
+ canp->state = CAN_STARTING;
+
+ canp->can->BTR = canp->config->btr; /* BTR initialization.*/
+ canp->can->CMR = CANCMR_RRB;
+
+ /* Interrupt sources initialization.*/
+ canp->can->IER = CANIER_TIE3 | CANIER_TIE2 | CANIER_BEIE |
+ CANIER_EPIE | CANIER_DOIE | CANIER_EIE |
+ CANIER_TIE1 | CANIER_RIE;
+
+#if CAN_USE_SLEEP_MODE
+ canp->can->IER |= CANIER_WUIE;
+ nvicEnableVector(CANActivity_IRQn,
+ CORTEX_PRIORITY_MASK(LPC17xx_CAN_IRQ_PRIORITY));
+#endif /* CAN_USE_SLEEP_MODE */
+
+ canp->can->MOD = canp->config->mod; /* Operating mode. */
+
+ nvicEnableVector(CAN_IRQn,
+ CORTEX_PRIORITY_MASK(LPC17xx_CAN_IRQ_PRIORITY));
+}
+
+/**
+ * @brief Deactivates the CAN peripheral.
+ *
+ * @param[in] canp pointer to the @p CANDriver object
+ *
+ * @notapi
+ */
+void can_lld_stop(CANDriver *canp) {
+
+ /* If in ready state then disables the CAN peripheral.*/
+ if (canp->state == CAN_READY) {
+
+ canp->can->MOD = CANMOD_RM; /* Reset mode. */
+ canp->can->IER = 0;
+#if (LPC17xx_CAN_USE_CAN1 && LPC17xx_CAN_USE_CAN2) == 0
+ nvicDisableVector(CAN_IRQn); /* Interrupt disabled only if one CAN is in use. */
+#endif
+
+#if LPC17xx_CAN_USE_CAN1
+ if (&CAND1 == canp) {
+ LPC_SC->PCONP &= ~(1UL << 13);
+ }
+#endif
+#if LPC17xx_CAN_USE_CAN2
+ if (&CAND2 == canp) {
+ LPC_SC->PCONP &= ~(1UL << 14);
+ }
+#endif
+
+#if CAN_USE_SLEEP_MODE
+ nvicDisableVector(CANActivity_IRQn);
+#endif /* CAN_USE_SLEEP_MODE */
+ }
+}
+
+/**
+ * @brief Determines whether a frame can be transmitted.
+ *
+ * @param[in] canp pointer to the @p CANDriver object
+ * @param[in] mailbox mailbox number, @p CAN_ANY_MAILBOX for any mailbox
+ *
+ * @return The queue space availability.
+ * @retval FALSE no space in the transmit queue.
+ * @retval TRUE transmit slot available.
+ *
+ * @notapi
+ */
+bool_t can_lld_is_tx_empty(CANDriver *canp, canmbx_t mailbox) {
+
+ switch (mailbox) {
+ case CAN_ANY_MAILBOX:
+ return ((canp->can->SR & (CANSR_TBS1 | CANSR_TBS2 | CANSR_TBS3)) != 0);
+ case 1:
+ return (canp->can->SR & CANSR_TBS1) != 0;
+ case 2:
+ return (canp->can->SR & CANSR_TBS2) != 0;
+ case 3:
+ return (canp->can->SR & CANSR_TBS3) != 0;
+ default:
+ return FALSE;
+ }
+}
+
+/**
+ * @brief Inserts a frame into the transmit queue.
+ *
+ * @param[in] canp pointer to the @p CANDriver object
+ * @param[in] ctfp pointer to the CAN frame to be transmitted
+ * @param[in] mailbox mailbox number, @p CAN_ANY_MAILBOX for any mailbox
+ *
+ * @notapi
+ */
+void can_lld_transmit(CANDriver *canp,
+ canmbx_t mailbox,
+ const CANTxFrame *ctfp) {
+ volatile uint32_t * tfi;
+ uint32_t tbs_n;
+ uint32_t sr;
+
+ tbs_n = mailbox;
+
+ if (mailbox == CAN_ANY_MAILBOX) {
+ sr = canp->can->SR;
+ if (sr & CANSR_TBS1) {
+ tbs_n = 1;
+ }
+ else if (sr & CANSR_TBS2) {
+ tbs_n = 2;
+ }
+ else if (sr & CANSR_TBS3) {
+ tbs_n = 3;
+ }
+ else {
+ return;
+ }
+ }
+
+ /* Pointer to a free transmission mailbox.*/
+ switch (tbs_n) {
+ case 1:
+ tfi = &canp->can->TFI1;
+ break;
+ case 2:
+ tfi = &canp->can->TFI2;
+ break;
+ case 3:
+ tfi = &canp->can->TFI3;
+ break;
+ default:
+ return;
+ }
+
+ /* Preparing the message.*/
+ * tfi = ((uint32_t)ctfp->IDE << 31) | ((uint32_t)ctfp->RTR << 30) |
+ (((uint32_t)ctfp->DLC) << 16); /* CAN Transmit Frame Information Register. */
+ if (ctfp->IDE)
+ *(tfi + 1) = ctfp->EID; /* CAN Transmit Identifier register 29-bit. */
+ else
+ *(tfi + 1) = ctfp->SID; /* CAN Transmit Identifier register 11-bit. */
+
+ *(tfi + 2) = ctfp->data32[0]; /* CAN Transmit Data Register A. */
+ *(tfi + 3) = ctfp->data32[1]; /* CAN Transmit Data Register B. */
+
+#if LPC17xx_CAN_USE_LOCAL_SELF_TEST
+ canp->can->CMR = (1UL << (4 + tbs_n)) | CANCMR_SRR;
+#else
+ canp->can->CMR = (1UL << (4 + tbs_n)) | CANCMR_TR;
+#endif
+}
+
+/**
+ * @brief Determines whether a frame has been received.
+ *
+ * @param[in] canp pointer to the @p CANDriver object
+ * @param[in] mailbox mailbox number, @p CAN_ANY_MAILBOX for any mailbox
+ *
+ * @return The queue space availability.
+ * @retval FALSE no space in the transmit queue.
+ * @retval TRUE transmit slot available.
+ *
+ * @notapi
+ */
+bool_t can_lld_is_rx_nonempty(CANDriver *canp, canmbx_t mailbox) {
+
+ switch (mailbox) {
+ case CAN_ANY_MAILBOX:
+ case 1:
+ return ((canp->can->GSR & CANGSR_RBS) != 0);
+ default:
+ return FALSE;
+ }
+}
+
+/**
+ * @brief Receives a frame from the input queue.
+ *
+ * @param[in] canp pointer to the @p CANDriver object
+ * @param[in] mailbox mailbox number, @p CAN_ANY_MAILBOX for any mailbox
+ * @param[out] crfp pointer to the buffer where the CAN frame is copied
+ *
+ * @notapi
+ */
+void can_lld_receive(CANDriver *canp,
+ canmbx_t mailbox,
+ CANRxFrame *crfp) {
+ uint32_t rfs, rid;
+
+ switch (mailbox) {
+ case CAN_ANY_MAILBOX:
+ case 1:
+ /* Fetches the message.*/
+ rfs = canp->can->RFS;
+ rid = canp->can->RID;
+ crfp->data32[0] = canp->can->RDA;
+ crfp->data32[1] = canp->can->RDB;
+
+ /* Releases the mailbox.*/
+ canp->can->CMR = CANCMR_RRB;
+
+ /* Re-enables the interrupt in order to generate
+ events again. */
+ canp->can->IER |= CANIER_RIE;
+ break;
+ default:
+ /* Should not happen, do nothing.*/
+ return;
+ }
+
+ /* Decodes the various fields in the RX frame.*/
+ crfp->RTR = (rfs & CANRFS_RTR) >> 30;
+ crfp->IDE = (rfs & CANRFS_FF) >> 31;
+ if (crfp->IDE) {
+ crfp->EID = rid;
+ }
+ else {
+ crfp->SID = rid;
+ }
+ crfp->DLC = (rfs & CANRFS_DLC) >> 16;
+ crfp->IDF = (uint16_t)(rfs & CANRFS_ID);
+}
+
+#if CAN_USE_SLEEP_MODE || defined(__DOXYGEN__)
+/**
+ * @brief Enters the sleep mode.
+ *
+ * @param[in] canp pointer to the @p CANDriver object
+ *
+ * @notapi
+ */
+void can_lld_sleep(CANDriver *canp) {
+
+ canp->can->MOD |= CANMOD_SM;
+}
+
+/**
+ * @brief Enforces leaving the sleep mode.
+ *
+ * @param[in] canp pointer to the @p CANDriver object
+ *
+ * @notapi
+ */
+void can_lld_wakeup(CANDriver *canp) {
+
+ uint32_t reg_val;
+
+#if LPC17xx_CAN_USE_CAN1
+ if (&CAND1 == canp) {
+ reg_val = (1UL << 1);
+ }
+#endif
+#if LPC17xx_CAN_USE_CAN2
+ if (&CAND2 == canp) {
+ reg_val = (1UL << 2);
+ }
+#endif
+
+ LPC_SC->CANSLEEPCLR = reg_val;
+ canp->can->MOD &= ~CANMOD_SM;
+ LPC_SC->CANWAKEFLAGS = reg_val;
+}
+#endif /* CAN_USE_SLEEP_MODE */
+
+#if LPC17xx_CAN_USE_FILTER
+void canSetFilter(const CANFilterConfig *cfc) {
+ can_lld_set_filter(cfc);
+}
+#endif
+
+#endif /* HAL_USE_CAN */
+
+/** @} */
diff --git a/os/hal/platforms/LPC17xx/can_lld.h b/os/hal/platforms/LPC17xx/can_lld.h
new file mode 100644
index 000000000..2443eba60
--- /dev/null
+++ b/os/hal/platforms/LPC17xx/can_lld.h
@@ -0,0 +1,645 @@
+/*
+ ChibiOS/RT - Copyright (C) 2006-2013 Giovanni Di Sirio
+
+ Licensed under the Apache License, Version 2.0 (the "License");
+ you may not use this file except in compliance with the License.
+ You may obtain a copy of the License at
+
+ http://www.apache.org/licenses/LICENSE-2.0
+
+ Unless required by applicable law or agreed to in writing, software
+ distributed under the License is distributed on an "AS IS" BASIS,
+ WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ See the License for the specific language governing permissions and
+ limitations under the License.
+*/
+
+/**
+ * @file LPC17xx/can_lld.h
+ * @brief LPC17xx CAN subsystem low level driver header.
+ *
+ * @addtogroup CAN
+ * @{
+ */
+
+/*
+ This file has been contributed by:
+ Marcin Jokel.
+*/
+
+#ifndef _CAN_LLD_H_
+#define _CAN_LLD_H_
+
+#if HAL_USE_CAN || defined(__DOXYGEN__)
+/* TODO: FullCAN mode. */
+/*===========================================================================*/
+/* Driver constants. */
+/*===========================================================================*/
+
+/*
+ * CAN Mode register bits.
+ */
+#define CANMOD_RM (1UL << 0)
+#define CANMOD_LOM (1UL << 1)
+#define CANMOD_STM (1UL << 2)
+#define CANMOD_TPM (1UL << 3)
+#define CANMOD_SM (1UL << 4)
+#define CANMOD_RPM (1UL << 5)
+#define CANMOD_TM (1UL << 7)
+
+/*
+ * CAN Command register bits.
+ */
+#define CANCMR_TR (1UL << 0)
+#define CANCMR_AT (1UL << 1)
+#define CANCMR_RRB (1UL << 2)
+#define CANCMR_CDO (1UL << 3)
+#define CANCMR_SRR (1UL << 4)
+#define CANCMR_STB1 (1UL << 5)
+#define CANCMR_STB2 (1UL << 6)
+#define CANCMR_STB3 (1UL << 7)
+
+/*
+ * CAN Global Status register bits.
+ */
+#define CANGSR_RBS (1UL << 0)
+#define CANGSR_DOS (1UL << 1)
+#define CANGSR_TBS (1UL << 2)
+#define CANGSR_TCS (1UL << 3)
+#define CANGSR_RS (1UL << 4)
+#define CANGSR_TS (1UL << 5)
+#define CANGSR_ES (1UL << 6)
+#define CANGSR_BS (1UL << 7)
+#define CANGSR_RXERR 0x00FF0000
+#define CANGSR_TXERR 0xFF000000
+
+/*
+ * CAN Interrupt and Capture register bits.
+ */
+#define CANICR_RI (1UL << 0)
+#define CANICR_TI1 (1UL << 1)
+#define CANICR_EI (1UL << 2)
+#define CANICR_DOI (1UL << 3)
+#define CANICR_WUI (1UL << 4)
+#define CANICR_EPI (1UL << 5)
+#define CANICR_ALI (1UL << 6)
+#define CANICR_BEI (1UL << 7)
+#define CANICR_IDI (1UL << 8)
+#define CANICR_TI2 (1UL << 9)
+#define CANICR_TI3 (1UL << 10)
+#define CANICR_ERRBIT 0x001F0000
+#define CANICR_ERRBIT_SOF 0x00030000
+#define CANICR_ERRBIT_ID28_ID21 0x00020000
+#define CANICR_ERRBIT_ID20_ID18 0x00060000
+#define CANICR_ERRBIT_SRTR 0x00040000
+#define CANICR_ERRBIT_IDE 0x00050000
+#define CANICR_ERRBIT_ID17_ID13 0x00070000
+#define CANICR_ERRBIT_ID12_ID5 0x000F0000
+#define CANICR_ERRBIT_ID4_ID0 0x000E0000
+#define CANICR_ERRBIT_RTR 0x000C0000
+#define CANICR_ERRBIT_RES_BIT1 0x000D0000
+#define CANICR_ERRBIT_RES_BIT0 0x00090000
+#define CANICR_ERRBIT_DATA_LEN_CODE 0x000B0000
+#define CANICR_ERRBIT_DATA_FIELD 0x000A0000
+#define CANICR_ERRBIT_CRC_SEQ 0x00080000
+#define CANICR_ERRBIT_CRC_DEL 0x00180000
+#define CANICR_ERRBIT_ACK_SLOT 0x00190000
+#define CANICR_ERRBIT_ACK_DEL 0x001B0000
+#define CANICR_ERRBIT_EOF 0x001A0000
+#define CANICR_ERRBIT_INTERMISSION 0x00120000
+#define CANICR_ERRBIT_ACTIVE_ERROR 0x00110000
+#define CANICR_ERRBIT_PASSIVE_ERROR 0x00160000
+#define CANICR_ERRBIT_TOL_DOM_BITS 0x00130000
+#define CANICR_ERRBIT_ERROR_DEL 0x00170000
+#define CANICR_ERRBIT_OVERLOAD 0x001C0000
+#define CANICR_ERRDIR (1UL << 21)
+#define CANICR_ERRC (3UL << 22)
+#define CANICR_ERRC_BIT_ERR (0UL << 22)
+#define CANICR_ERRC_FORM_ERR (1UL << 22)
+#define CANICR_ERRC_STUFF_ERR (2UL << 22)
+#define CANICR_ERRC_OTHER_ERR (3UL << 22)
+#define CANICR_ALCBIT 0xFF000000
+
+/*
+ * CAN Interrupt Enable register bits.
+ */
+#define CANIER_RIE (1UL << 0)
+#define CANIER_TIE1 (1UL << 1)
+#define CANIER_EIE (1UL << 2)
+#define CANIER_DOIE (1UL << 3)
+#define CANIER_WUIE (1UL << 4)
+#define CANIER_EPIE (1UL << 5)
+#define CANIER_ALIE (1UL << 6)
+#define CANIER_BEIE (1UL << 7)
+#define CANIER_IDIE (1UL << 8)
+#define CANIER_TIE2 (1UL << 9)
+#define CANIER_TIE3 (1UL << 10)
+
+/*
+ * CAN Bus Timing register bits.
+ */
+#define CANBTR_BRP(t) ((t) << 0)
+#define CANBTR_SJW(t) ((t) << 14)
+#define CANBTR_TESG1(t) ((t) << 16)
+#define CANBTR_TESG2(t) ((t) << 20)
+#define CANBTR_SAM (1UL << 23)
+
+/*
+ * CAN Status register bits.
+ */
+#define CANSR_RBS (1UL << 0)
+#define CANSR_DOS (1UL << 1)
+#define CANSR_TBS1 (1UL << 2)
+#define CANSR_TCS1 (1UL << 3)
+#define CANSR_RS (1UL << 4)
+#define CANSR_TS1 (1UL << 5)
+#define CANSR_ES (1UL << 6)
+#define CANSR_BS (1UL << 7)
+#define CANSR_TBS2 (1UL << 10)
+#define CANSR_TCS2 (1UL << 11)
+#define CANSR_TS2 (1UL << 13)
+#define CANSR_TBS3 (1UL << 18)
+#define CANSR_TCS3 (1UL << 19)
+#define CANSR_TS3 (1UL << 21)
+
+/*
+ * CAN Receive Frame Status register bits.
+ */
+#define CANRFS_ID 0x000001FF
+#define CANRFS_BP (1UL << 10)
+#define CANRFS_DLC 0x000F0000
+#define CANRFS_RTR (1UL << 30)
+#define CANRFS_FF (1UL << 31)
+
+/*
+ * CAN Transmit Frame Information register bits.
+ */
+#define CANTFI_PRIO(p) ((p) << 0)
+#define CANTFI_DLC(l) ((l) << 16)
+#define CANTFI_RTR (1UL << 30)
+#define CANTFI_FF (1UL << 31)
+
+/*
+ * CAN Sleep Clear register bits.
+ */
+#define CANSLEEPCLR_CAN1SLEEP (1UL << 1)
+#define CANSLEEPCLR_CAN2SLEEP (1UL << 2)
+
+/*
+ * CAN Wake-up Flags register bits.
+ */
+#define CANWAKEFLAGS_CAN1WAKE (1UL << 1)
+#define CANWAKEFLAGS_CAN2WAKE (1UL << 2)
+
+/*
+ * Central Transmit Status register bits.
+ */
+#define CANTSR_TS1 (1UL << 0)
+#define CANTSR_TS2 (1UL << 1)
+#define CANTSR_TBS1 (1UL << 8)
+#define CANTSR_TBS2 (1UL << 9)
+#define CANTSR_TCS1 (1UL << 16)
+#define CANTSR_TCS2 (1UL << 17)
+
+/*
+ * Central Receive Status register bits.
+ */
+#define CANRSR_RS1 (1UL << 0)
+#define CANRSR_RS2 (1UL << 1)
+#define CANRSR_RB1 (1UL << 8)
+#define CANRSR_RB2 (1UL << 9)
+#define CANRSR_DOS1 (1UL << 16)
+#define CANRSR_DOS2 (1UL << 17)
+
+/*
+ * Central Miscellaneous Status register bits.
+ */
+#define CANMSR_E1 (1UL << 0)
+#define CANMSR_E2 (1UL << 1)
+#define CANMSR_BS1 (1UL << 8)
+#define CANMSR_BS2 (1UL << 9)
+
+/*
+ * Acceptance Filter Mode register bits.
+ */
+#define AFMR_ACC_OFF (1UL << 0)
+#define AFMR_ACC_BP (1UL << 1)
+#define AFMR_E_FCAN (1UL << 2)
+
+/**
+ * @brief This switch defines whether the driver implementation supports
+ * a low power switch mode with automatic an wakeup feature.
+ */
+#define CAN_SUPPORTS_SLEEP TRUE
+
+/**
+ * @brief This implementation supports three transmit mailboxes.
+ */
+#define CAN_TX_MAILBOXES 3
+
+/**
+ * @brief This implementation supports two receive mailboxes.
+ */
+#define CAN_RX_MAILBOXES 1
+
+/** @} */
+
+/**
+ * @name CAN registers helper macros
+ * @{
+ */
+#define CAN_IDE_STD 0 /**< @brief Standard id. */
+#define CAN_IDE_EXT 1 /**< @brief Extended id. */
+
+#define CAN_RTR_DATA 0 /**< @brief Data frame. */
+#define CAN_RTR_REMOTE 1 /**< @brief Remote frame. */
+
+#undef CAN_LIMIT_WARNING
+#undef CAN_LIMIT_ERROR
+#undef CAN_BUS_OFF_ERROR
+#undef CAN_FRAMING_ERROR
+
+#define CAN_WARNING_ERROR 1
+#define CAN_PASSIVE_ERROR 2
+#define CAN_BUS_ERROR 4
+
+/**
+ * @brief CAN filter fullCAN (standard identifier) type entry.
+ * @note Refer to the LPC17xx reference manual for info about filters.
+ */
+#define CANFilterFCEntry(ctrl_i1, dis_i1, id_i1, ctrl_i2, dis_i2, id_i2) \
+ ((((uint32_t)ctrl_i1) << 29) | (((uint32_t)dis_i1) << 28) | (((uint32_t)id_i1) << 16) | \
+ (((uint32_t)ctrl_i2) << 13) | (((uint32_t)dis_i2) << 12) | ((uint32_t)(id_i2)))
+
+/**
+ * @brief CAN filter standard identifier type entry.
+ * @note Refer to the LPC17xx reference manual for info about filters.
+ */
+#define CANFilterStdEntry(ctrl_i1, dis_i1, id_i1, ctrl_i2, dis_i2, id_i2) \
+ ((((uint32_t)ctrl_i1) << 29) | (((uint32_t)dis_i1) << 28) | (((uint32_t)id_i1) << 16) | \
+ (((uint32_t)ctrl_i2) << 13) | (((uint32_t)dis_i2) << 12) | ((uint32_t)(id_i2)))
+/**
+ * @brief CAN filter extended identifier range type entry.
+ * @note Refer to the LPC17xx reference manual for info about filters.
+ */
+#define CANFilterStdRangeEntry(ctrl_low, dis_low, id_low, ctrl_high, dis_high, id_high) \
+ ((((uint32_t)ctrl_low) << 29) | (((uint32_t)dis_low) << 28) | (((uint32_t)id_low) << 16) | \
+ (((uint32_t)ctrl_up) << 13) | (((uint32_t)dis_up) << 12) | ((uint32_t)(id_up)))
+
+/**
+ * @brief CAN filter extended identifier type entry.
+ * @note Refer to the LPC17xx reference manual for info about filters.
+ */
+#define CANFilterExtEntry(ctrl, id) \
+ ((((uint32_t)ctrl) << 29) | ((uint32_t)(id)))
+
+/**
+ * @brief CAN filter extended range identifier type entry.
+ * @note Refer to the LPC17xx reference manual for info about filters.
+ */
+#define CANFilterExtRangeEntry(ctrl, id) \
+ ((((uint32_t)ctrl) << 29) | ((uint32_t)(id)))
+/** @} */
+
+/*===========================================================================*/
+/* Driver pre-compile time settings. */
+/*===========================================================================*/
+
+/**
+ * @name Configuration options
+ * @{
+ */
+/**
+ * @brief CAN1 driver enable switch.
+ * @details If set to @p TRUE the support for CAN1 is included.
+ */
+#if !defined(LPC17xx_CAN_USE_CAN1) || defined(__DOXYGEN__)
+#define LPC17xx_CAN_USE_CAN1 FALSE
+#endif
+
+/**
+ * @brief CAN2 driver enable switch.
+ * @details If set to @p TRUE the support for CAN2 is included.
+ */
+#if !defined(LPC17xx_CAN_USE_CAN2) || defined(__DOXYGEN__)
+#define LPC17xx_CAN_USE_CAN2 FALSE
+#endif
+
+/**
+ * @brief CAN1 and CAN2 interrupt priority level setting.
+ */
+#if !defined(LPC17xx_CAN_IRQ_PRIORITY) || defined(__DOXYGEN__)
+#define LPC17xx_CAN_IRQ_PRIORITY 11
+#endif
+/** @} */
+
+/**
+ * @brief CAN1 and CAN2 local self test enable.
+ */
+#if !defined(LPC17xx_CAN_USE_LOCAL_SELF_TEST) || defined(__DOXYGEN__)
+#define LPC17xx_CAN_USE_LOCAL_SELF_TEST FALSE
+#endif
+/** @} */
+
+/**
+ * @brief CAN1 and CAN2 acceptance filter enable.
+ */
+#if !defined(LPC17xx_CAN_USE_FILTER) || defined(__DOXYGEN__)
+#define LPC17xx_CAN_USE_FILTER FALSE
+#endif
+/** @} */
+
+/** @} */
+
+/*===========================================================================*/
+/* Derived constants and error checks. */
+/*===========================================================================*/
+
+#if LPC17xx_CAN_USE_CAN1 && !LPC17xx_HAS_CAN1
+#error "CAN1 not present in the selected device"
+#endif
+
+#if LPC17xx_CAN_USE_CAN2 && !LPC17xx_HAS_CAN2
+#error "CAN2 not present in the selected device"
+#endif
+
+#if !LPC17xx_CAN_USE_CAN1 && !LPC17xx_CAN_USE_CAN2
+#error "CAN driver activated but no CAN peripheral assigned"
+#endif
+
+#if !LPC17xx_CAN_USE_CAN1 && LPC17xx_CAN_USE_CAN2
+#error "CAN2 requires CAN1, it cannot operate independently"
+#endif
+
+#if CAN_USE_SLEEP_MODE && !CAN_SUPPORTS_SLEEP
+#error "CAN sleep mode not supported in this architecture"
+#endif
+
+/*===========================================================================*/
+/* Driver data structures and types. */
+/*===========================================================================*/
+
+/**
+ * @brief Type of a transmission mailbox index.
+ */
+typedef uint32_t canmbx_t;
+
+/**
+ * @brief CAN transmission frame.
+ * @note Accessing the frame data as word16 or word32 is not portable because
+ * machine data endianness, it can be still useful for a quick filling.
+ */
+typedef struct {
+ struct {
+ uint8_t DLC:4; /**< @brief Data length. */
+ uint8_t RTR:1; /**< @brief Frame type. */
+ uint8_t IDE:1; /**< @brief Identifier type. */
+ };
+ union {
+ struct {
+ uint32_t SID:11; /**< @brief Standard identifier.*/
+ };
+ struct {
+ uint32_t EID:29; /**< @brief Extended identifier.*/
+ };
+ };
+ union {
+ uint8_t data8[8]; /**< @brief Frame data. */
+ uint16_t data16[4]; /**< @brief Frame data. */
+ uint32_t data32[2]; /**< @brief Frame data. */
+ };
+} CANTxFrame;
+
+/**
+ * @brief CAN received frame.
+ * @note Accessing the frame data as word16 or word32 is not portable because
+ * machine data endianness, it can be still useful for a quick filling.
+ */
+typedef struct {
+ struct {
+ uint16_t IDF:10; /**< @brief Filter id. */
+ };
+ struct {
+ uint8_t DLC:4; /**< @brief Data length. */
+ uint8_t RTR:1; /**< @brief Frame type. */
+ uint8_t IDE:1; /**< @brief Identifier type. */
+ };
+ union {
+ struct {
+ uint32_t SID:11; /**< @brief Standard identifier.*/
+ };
+ struct {
+ uint32_t EID:29; /**< @brief Extended identifier.*/
+ };
+ };
+ union {
+ uint8_t data8[8]; /**< @brief Frame data. */
+ uint16_t data16[4]; /**< @brief Frame data. */
+ uint32_t data32[2]; /**< @brief Frame data. */
+ };
+} CANRxFrame;
+
+/**
+ * @brief CAN filter standard identifier type.
+ * @note Refer to the LPC17xx reference manual for info about filters.
+ */
+typedef const uint32_t CANFilterStd;
+
+/**
+ * @brief CAN filter standard identifier range type.
+ * @note Refer to the LPC17xx reference manual for info about filters.
+ */
+typedef const uint32_t CANFilterStdRange;
+
+/**
+ * @brief CAN filter extended identifier range type.
+ * @note Refer to the LPC17xx reference manual for info about filters.
+ */
+typedef const uint32_t CANFilterExt;
+
+/**
+ * @brief CAN filter extended range identifier type.
+ * @note Refer to the LPC17xx reference manual for info about filters.
+ */
+typedef const uint32_t CANFilterExtRange;
+
+/**
+ * @brief CAN filter configuration structure.
+ * @note Refer to the LPC17xx reference manual for info about filters.
+ */
+typedef struct {
+ /**
+ * @brief Acceptance filter mode register.
+ */
+ uint32_t afmr;
+ /**
+ * @brief FullCAN (standard identifier) table.
+ */
+ CANFilterStd *fc_id_table;
+ /**
+ * @brief Number of positions in fullCAN (standard identifier) table.
+ */
+ uint32_t fc_id_table_n;
+ /**
+ * @brief Standard identifier table.
+ */
+ CANFilterStd *std_id_table;
+ /**
+ * @brief Number of positions in standard identifier table.
+ */
+ uint32_t std_id_table_n;
+ /**
+ * @brief Standard range identifier table.
+ */
+ CANFilterStdRange *std_range_id_table;
+ /**
+ * @brief Number of positions in standard range identifier table.
+ */
+ uint32_t std_range_id_table_n;
+ /**
+ * @brief Extended identifier table.
+ */
+ CANFilterExt *ext_id_table;
+ /**
+ * @brief Number of positions in extended identifier table.
+ */
+ uint32_t ext_id_table_n;
+ /**
+ * @brief Extended range identifier table.
+ */
+ CANFilterExtRange *ext_range_id_table;
+ /**
+ * @brief Number of positions in extended range identifier table.
+ */
+ uint32_t ext_range_id_table_n;
+} CANFilterConfig;
+
+/**
+ * @brief Driver configuration structure.
+ */
+typedef struct {
+ /**
+ * @brief CAN MOD register initialization data.
+ * @note Some bits in this register are enforced by the driver regardless
+ * their status in this field.
+ */
+ uint32_t mod;
+ /**
+ * @brief CAN BTR register initialization data.
+ * @note Some bits in this register are enforced by the driver regardless
+ * their status in this field.
+ */
+ uint32_t btr;
+} CANConfig;
+
+/**
+ * @brief Structure representing an CAN driver.
+ */
+typedef struct {
+ /**
+ * @brief Driver state.
+ */
+ canstate_t state;
+ /**
+ * @brief Current configuration data.
+ */
+ const CANConfig *config;
+ /**
+ * @brief Transmission queue semaphore.
+ */
+ Semaphore txsem;
+ /**
+ * @brief Receive queue semaphore.
+ */
+ Semaphore rxsem;
+ /**
+ * @brief One or more frames become available.
+ * @note After broadcasting this event it will not be broadcasted again
+ * until the received frames queue has been completely emptied. It
+ * is <b>not</b> broadcasted for each received frame. It is
+ * responsibility of the application to empty the queue by
+ * repeatedly invoking @p chReceive() when listening to this event.
+ * This behavior minimizes the interrupt served by the system
+ * because CAN traffic.
+ * @note The flags associated to the listeners will indicate which
+ * receive mailboxes become non-empty.
+ */
+ EventSource rxfull_event;
+ /**
+ * @brief One or more transmission mailbox become available.
+ * @note The flags associated to the listeners will indicate which
+ * transmit mailboxes become empty.
+ *
+ */
+ EventSource txempty_event;
+ /**
+ * @brief A CAN bus error happened.
+ * @note The flags associated to the listeners will indicate the
+ * error(s) that have occurred.
+ */
+ EventSource error_event;
+#if CAN_USE_SLEEP_MODE || defined (__DOXYGEN__)
+ /**
+ * @brief Entering sleep state event.
+ */
+ EventSource sleep_event;
+ /**
+ * @brief Exiting sleep state event.
+ */
+ EventSource wakeup_event;
+#endif /* CAN_USE_SLEEP_MODE */
+ /* End of the mandatory fields.*/
+ /**
+ * @brief Pointer to the CAN registers.
+ */
+ LPC_CAN_TypeDef *can;
+} CANDriver;
+
+/*===========================================================================*/
+/* Driver macros. */
+/*===========================================================================*/
+
+/*===========================================================================*/
+/* External declarations. */
+/*===========================================================================*/
+
+#if LPC17xx_CAN_USE_CAN1 && !defined(__DOXYGEN__)
+extern CANDriver CAND1;
+#endif
+
+#if LPC17xx_CAN_USE_CAN2 && !defined(__DOXYGEN__)
+extern CANDriver CAND2;
+#endif
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+ void can_lld_init(void);
+ void can_lld_start(CANDriver *canp);
+ void can_lld_stop(CANDriver *canp);
+ bool_t can_lld_is_tx_empty(CANDriver *canp,
+ canmbx_t mailbox);
+ void can_lld_transmit(CANDriver *canp,
+ canmbx_t mailbox,
+ const CANTxFrame *crfp);
+ bool_t can_lld_is_rx_nonempty(CANDriver *canp,
+ canmbx_t mailbox);
+ void can_lld_receive(CANDriver *canp,
+ canmbx_t mailbox,
+ CANRxFrame *ctfp);
+#if CAN_USE_SLEEP_MODE
+ void can_lld_sleep(CANDriver *canp);
+ void can_lld_wakeup(CANDriver *canp);
+#endif /* CAN_USE_SLEEP_MODE */
+#if LPC17xx_CAN_USE_FILTER
+ void canSetFilter(const CANFilterConfig *cfc);
+#endif /* LPC17xx_CAN_USE_FILTER */
+#ifdef __cplusplus
+}
+#endif
+
+#endif /* HAL_USE_CAN */
+
+#endif /* _CAN_LLD_H_ */
+
+/** @} */
diff --git a/os/hal/platforms/LPC17xx/platform.mk b/os/hal/platforms/LPC17xx/platform.mk
index 9e5f855de..71a87ac76 100644
--- a/os/hal/platforms/LPC17xx/platform.mk
+++ b/os/hal/platforms/LPC17xx/platform.mk
@@ -9,7 +9,8 @@ PLATFORMSRC = ${CHIBIOS}/os/hal/platforms/LPC17xx/hal_lld.c \
${CHIBIOS}/os/hal/platforms/LPC17xx/i2c_lld.c \
${CHIBIOS}/os/hal/platforms/LPC17xx/spi_lld.c \
${CHIBIOS}/os/hal/platforms/LPC17xx/dac_lld.c \
- ${CHIBIOS}/os/hal/platforms/LPC17xx/mac_lld.c
+ ${CHIBIOS}/os/hal/platforms/LPC17xx/mac_lld.c \
+ ${CHIBIOS}/os/hal/platforms/LPC17xx/can_lld.c
# Required include directories