trying to execute the following code the following error occurs

cancel
Showing results for 
Show  only  | Search instead for 
Did you mean: 

trying to execute the following code the following error occurs

604 Views
sharuqueshaji
Contributor I

#if defined (__USE_LPCOPEN)
#if defined(NO_BOARD_LIB)
#include "chip.h"
#else
#include "board.h"
#endif
#endif

#include <cr_section_macros.h>
#include <can_17xx_40xx.h>
#include<uart_17xx_40xx.h>
// TODO: insert other include files here

// TODO: insert other definitions and declarations here

int main(void) {

#if defined (__USE_LPCOPEN)
// Read clock settings and update SystemCoreClock variable
SystemCoreClockUpdate();
#if !defined(NO_BOARD_LIB)
// Set up and initialize all required blocks and
// functions related to the board hardware
Board_Init();


// Set the LED to the state of "On"
Board_LED_Set(0, true);
#endif
#endif
STATIC void setBusTiming(LPC_CAN_T *pCAN, IP_CAN_BUS_TIMING_T *pBusTiming) {
/* Enter to Reset Mode */
Chip_CAN_SetMode(pCAN, CAN_RESET_MODE, ENABLE);

/* Set Bus Timing */
pCAN->BTR = CAN_BTR_BRP(pBusTiming->BRP)
| CAN_BTR_SJW(pBusTiming->SJW)
| CAN_BTR_TESG1(pBusTiming->TESG1)
| CAN_BTR_TESG2(pBusTiming->TESG2);

if (pBusTiming->SAM) {
pCAN->BTR |= CAN_BTR_SAM;
}

/* Exit from Reset Mode */
Chip_CAN_SetMode(pCAN, CAN_RESET_MODE, DISABLE);
}

/* Get start row, end row of the given section */
STATIC void getSectionAddress(LPC_CANAF_T *pCANAF,
CANAF_RAM_SECTION_T SectionID, uint16_t *StartAddr, uint16_t *EndAddr)
{
if (SectionID == CANAF_RAM_FULLCAN_SEC) {
*StartAddr = 0;
}
else {
*StartAddr = CANAF_ENDADDR_VAL(pCANAF->ENDADDR[SectionID - 1]);
}
*EndAddr = CANAF_ENDADDR_VAL(pCANAF->ENDADDR[SectionID]);

if (*EndAddr > 0) {
*EndAddr -= 1; /* Minus 1 to get the actual end row */
}
else {
*EndAddr = *StartAddr;
}
}

/* Get the total number of entries in LUT */
STATIC INLINE uint16_t getTotalEntryNum(LPC_CANAF_T *pCANAF)
{
return CANAF_ENDADDR_VAL(pCANAF->ENDADDR[CANAF_RAM_EFF_GRP_SEC]); /* Extended ID Group section is the last section of LUT */
}

/* Set the End Address of a section. EndAddr = the number of the last row of the section + 1. */
STATIC INLINE void setSectionEndAddress(LPC_CANAF_T *pCANAF,
CANAF_RAM_SECTION_T SectionID, uint16_t EndAddr)
{
pCANAF->ENDADDR[SectionID] = CANAF_ENDADDR(EndAddr);
}

/* Get information of the received frame. Return ERROR means no message came.*/
STATIC INLINE Status getReceiveFrameInfo(LPC_CAN_T *pCAN,
IP_CAN_001_RX_T *pRxFrame)
{
*pRxFrame = pCAN->RX;
return (pCAN->SR & CAN_SR_RBS(0)) ? SUCCESS : ERROR;
}

/* Set Tx Frame Information */
STATIC INLINE void setSendFrameInfo(LPC_CAN_T *pCAN, CAN_BUFFER_ID_T TxBufID,
LPC_CAN_TX_T *pTxFrame)
{
pCAN->TX[TxBufID] = *pTxFrame;
}

/* Create the standard ID entry */
STATIC uint16_t createStdIDEntry(CAN_STD_ID_ENTRY_T *pEntryInfo, bool IsFullCANEntry)
{
uint16_t Entry = 0;
Entry = (pEntryInfo->CtrlNo & CAN_STD_ENTRY_CTRL_NO_MASK) << CAN_STD_ENTRY_CTRL_NO_POS;
Entry |= (pEntryInfo->Disable & CAN_STD_ENTRY_DISABLE_MASK) << CAN_STD_ENTRY_DISABLE_POS;
Entry |= (pEntryInfo->ID_11 & CAN_STD_ENTRY_ID_MASK) << CAN_STD_ENTRY_ID_POS;
if (IsFullCANEntry) {
Entry |= 1 << CAN_STD_ENTRY_IE_POS;
}
return Entry;
}

STATIC INLINE uint16_t createUnUsedSTDEntry(uint8_t CtrlNo)
{
return ((CtrlNo & CAN_STD_ENTRY_CTRL_NO_MASK) << CAN_STD_ENTRY_CTRL_NO_POS) | (1 << CAN_STD_ENTRY_DISABLE_POS);
}

/* Get information from the standard ID entry */
STATIC void readStdIDEntry(uint16_t EntryVal, CAN_STD_ID_ENTRY_T *pEntryInfo)
{
pEntryInfo->CtrlNo = (EntryVal >> CAN_STD_ENTRY_CTRL_NO_POS) & CAN_STD_ENTRY_CTRL_NO_MASK;
pEntryInfo->Disable = (EntryVal >> CAN_STD_ENTRY_DISABLE_POS) & CAN_STD_ENTRY_DISABLE_MASK;
pEntryInfo->ID_11 = (EntryVal >> CAN_STD_ENTRY_ID_POS) & CAN_STD_ENTRY_ID_MASK;
}

/* Setup Standard iD section */
STATIC Status setupSTDSection(uint32_t *pCANAFRamAddr,
CAN_STD_ID_ENTRY_T *pStdCANSec,
uint16_t EntryNum,
bool IsFullCANEntry)
{
uint16_t i;
uint16_t CurID = 0;
uint16_t Entry;
uint16_t EntryCnt = 0;

/* Setup FullCAN section */
for (i = 0; i < EntryNum; i += 2) {
/* First Entry */
if (CurID > pStdCANSec[i].ID_11) {
return ERROR;
}
CurID = pStdCANSec[i].ID_11;
Entry = createStdIDEntry(&pStdCANSec[i], IsFullCANEntry);
pCANAFRamAddr[EntryCnt] = Entry << 16;

/* Second Entry */
if ((i + 1) < EntryNum) {
if (CurID > pStdCANSec[i + 1].ID_11) {
return ERROR;
}
CurID = pStdCANSec[i + 1].ID_11;
Entry = createStdIDEntry(&pStdCANSec[i + 1], IsFullCANEntry);
pCANAFRamAddr[EntryCnt] |= Entry;
}
else {
pCANAFRamAddr[EntryCnt] |= createUnUsedSTDEntry(pStdCANSec[0].CtrlNo);
}
EntryCnt++;
}
return SUCCESS;

}

/* Setup the Group Standard ID section */
STATIC Status setupSTDRangeSection(uint32_t *pCANAFRamAddr,
CAN_STD_ID_RANGE_ENTRY_T *pStdRangeCANSec,
uint16_t EntryNum)
{
return setupSTDSection(pCANAFRamAddr, (CAN_STD_ID_ENTRY_T *) pStdRangeCANSec, EntryNum * 2, false);
}

/* Shift a number of entries down 1 position */
STATIC void shiftSTDEntryDown(uint32_t *arr, int32_t num)
{
uint32_t i = 0;
uint32_t prevRow, curRow;

if (num <= 0) {
return;
}

prevRow = arr[0];
arr[0] = ((prevRow & 0xFFFF0000) >> 16);
for (i = 0; i < (num / 2); i++) {
curRow = arr[i + 1];
arr[i + 1] = ((prevRow & 0xFFFF) << 16) | ((curRow & 0xFFFF0000) >> 16);
prevRow = curRow;
}
if ((num % 2) == 0) {
uint8_t CtrlNo = (prevRow >> CAN_STD_ENTRY_CTRL_NO_POS) & CAN_STD_ENTRY_CTRL_NO_MASK;
arr[num / 2] = ((prevRow & 0xFFFF) << 16) | createUnUsedSTDEntry(CtrlNo);
}
}

/* Shift a number of entries up 1 position */
STATIC void shiftSTDEntryUp(uint32_t *arr, int32_t num)
{
int32_t i = 0;
uint32_t prevRow = 0, curRow = 0;
uint8_t CtrlNo = 0;

if (num <= 0) {
return;
}

curRow = arr[((num + 1) / 2) - 1];
CtrlNo = (curRow >> CAN_STD_ENTRY_CTRL_NO_POS) & CAN_STD_ENTRY_CTRL_NO_MASK;

/* If num is odd, the last row only includes one item. Therefore, there is nothing
to do with it. If num is even, shift the last item to one place of the row.*/
if ((num % 2) == 0) {
arr[((num + 1) / 2) - 1] = ((curRow & 0xFFFF) << 16) | createUnUsedSTDEntry(CtrlNo);
}
/* Shift from the row before the last row */
for (i = ((num + 1) / 2) - 1; i > 0; i--) {
prevRow = arr[i - 1];
arr[i - 1] = ((curRow & 0xFFFF0000) >> 16) | ((prevRow & 0xFFFF) << 16);
curRow = prevRow;
}
}

/* Create an extended ID entry */
STATIC uint32_t createExtIDEntry(CAN_EXT_ID_ENTRY_T *pEntryInfo)
{
uint32_t Entry = 0;
Entry = (pEntryInfo->CtrlNo & CAN_EXT_ENTRY_CTRL_NO_MASK) << CAN_EXT_ENTRY_CTRL_NO_POS;
Entry |= (pEntryInfo->ID_29 & CAN_EXT_ENTRY_ID_MASK) << CAN_EXT_ENTRY_ID_POS;
return Entry;
}

/* Get information from an extended ID entry */
STATIC void readExtIDEntry(uint32_t EntryVal, CAN_EXT_ID_ENTRY_T *pEntryInfo)
{
pEntryInfo->CtrlNo = (EntryVal >> CAN_EXT_ENTRY_CTRL_NO_POS) & CAN_EXT_ENTRY_CTRL_NO_MASK;
pEntryInfo->ID_29 = (EntryVal >> CAN_EXT_ENTRY_ID_POS) & CAN_EXT_ENTRY_ID_MASK;
}

/* Setup the Extended ID Section */
STATIC Status setupEXTSection(uint32_t *pCANAFRamAddr, CAN_EXT_ID_ENTRY_T *pExtCANSec, uint16_t EntryNum)
{
uint16_t i;
uint32_t CurID = 0;
uint32_t Entry;
uint16_t EntryCnt = 0;

/* Setup FullCAN section */
for (i = 0; i < EntryNum; i++) {
if (CurID > pExtCANSec[i].ID_29) {
return ERROR;
}
CurID = pExtCANSec[i].ID_29;
Entry = createExtIDEntry(&pExtCANSec[i]);
pCANAFRamAddr[EntryCnt] = Entry;
EntryCnt++;
}
return SUCCESS;

}

/* Setup Group Extended ID section */
STATIC Status setupEXTRangeSection(uint32_t *pCANAFRamAddr,
CAN_EXT_ID_RANGE_ENTRY_T *pExtRangeCANSec,
uint16_t EntryNum)
{
return setupEXTSection(pCANAFRamAddr, (CAN_EXT_ID_ENTRY_T *) pExtRangeCANSec, EntryNum * 2);
}

/* Get entry value from the given start index of the given array. byteNum is 2 or 4 bytes */
STATIC uint32_t getArrayVal(uint8_t *arr, uint32_t startIndex, uint8_t byteNum)
{
uint8_t i = 0;
uint32_t retVal = 0;
uint32_t index;

index = startIndex * byteNum;
if (byteNum == 2) { // each entry uses 2 bytes
if (startIndex % 2) {
index -= 2; // little endian
}
else {
index += 2;
}
}

for (i = 0; i < byteNum; i++) {
retVal |= arr[index + i] << (8 * i);
}
return retVal;
}

/* Search the index to insert the new entry */
STATIC int32_t searchInsertIndex(uint32_t *arr, uint32_t arrNum, uint32_t val, uint32_t mask, uint8_t unitSize)
{
uint32_t LowerIndex, UpperIndex, MidIndex;
uint32_t MidVal;
uint8_t *byteArray = (uint8_t *) arr;

if (arrNum == 0) {
return 0; /* Insert into the first line */

}
LowerIndex = 0;
UpperIndex = arrNum - 1;
while (LowerIndex + 1 < UpperIndex) {
MidIndex = (LowerIndex + UpperIndex) / 2;
MidVal = getArrayVal(byteArray, MidIndex, unitSize) & mask;
if (MidVal == val) {
return -1; /* The new value is already in the array */
}
else if (MidVal < val) {
LowerIndex = MidIndex + 1;
}
else {
UpperIndex = MidIndex - 1;
}
}

if (((getArrayVal(byteArray, LowerIndex, unitSize) & mask) == val) ||
((getArrayVal(byteArray, UpperIndex, unitSize) & mask) == val)) {
return -1; /* The new value is already in the array */
}
if ((getArrayVal(byteArray, LowerIndex, unitSize) & mask) > val) {
return LowerIndex;
}
if ((getArrayVal(byteArray, UpperIndex, unitSize) & mask) < val) {
return UpperIndex + 1;
}

return UpperIndex;
}

/* Insert an entry into FullCAN Table */
STATIC Status insertSTDEntry(LPC_CANAF_T *pCANAF,
LPC_CANAF_RAM_T *pCANAFRam,
CAN_STD_ID_ENTRY_T *pEntry,
bool IsFullCANEntry)
{
int32_t IDIndex = 0;
uint16_t StartRow, EndRow;
uint16_t EntryCnt = 0;
uint16_t i = 0;
uint32_t tmp = 0;
CAN_AF_MODE_T CurMode = Chip_CAN_GetAFMode(pCANAF);

if (getTotalEntryNum(pCANAF) >= CANAF_RAM_ENTRY_NUM) {
return ERROR;
}

/* Check if a number of entries in section is odd or even */
if (IsFullCANEntry) {
getSectionAddress(pCANAF, CANAF_RAM_FULLCAN_SEC, &StartRow, &EndRow);
}
else {
getSectionAddress(pCANAF, CANAF_RAM_SFF_SEC, &StartRow, &EndRow);

}

if (EndRow > StartRow) {
EntryCnt = (EndRow - StartRow + 1) * 2;
if ((((pCANAFRam->MASK[EndRow] >> CAN_STD_ENTRY_ID_POS) & CAN_STD_ENTRY_ID_MASK) ==
0) &&
(((pCANAFRam->MASK[EndRow] >>
CAN_STD_ENTRY_DISABLE_POS) & CAN_STD_ENTRY_DISABLE_MASK) == 1)) { /* Unsed entry */
EntryCnt -= 1;
}

}

/* Search for Index of new entry */
IDIndex = searchInsertIndex((uint32_t *) &pCANAFRam->MASK[StartRow],
EntryCnt,
pEntry->ID_11 & CAN_STD_ENTRY_ID_MASK,
CAN_STD_ENTRY_ID_MASK,
sizeof(uint16_t));
if ((IDIndex == -1) || (IDIndex > EntryCnt )) {
return ERROR;
}

/* AF Off */
Chip_CAN_SetAFMode(pCANAF, CAN_AF_OFF_MODE);

/* Move all remaining sections one place down
if new entry will increase FullCAN list */
if ((EntryCnt % 2) == 0) {
uint16_t StartAddr, EndAddr;

for (i = getTotalEntryNum(pCANAF); i > EndRow; i--) {
pCANAFRam->MASK[i] = pCANAFRam->MASK[i - 1];
}

if (IsFullCANEntry) {
getSectionAddress(pCANAF, CANAF_RAM_FULLCAN_SEC, &StartAddr, &EndAddr);
setSectionEndAddress(pCANAF, CANAF_RAM_FULLCAN_SEC, EndAddr + 2);
}
getSectionAddress(pCANAF, CANAF_RAM_SFF_SEC, &StartAddr, &EndAddr);
setSectionEndAddress(pCANAF, CANAF_RAM_SFF_SEC, EndAddr + 2);
getSectionAddress(pCANAF, CANAF_RAM_SFF_GRP_SEC, &StartAddr, &EndAddr);
setSectionEndAddress(pCANAF, CANAF_RAM_SFF_GRP_SEC, EndAddr + 2);
getSectionAddress(pCANAF, CANAF_RAM_EFF_SEC, &StartAddr, &EndAddr);
setSectionEndAddress(pCANAF, CANAF_RAM_EFF_SEC, EndAddr + 2);
getSectionAddress(pCANAF, CANAF_RAM_EFF_GRP_SEC, &StartAddr, &EndAddr);
setSectionEndAddress(pCANAF, CANAF_RAM_EFF_GRP_SEC, EndAddr + 2);
}

/* Shift rows behind the row of search index. If search index is low index of the row, shift the row of search index also. */
if ((IDIndex % 2) == 0) {
shiftSTDEntryDown((uint32_t *) &pCANAFRam->MASK[StartRow + IDIndex / 2], EntryCnt - IDIndex);
}
else {
shiftSTDEntryDown((uint32_t *) &pCANAFRam->MASK[StartRow + IDIndex / 2 + 1], EntryCnt - IDIndex - 1);
}

/* Insert new item */
tmp = createStdIDEntry(pEntry, IsFullCANEntry);
if ((IDIndex % 2) == 0) {
if (IDIndex == EntryCnt) {
/* Insert unused item if the new item is the last item*/
pCANAFRam->MASK[StartRow + IDIndex / 2] = (tmp << 16) | createUnUsedSTDEntry(pEntry->CtrlNo);
}
else {
uint32_t val;
val = pCANAFRam->MASK[StartRow + IDIndex / 2] & 0x0000FFFF;
/* Insert new item */
pCANAFRam->MASK[StartRow + IDIndex / 2] = val | (tmp << 16);
}
}
else {
uint32_t val, valNext;
val = pCANAFRam->MASK[StartRow + IDIndex / 2];
valNext = pCANAFRam->MASK[StartRow + IDIndex / 2 + 1];
/* In case the new entry is not the last item, shift the item at the found index to the next row*/
if (IDIndex < EntryCnt ) {

pCANAFRam->MASK[StartRow + IDIndex / 2 + 1] = (valNext & 0x0000FFFF) | ((val & 0xFFFF) << 16);
}
pCANAFRam->MASK[StartRow + IDIndex / 2] = (val & 0xFFFF0000) | tmp;
}

/* Return to previous mode */
Chip_CAN_SetAFMode(pCANAF, CurMode);
return SUCCESS;
}

/* Read STD Entry */
STATIC Status readSTDEntry(LPC_CANAF_T *pCANAF,
LPC_CANAF_RAM_T *pCANAFRam,
uint16_t Position,
bool IsFullCANEntry,
CAN_STD_ID_ENTRY_T *pEntry)

{
uint16_t StartRow, EndRow;
uint16_t EntryCnt = 0;

/* Check if a number of entries in section is odd or even */
if (IsFullCANEntry) {
getSectionAddress(pCANAF, CANAF_RAM_FULLCAN_SEC, &StartRow, &EndRow);
}
else {
getSectionAddress(pCANAF, CANAF_RAM_SFF_SEC, &StartRow, &EndRow);
}

if (EndRow > StartRow) {
EntryCnt = (EndRow - StartRow + 1) * 2;
if ((((pCANAFRam->MASK[EndRow] >> CAN_STD_ENTRY_ID_POS) & CAN_STD_ENTRY_ID_MASK) ==
0) &&
(((pCANAFRam->MASK[EndRow] >>
CAN_STD_ENTRY_DISABLE_POS) & CAN_STD_ENTRY_DISABLE_MASK) == 1)) { /* Unsed entry */
EntryCnt -= 1;
}
}
if (Position >= EntryCnt) {
return ERROR;
}

if ((Position % 2) == 0) {
readStdIDEntry(pCANAFRam->MASK[StartRow + Position / 2] >> 16, pEntry);
}
else {
readStdIDEntry(pCANAFRam->MASK[StartRow + Position / 2] & 0xFFFF, pEntry);
}

return SUCCESS;
}

/* Remove STD Entry from given table */
Status removeSTDEntry(LPC_CANAF_T *pCANAF,
LPC_CANAF_RAM_T *pCANAFRam,
int16_t IDIndex,
bool IsFullCANEntry)
{
uint16_t StartRow, EndRow;
uint16_t EntryCnt = 0, i;
uint32_t tmp = 0;
CAN_AF_MODE_T CurMode = Chip_CAN_GetAFMode(pCANAF);

if (IDIndex < 0) {
return ERROR;
}

if (getTotalEntryNum(pCANAF) >= CANAF_RAM_ENTRY_NUM) {
return ERROR;
}

/* Check if a number of entries in section is odd or even */
if (IsFullCANEntry) {
getSectionAddress(pCANAF, CANAF_RAM_FULLCAN_SEC, &StartRow, &EndRow);
}
else {
getSectionAddress(pCANAF, CANAF_RAM_SFF_SEC, &StartRow, &EndRow);
}

if (EndRow > StartRow) {
EntryCnt = (EndRow - StartRow + 1) * 2;
if ((((pCANAFRam->MASK[EndRow] >> CAN_STD_ENTRY_ID_POS) & CAN_STD_ENTRY_ID_MASK) ==
0) &&
(((pCANAFRam->MASK[EndRow] >>
CAN_STD_ENTRY_DISABLE_POS) & CAN_STD_ENTRY_DISABLE_MASK) == 1)) { /* Unsed entry */
EntryCnt -= 1;
}

}
if (IDIndex >= EntryCnt) {
return ERROR;
}

/* AF Off */
Chip_CAN_SetAFMode(pCANAF, CAN_AF_OFF_MODE);

/* Shift rows behind the row of remove index. If remove index is low index of the row, shift the row of remove index also. */
tmp = pCANAFRam->MASK[StartRow + IDIndex / 2 + 1];
if ((IDIndex % 2) == 0) {
shiftSTDEntryUp((uint32_t *) &pCANAFRam->MASK[StartRow + IDIndex / 2], EntryCnt - IDIndex);
}
else {
shiftSTDEntryUp((uint32_t *) &pCANAFRam->MASK[StartRow + IDIndex / 2 + 1], EntryCnt - IDIndex - 1);

/* Set value for the entry at remove index */
pCANAFRam->MASK[StartRow + IDIndex / 2] &= 0xFFFF0000;
if (IDIndex == (EntryCnt - 1)) {
uint8_t CtrlNo;
tmp = (pCANAFRam->MASK[StartRow + IDIndex / 2]) >> 16;
CtrlNo = (tmp >> CAN_STD_ENTRY_CTRL_NO_POS) & CAN_STD_ENTRY_CTRL_NO_MASK;
pCANAFRam->MASK[StartRow + IDIndex / 2] |= createUnUsedSTDEntry(CtrlNo);
}
else {
pCANAFRam->MASK[StartRow + IDIndex / 2] |= (tmp >> 16) & 0xFFFF;
}
}
/* Move all remaining sections one place up
if new entry will decrease FullCAN list */
if (EntryCnt % 2) {
uint16_t StartAddr, EndAddr;

for (i = EndRow; i < getTotalEntryNum(pCANAF); i++) {
pCANAFRam->MASK[i] = pCANAFRam->MASK[i + 1];
}

if (IsFullCANEntry) {
getSectionAddress(pCANAF, CANAF_RAM_FULLCAN_SEC, &StartAddr, &EndAddr);
setSectionEndAddress(pCANAF, CANAF_RAM_FULLCAN_SEC, EndAddr);
}
getSectionAddress(pCANAF, CANAF_RAM_SFF_SEC, &StartAddr, &EndAddr);
setSectionEndAddress(pCANAF, CANAF_RAM_SFF_SEC, EndAddr);
getSectionAddress(pCANAF, CANAF_RAM_SFF_GRP_SEC, &StartAddr, &EndAddr);
setSectionEndAddress(pCANAF, CANAF_RAM_SFF_GRP_SEC, EndAddr);
getSectionAddress(pCANAF, CANAF_RAM_EFF_SEC, &StartAddr, &EndAddr);
setSectionEndAddress(pCANAF, CANAF_RAM_EFF_SEC, EndAddr);
getSectionAddress(pCANAF, CANAF_RAM_EFF_GRP_SEC, &StartAddr, &EndAddr);
setSectionEndAddress(pCANAF, CANAF_RAM_EFF_GRP_SEC, EndAddr);
}

/* Return to previous mode */
Chip_CAN_SetAFMode(pCANAF, CurMode);
return SUCCESS;
}

/* Remove LUT Entry from given table */
Status removeLUTEntry(LPC_CANAF_T *pCANAF,
LPC_CANAF_RAM_T *pCANAFRam,
CANAF_RAM_SECTION_T SectionID,
int16_t Position)
{
uint16_t StartRow, EndRow;
uint16_t StartAddr, EndAddr;
uint16_t EntryCnt = 0;
uint8_t EntryRowNum = 1;
uint16_t i = 0;
CAN_AF_MODE_T CurMode = Chip_CAN_GetAFMode(pCANAF);

if (Position < 0) {
return ERROR;
}

if (getTotalEntryNum(pCANAF) >= CANAF_RAM_ENTRY_NUM) {
return ERROR;
}

if (SectionID == CANAF_RAM_FULLCAN_SEC) {
return removeSTDEntry(pCANAF, pCANAFRam, Position, true);
}
else if (SectionID == CANAF_RAM_SFF_SEC) {
return removeSTDEntry(pCANAF, pCANAFRam, Position, false);
}

/* Get a number of rows for an entry */
if (SectionID == CANAF_RAM_EFF_GRP_SEC) {
EntryRowNum = 2;
}

/* Get Start Row, End Row */
getSectionAddress(pCANAF, SectionID, &StartRow, &EndRow);

if (EndRow > StartRow) {
EntryCnt = (EndRow - StartRow + 1) / EntryRowNum;
}

if (Position >= EntryCnt) {
return ERROR;
}

/* AF Off */
Chip_CAN_SetAFMode(pCANAF, CAN_AF_OFF_MODE);

/* Move all remaining sections one place up
if new entry will increase FullCAN list */
for (i = StartRow + Position * EntryRowNum; i < getTotalEntryNum(pCANAF); i++) {
pCANAFRam->MASK[i] = pCANAFRam->MASK[i + EntryRowNum];
}

/* Get Start Row, End Row */
switch (SectionID) {
case CANAF_RAM_SFF_GRP_SEC:
getSectionAddress(pCANAF, CANAF_RAM_SFF_GRP_SEC, &StartAddr, &EndAddr);
setSectionEndAddress(pCANAF, CANAF_RAM_SFF_GRP_SEC, EndAddr - EntryRowNum + 1);

case CANAF_RAM_EFF_SEC:
getSectionAddress(pCANAF, CANAF_RAM_EFF_SEC, &StartAddr, &EndAddr);
setSectionEndAddress(pCANAF, CANAF_RAM_EFF_SEC, EndAddr - EntryRowNum + 1);

case CANAF_RAM_EFF_GRP_SEC:
getSectionAddress(pCANAF, CANAF_RAM_EFF_GRP_SEC, &StartAddr, &EndAddr);
setSectionEndAddress(pCANAF, CANAF_RAM_EFF_GRP_SEC, EndAddr - EntryRowNum + 1);
break;

default:
return ERROR;
}

/* Return to previous mode */
Chip_CAN_SetAFMode(pCANAF, CurMode);
return SUCCESS;
}

/* Clear AF LUT */
void clearAFLUT(LPC_CANAF_T *pCanAF, LPC_CANAF_RAM_T *pCanAFRam) {
uint32_t i = 0;
CAN_AF_MODE_T CurMode = Chip_CAN_GetAFMode(pCanAF);

/* AF Off */
Chip_CAN_SetAFMode(pCanAF, CAN_AF_OFF_MODE);

/* Clear AF Ram region */
for (i = 0; i < CANAF_RAM_ENTRY_NUM; i++) {
pCanAFRam->MASK[i] = 0;
}

/* Reset address registers */
setSectionEndAddress(pCanAF, CANAF_RAM_FULLCAN_SEC, 0);
setSectionEndAddress(pCanAF, CANAF_RAM_SFF_SEC, 0);
setSectionEndAddress(pCanAF, CANAF_RAM_SFF_GRP_SEC, 0);
setSectionEndAddress(pCanAF, CANAF_RAM_EFF_SEC, 0);
setSectionEndAddress(pCanAF, CANAF_RAM_EFF_GRP_SEC, 0);

/* Return to previous mode */
Chip_CAN_SetAFMode(pCanAF, CurMode);
}

/* Returns clock for the peripheral block */
STATIC CHIP_SYSCTL_CLOCK_T Chip_CAN_GetClockIndex(LPC_CAN_T *pCAN)
{
CHIP_SYSCTL_CLOCK_T clkCAN;

if (pCAN == LPC_CAN1) {
clkCAN = SYSCTL_CLOCK_CAN1;
}
else {
clkCAN = SYSCTL_CLOCK_CAN2;
}

return clkCAN;
}

#if defined(CHIP_LPC177X_8X) || defined(CHIP_LPC40XX)
/* Returns reset ID for the peripheral block */
STATIC CHIP_SYSCTL_RESET_T Chip_CAN_GetResetIndex(LPC_CAN_T *pCAN)
{
CHIP_SYSCTL_RESET_T resetCAN;

if (pCAN == LPC_CAN1) {
resetCAN = SYSCTL_RESET_CAN1;
}
else {
resetCAN = SYSCTL_RESET_CAN2;
}

return resetCAN;
}

#endif

#if defined(CHIP_LPC175X_6X)
/* Returns clock ID for the peripheral block */
STATIC CHIP_SYSCTL_PCLK_T Chip_CAN_GetClkIndex(LPC_CAN_T *pCAN)
{
CHIP_SYSCTL_PCLK_T clkCAN;

if (pCAN == LPC_CAN1) {
clkCAN = SYSCTL_PCLK_CAN1;
}
else {
clkCAN = SYSCTL_PCLK_CAN2;
}

return clkCAN;
}

#endif

/*****************************************************************************
* Public functions
****************************************************************************/

/* Initialize CAN Interface */
void Chip_CAN_Init(LPC_CAN_T *pCAN, LPC_CANAF_T *pCANAF, LPC_CANAF_RAM_T *pCANAFRam)
{
volatile uint32_t i;

Chip_Clock_EnablePeriphClock(Chip_CAN_GetClockIndex(pCAN));
#if defined(CHIP_LPC177X_8X) || defined(CHIP_LPC40XX)
Chip_SYSCTL_PeriphReset(Chip_CAN_GetResetIndex(pCAN));
#endif

/* Enter to Reset Mode */
pCAN->MOD = CAN_MOD_RM;

/* Disable all CAN Interrupts */
pCAN->IER &= (~CAN_IER_BITMASK) & CAN_IER_BITMASK;
pCAN->GSR &= (~CAN_GSR_BITMASK) & CAN_GSR_BITMASK;

/* Request command to release Rx, Tx buffer and clear data overrun */
pCAN->CMR = CAN_CMR_RRB | CAN_CMR_AT | CAN_CMR_CDO;

/* Read to clear interrupt pending in interrupt capture register */
i = pCAN->ICR;

/* Return to normal mode */
pCAN->MOD = CAN_MOD_OPERATION;

/* Initiialize Acceptance filter */
clearAFLUT(pCANAF, pCANAFRam);
Chip_CAN_SetAFMode(pCANAF, CAN_AF_NORMAL_MODE);
}

/* De-Initialize CAN Interface */
void Chip_CAN_DeInit(LPC_CAN_T *pCAN)
{
Chip_Clock_DisablePeriphClock(Chip_CAN_GetClockIndex(pCAN));
}

/* Set CAN Bit Rate */
Status Chip_CAN_SetBitRate(LPC_CAN_T *pCAN, uint32_t BitRate)
{
IP_CAN_BUS_TIMING_T BusTiming;
uint32_t result = 0;
uint8_t NT, TSEG1 = 0, TSEG2 = 0;
uint32_t CANPclk = 0;
uint32_t BRP = 0;

#if defined(CHIP_LPC175X_6X)
CANPclk = Chip_Clock_GetPeripheralClockRate(Chip_CAN_GetClkIndex(pCAN));
#else
CANPclk = Chip_Clock_GetPeripheralClockRate();
#endif
result = CANPclk / BitRate;

/* Calculate suitable nominal time value
* NT (nominal time) = (TSEG1 + TSEG2 + 3)
* NT <= 24
* TSEG1 >= 2*TSEG2
*/
for (NT = 24; NT > 0; NT = NT - 2) {
if ((result % NT) == 0) {
BRP = result / NT - 1;

NT--;

TSEG2 = (NT / 3) - 1;

TSEG1 = NT - (NT / 3) - 1;

break;
}
}
if (NT == 0) {
return ERROR;
}

BusTiming.TESG1 = TSEG1;
BusTiming.TESG2 = TSEG2;
BusTiming.BRP = BRP;
BusTiming.SJW = 3;
BusTiming.SAM = 0;
setBusTiming(pCAN, &BusTiming);
return SUCCESS;
}

/* Set CAN Mode */
void Chip_CAN_SetMode(LPC_CAN_T *pCAN, CAN_MODE_T Mode, FunctionalState NewState)
{
if ((Mode & CAN_MOD_LOM) || (Mode & CAN_MOD_STM)) {
/* Enter to Reset Mode */
pCAN->MOD |= CAN_MOD_RM;

/* Change to the given mode */
if (NewState) {
pCAN->MOD |= Mode;
}
else {
pCAN->MOD &= (~Mode) & CAN_MOD_BITMASK;
}

/* Release Reset Mode */
pCAN->MOD &= (~CAN_MOD_RM) & CAN_MOD_BITMASK;
}
else {
if (NewState) {
pCAN->MOD |= Mode;
}
else {
pCAN->MOD &= (~Mode) & CAN_MOD_BITMASK;
}
}

}

/* Get Free TxBuf */
CAN_BUFFER_ID_T Chip_CAN_GetFreeTxBuf(LPC_CAN_T *pCAN)
{
CAN_BUFFER_ID_T TxBufID = CAN_BUFFER_1;

/* Select a free buffer */
for (TxBufID = (CAN_BUFFER_ID_T) 0; TxBufID < CAN_BUFFER_LAST; TxBufID++) {
if (Chip_CAN_GetStatus(pCAN) & CAN_SR_TBS(TxBufID)) {
break;
}
}

return TxBufID;
}

/* Set AF Lookup Table */
Status Chip_CAN_SetAFLUT(LPC_CANAF_T *pCANAF, LPC_CANAF_RAM_T *pCANAFRam, CANAF_LUT_T *pAFSections) {
uint16_t EntryCnt = 0, FullCANEntryCnt = 0;
Status ret = ERROR;
CAN_AF_MODE_T CurMode = Chip_CAN_GetAFMode(pCANAF);

/* AF Off */
Chip_CAN_SetAFMode(pCANAF, CAN_AF_OFF_MODE);

do {
/* Check a number of entries */
if ((((pAFSections->FullCANEntryNum + 1) / 2) +
((pAFSections->SffEntryNum + 1) / 2) +
(pAFSections->SffGrpEntryNum) +
(pAFSections->EffEntryNum) +
(pAFSections->EffGrpEntryNum * 2)) > CANAF_RAM_ENTRY_NUM) {
ret = ERROR;
break;
}

/* Setup FullCAN section */
ret =
setupSTDSection((uint32_t *) &pCANAFRam->MASK[EntryCnt], pAFSections->FullCANSec,
pAFSections->FullCANEntryNum, true);
if (ret == ERROR) {
break;
}
EntryCnt = (pAFSections->FullCANEntryNum + 1) >> 1;
FullCANEntryCnt = EntryCnt;
setSectionEndAddress(pCANAF, CANAF_RAM_FULLCAN_SEC, EntryCnt);

/* Set up Individual Standard ID section */
ret =
setupSTDSection((uint32_t *) &pCANAFRam->MASK[EntryCnt],
pAFSections->SffSec,
pAFSections->SffEntryNum,
false);
if (ret == ERROR) {
break;
}

EntryCnt += (pAFSections->SffEntryNum + 1) >> 1;
setSectionEndAddress(pCANAF, CANAF_RAM_SFF_SEC, EntryCnt);

/* Set up Group Standard ID section */
ret =
setupSTDRangeSection((uint32_t *) &pCANAFRam->MASK[EntryCnt], pAFSections->SffGrpSec,
pAFSections->SffGrpEntryNum);
if (ret == ERROR) {
break;
}

EntryCnt += pAFSections->SffGrpEntryNum;
setSectionEndAddress(pCANAF, CANAF_RAM_SFF_GRP_SEC, EntryCnt);

/* Setup Individual Extended ID section */
ret =
setupEXTSection((uint32_t *) &pCANAFRam->MASK[EntryCnt], pAFSections->EffSec, pAFSections->EffEntryNum);
if (ret == ERROR) {
break;
}

EntryCnt += pAFSections->EffEntryNum;
setSectionEndAddress(pCANAF, CANAF_RAM_EFF_SEC, EntryCnt);

/* Setup Group Extended ID section */
ret =
setupEXTRangeSection((uint32_t *) &pCANAFRam->MASK[EntryCnt], pAFSections->EffGrpSec,
pAFSections->EffGrpEntryNum);
if (ret == ERROR) {
break;
}

EntryCnt += pAFSections->EffGrpEntryNum * 2;
setSectionEndAddress(pCANAF, CANAF_RAM_EFF_GRP_SEC, EntryCnt);

if ((FullCANEntryCnt > 0) && ((0x800 - 6 * FullCANEntryCnt) < EntryCnt)) {
ret = ERROR;
}

} while (0);
/* Return to previous mode */
Chip_CAN_SetAFMode(pCANAF, CurMode);

return ret;
}

/* Get the number of entries of the given section */
uint16_t Chip_CAN_GetEntriesNum(LPC_CANAF_T *pCANAF, LPC_CANAF_RAM_T *pCANAFRam,
CANAF_RAM_SECTION_T SectionID)
{
uint16_t StartRow, EndRow;
uint16_t EntryCnt = 0;

getSectionAddress(pCANAF, SectionID, &StartRow, &EndRow);
if (EndRow <= StartRow) {
return 0;
}
if ((SectionID == CANAF_RAM_FULLCAN_SEC) ||
(SectionID == CANAF_RAM_SFF_SEC)) {
EntryCnt = (EndRow - StartRow + 1) * 2;
if ((((pCANAFRam->MASK[EndRow] >> CAN_STD_ENTRY_ID_POS) & CAN_STD_ENTRY_ID_MASK) ==
0) &&
(((pCANAFRam->MASK[EndRow] >>
CAN_STD_ENTRY_DISABLE_POS) & CAN_STD_ENTRY_DISABLE_MASK) == 1)) { /* Unsed entry */
EntryCnt -= 1;
}
}
else if ((SectionID == CANAF_RAM_SFF_GRP_SEC) ||
(SectionID == CANAF_RAM_EFF_SEC)) {
EntryCnt = EndRow - StartRow + 1;
}
else {
EntryCnt = (EndRow - StartRow + 1) / 2;
}
return EntryCnt;
}

/* Insert an entry into FullCAN Table */
Status Chip_CAN_InsertFullCANEntry(LPC_CANAF_T *pCANAF,
LPC_CANAF_RAM_T *pCANAFRam,
CAN_STD_ID_ENTRY_T *pEntry) {
return insertSTDEntry(pCANAF, pCANAFRam, pEntry, true);
}

/* Insert an entry into Individual STD section */
Status Chip_CAN_InsertSTDEntry(LPC_CANAF_T *pCANAF,
LPC_CANAF_RAM_T *pCANAFRam,
CAN_STD_ID_ENTRY_T *pEntry)
{
return insertSTDEntry(pCANAF, pCANAFRam, pEntry, false);
}

/* Insert an entry into Individual EXT section */
Status Chip_CAN_InsertEXTEntry(LPC_CANAF_T *pCANAF,
LPC_CANAF_RAM_T *pCANAFRam,
CAN_EXT_ID_ENTRY_T *pEntry) {
int32_t IDIndex = 0;
uint16_t StartRow, EndRow;
uint16_t EntryCnt = 0;
uint16_t i = 0;
uint32_t tmp = 0;
CAN_AF_MODE_T CurMode = Chip_CAN_GetAFMode(pCANAF);

if (getTotalEntryNum(pCANAF) >= CANAF_RAM_ENTRY_NUM) {
return ERROR;
}

/* Check if a number of entries in section is odd or even */
getSectionAddress(pCANAF, CANAF_RAM_EFF_SEC, &StartRow, &EndRow);

if (EndRow > StartRow) {
EntryCnt = EndRow - StartRow + 1;
}

/* Search for Index of new entry */
IDIndex = searchInsertIndex((uint32_t *) &pCANAFRam->MASK[StartRow],
EntryCnt,
pEntry->ID_29 & CAN_EXT_ENTRY_ID_MASK,
CAN_EXT_ENTRY_ID_MASK,
sizeof(uint32_t));
if ((IDIndex == -1) || (IDIndex > EntryCnt )) {
return ERROR;
}

/* AF Off */
Chip_CAN_SetAFMode(pCANAF, CAN_AF_OFF_MODE);

/* Move all remaining sections one place down
if new entry will increase FullCAN list */

for (i = getTotalEntryNum(pCANAF); i > (StartRow + IDIndex); i--) {
pCANAFRam->MASK[i] = pCANAFRam->MASK[i - 1];
}

/* Insert new item */
tmp = createExtIDEntry(pEntry);
pCANAFRam->MASK[StartRow + IDIndex] = tmp;

/* Update address table */
getSectionAddress(pCANAF, CANAF_RAM_EFF_SEC, &StartRow, &EndRow);
setSectionEndAddress(pCANAF, CANAF_RAM_EFF_SEC, EndRow + 2);
getSectionAddress(pCANAF, CANAF_RAM_EFF_GRP_SEC, &StartRow, &EndRow);
setSectionEndAddress(pCANAF, CANAF_RAM_EFF_GRP_SEC, EndRow + 2);

/* Return to previous mode */
Chip_CAN_SetAFMode(pCANAF, CurMode);
return SUCCESS;
}

Status Chip_CAN_InsertGroupSTDEntry(LPC_CANAF_T *pCANAF,
LPC_CANAF_RAM_T *pCANAFRam,
CAN_STD_ID_RANGE_ENTRY_T *pEntry)
{
uint16_t InsertIndex = 0;
uint16_t StartRow, EndRow;
uint16_t LowerID = 0, UpperID = 0;
uint16_t i = 0;
CAN_AF_MODE_T CurMode = Chip_CAN_GetAFMode(pCANAF);

if (getTotalEntryNum(pCANAF) >= CANAF_RAM_ENTRY_NUM) {
return ERROR;
}

getSectionAddress(pCANAF, CANAF_RAM_SFF_GRP_SEC, &StartRow, &EndRow);

/* Search for Index of the entry which upper the new item */
for (InsertIndex = StartRow; InsertIndex <= EndRow; InsertIndex++) {
LowerID = (pCANAFRam->MASK[InsertIndex] >> (16 + CAN_STD_ENTRY_ID_POS)) & CAN_STD_ENTRY_ID_MASK;
UpperID = (pCANAFRam->MASK[InsertIndex] >> CAN_STD_ENTRY_ID_POS) & CAN_STD_ENTRY_ID_MASK;
if (LowerID >= pEntry->LowerID.ID_11) {
break;
}
}

/* Compare to the previous row (if any)*/
if (InsertIndex > 0) {
uint16_t PrevUpperID;
PrevUpperID = (pCANAFRam->MASK[InsertIndex - 1] >> CAN_STD_ENTRY_ID_POS) & CAN_STD_ENTRY_ID_MASK;

if (PrevUpperID >= pEntry->UpperID.ID_11) {
return SUCCESS;
}

if (pEntry->UpperID.ID_11 < LowerID) {
if (pEntry->LowerID.ID_11 < PrevUpperID) { /* The new range is merged to the range of the previous row */
uint32_t val = pCANAFRam->MASK[InsertIndex - 1] & 0xFFFF0000;
pCANAFRam->MASK[InsertIndex - 1] = val | createStdIDEntry(&pEntry->UpperID, false);
return SUCCESS;
}
else {
goto insert_grp_entry;
}
}
}

/* Compare to the next row (if any)*/
if ((EndRow) && (InsertIndex <= EndRow)) {
if (pEntry->UpperID.ID_11 >= UpperID) { /* The new range is merged to the range of the next row */
uint32_t val;
val = createStdIDEntry(&pEntry->LowerID, false) << 16;
val |= createStdIDEntry(&pEntry->UpperID, false);
pCANAFRam->MASK[InsertIndex] = val;
return SUCCESS;
}
else if (pEntry->UpperID.ID_11 < UpperID) {
if (pEntry->UpperID.ID_11 > LowerID) { /* The new range is merged to the range of the next row */
uint32_t val = pCANAFRam->MASK[InsertIndex] & 0x0000FFFF;
pCANAFRam->MASK[InsertIndex] = val | (createStdIDEntry(&pEntry->LowerID, false) << 16);
return SUCCESS;
}
}
}

insert_grp_entry:

/* AF Off */
Chip_CAN_SetAFMode(pCANAF, CAN_AF_OFF_MODE);

/* Move all remaining sections one place down
if new entry will increase FullCAN list */

for (i = getTotalEntryNum(pCANAF); i > InsertIndex; i--) {
pCANAFRam->MASK[i] = pCANAFRam->MASK[i - 1];
}

/* Insert new item */
pCANAFRam->MASK[InsertIndex] = createStdIDEntry(&pEntry->LowerID, false) << 16;
pCANAFRam->MASK[InsertIndex] |= createStdIDEntry(&pEntry->UpperID, false);

getSectionAddress(pCANAF, CANAF_RAM_SFF_GRP_SEC, &StartRow, &EndRow);
setSectionEndAddress(pCANAF, CANAF_RAM_SFF_GRP_SEC, EndRow + 2);
getSectionAddress(pCANAF, CANAF_RAM_EFF_SEC, &StartRow, &EndRow);
setSectionEndAddress(pCANAF, CANAF_RAM_EFF_SEC, EndRow + 2);
getSectionAddress(pCANAF, CANAF_RAM_EFF_GRP_SEC, &StartRow, &EndRow);
setSectionEndAddress(pCANAF, CANAF_RAM_EFF_GRP_SEC, EndRow + 2);

/* Return to previous mode */
Chip_CAN_SetAFMode(pCANAF, CurMode);
return SUCCESS;
}

Status Chip_CAN_InsertGroupEXTEntry(LPC_CANAF_T *pCANAF,
LPC_CANAF_RAM_T *pCANAFRam,
CAN_EXT_ID_RANGE_ENTRY_T *pEntry)
{
uint32_t InsertIndex = 0;
uint16_t StartRow, EndRow;
uint32_t LowerID = 0, UpperID = 0;
uint16_t i = 0;
CAN_AF_MODE_T CurMode = Chip_CAN_GetAFMode(pCANAF);

if (getTotalEntryNum(pCANAF) >= CANAF_RAM_ENTRY_NUM) {
return ERROR;
}

/* Check if a number of entries in section is odd or even */
getSectionAddress(pCANAF, CANAF_RAM_EFF_GRP_SEC, &StartRow, &EndRow);

/* Search for Index of new entry */
for (InsertIndex = StartRow; InsertIndex <= EndRow; InsertIndex += 2) {
LowerID = (pCANAFRam->MASK[InsertIndex] >> CAN_EXT_ENTRY_ID_POS) & CAN_EXT_ENTRY_ID_MASK;
UpperID = (pCANAFRam->MASK[InsertIndex + 1] >> CAN_EXT_ENTRY_ID_POS) & CAN_EXT_ENTRY_ID_MASK;
if (LowerID >= pEntry->LowerID.ID_29) {
break;
}
}

/* Compare to the previous row (if any)*/
if (InsertIndex > 0) {
uint32_t PrevUpperID;
PrevUpperID = (pCANAFRam->MASK[(InsertIndex - 2) + 1] >> CAN_EXT_ENTRY_ID_POS) & CAN_EXT_ENTRY_ID_MASK;

if (PrevUpperID >= pEntry->UpperID.ID_29) {
return SUCCESS;
}

if (pEntry->UpperID.ID_29 < LowerID) {
if (pEntry->LowerID.ID_29 < PrevUpperID) {
pCANAFRam->MASK[(InsertIndex - 2) + 1] = createExtIDEntry(&pEntry->UpperID);
return SUCCESS;
}
else {
goto insert_grp_entry;
}
}
}

if ((EndRow) && (InsertIndex < EndRow)) {
if (pEntry->UpperID.ID_29 >= UpperID) {
pCANAFRam->MASK[InsertIndex] = createExtIDEntry(&pEntry->LowerID);
pCANAFRam->MASK[InsertIndex + 1] = createExtIDEntry(&pEntry->UpperID);
return SUCCESS;
}
else if (pEntry->UpperID.ID_29 < UpperID) {
if (pEntry->UpperID.ID_29 > LowerID) {
pCANAFRam->MASK[InsertIndex] = createExtIDEntry(&pEntry->LowerID);
return SUCCESS;
}
}
}

insert_grp_entry:

/* AF Off */
Chip_CAN_SetAFMode(pCANAF, CAN_AF_OFF_MODE);

/* Move all remaining sections two places down
if new entry will increase FullCAN list */

for (i = getTotalEntryNum(pCANAF) + 1; i > InsertIndex; i--) {
pCANAFRam->MASK[i] = pCANAFRam->MASK[i - 2];
}

/* Insert new item */
pCANAFRam->MASK[InsertIndex] = createExtIDEntry(&pEntry->LowerID);
pCANAFRam->MASK[InsertIndex + 1] = createExtIDEntry(&pEntry->UpperID);

getSectionAddress(pCANAF, CANAF_RAM_EFF_GRP_SEC, &StartRow, &EndRow);
setSectionEndAddress(pCANAF, CANAF_RAM_EFF_GRP_SEC, EndRow + 3);

/* Return to previous mode */
Chip_CAN_SetAFMode(pCANAF, CurMode);
return SUCCESS;
}

/* Remove an entry into FullCAN Table */
Status Chip_CAN_RemoveFullCANEntry(LPC_CANAF_T *pCANAF,
LPC_CANAF_RAM_T *pCANAFRam,
int16_t Position) {
return removeLUTEntry(pCANAF, pCANAFRam, CANAF_RAM_FULLCAN_SEC, Position);
}

/* Remove an entry into Individual STD section */
Status Chip_CAN_RemoveSTDEntry(LPC_CANAF_T *pCANAF,
LPC_CANAF_RAM_T *pCANAFRam,
int16_t Position)
{
return removeLUTEntry(pCANAF, pCANAFRam, CANAF_RAM_SFF_SEC, Position);
}

/* Remove an entry into Group STD section */
Status Chip_CAN_RemoveGroupSTDEntry(LPC_CANAF_T *pCANAF,
LPC_CANAF_RAM_T *pCANAFRam,
int16_t Position)
{
return removeLUTEntry(pCANAF, pCANAFRam, CANAF_RAM_SFF_GRP_SEC, Position);
}

/* Remove an entry into Individual EXT section */
Status Chip_CAN_RemoveEXTEntry(LPC_CANAF_T *pCANAF,
LPC_CANAF_RAM_T *pCANAFRam,
int16_t Position) {
return removeLUTEntry(pCANAF, pCANAFRam, CANAF_RAM_EFF_SEC, Position);
}

/* Remove an entry into Group EXT section */
Status Chip_CAN_RemoveGroupEXTEntry(LPC_CANAF_T *pCANAF,
LPC_CANAF_RAM_T *pCANAFRam,
int16_t Position)
{
return removeLUTEntry(pCANAF, pCANAFRam, CANAF_RAM_EFF_GRP_SEC, Position);
}

Status Chip_CAN_ReadFullCANEntry(LPC_CANAF_T *pCANAF,
LPC_CANAF_RAM_T *pCANAFRam,
uint16_t Position,
CAN_STD_ID_ENTRY_T *pEntry)
{
return readSTDEntry(pCANAF, pCANAFRam, Position, true, pEntry);
}

Status Chip_CAN_ReadSTDEntry(LPC_CANAF_T *pCANAF,
LPC_CANAF_RAM_T *pCANAFRam,
uint16_t Position,
CAN_STD_ID_ENTRY_T *pEntry)
{
return readSTDEntry(pCANAF, pCANAFRam, Position, false, pEntry);
}

Status Chip_CAN_ReadGroupSTDEntry(LPC_CANAF_T *pCANAF,
LPC_CANAF_RAM_T *pCANAFRam,
uint16_t Position,
CAN_STD_ID_RANGE_ENTRY_T *pEntry)
{
uint16_t StartRow, EndRow;
uint16_t EntryCnt = 0;

getSectionAddress(pCANAF, CANAF_RAM_SFF_GRP_SEC, &StartRow, &EndRow);

if (EndRow > StartRow) {
EntryCnt = EndRow - StartRow + 1;
}
if (Position >= EntryCnt) {
return ERROR;
}

readStdIDEntry(pCANAFRam->MASK[StartRow + Position] >> 16, &pEntry->LowerID);
readStdIDEntry(pCANAFRam->MASK[StartRow + Position] & 0xFFFF, &pEntry->UpperID);
return SUCCESS;
}

Status Chip_CAN_ReadEXTEntry(LPC_CANAF_T *pCANAF,
LPC_CANAF_RAM_T *pCANAFRam,
uint16_t Position,
CAN_EXT_ID_ENTRY_T *pEntry)
{
uint16_t StartRow, EndRow;
uint16_t EntryCnt = 0;

getSectionAddress(pCANAF, CANAF_RAM_EFF_SEC, &StartRow, &EndRow);

if (EndRow > StartRow) {
EntryCnt = EndRow - StartRow + 1;
}
if (Position >= EntryCnt) {
return ERROR;
}

readExtIDEntry(pCANAFRam->MASK[StartRow + Position], pEntry);
return SUCCESS;
}

Status Chip_CAN_ReadGroupEXTEntry(LPC_CANAF_T *pCANAF,
LPC_CANAF_RAM_T *pCANAFRam,
uint16_t Position,
CAN_EXT_ID_RANGE_ENTRY_T *pEntry)

{
uint16_t StartRow, EndRow;
uint16_t EntryCnt = 0;

getSectionAddress(pCANAF, CANAF_RAM_EFF_GRP_SEC, &StartRow, &EndRow);

if (EndRow > StartRow) {
EntryCnt = (EndRow - StartRow + 1) / 2;
}
if (Position >= EntryCnt) {
return ERROR;
}

readExtIDEntry(pCANAFRam->MASK[StartRow + Position * 2], &pEntry->LowerID);
readExtIDEntry(pCANAFRam->MASK[StartRow + Position * 2 + 1], &pEntry->UpperID);
return SUCCESS;
}

/* Send CAN Message */
Status Chip_CAN_Send(LPC_CAN_T *pCAN, CAN_BUFFER_ID_T TxBufID, CAN_MSG_T *pMsg)
{
uint8_t i = 0;
LPC_CAN_TX_T TxFrame;

/* Write Frame Information */
TxFrame.TFI = 0;
if (pMsg->Type & CAN_REMOTE_MSG) {
TxFrame.TFI |= CAN_TFI_RTR;
}
else {
TxFrame.TFI |= CAN_TFI_DLC(pMsg->DLC);
for (i = 0; i < (CAN_MSG_MAX_DATA_LEN + 3) / 4; i++) {
TxFrame.TD[i] =
pMsg->Data[4 *
i] |
(pMsg->Data[4 * i +
1] << 8) | (pMsg->Data[4 * i + 2] << 16) | (pMsg->Data[4 * i + 3] << 24);
}
}

if (pMsg->ID & CAN_EXTEND_ID_USAGE) {
TxFrame.TFI |= CAN_TFI_FF;
TxFrame.TID = CAN_TID_ID29(pMsg->ID);
}
else {
TxFrame.TID = CAN_TID_ID11(pMsg->ID);
}

/* Set message information */
setSendFrameInfo(pCAN, TxBufID, &TxFrame);

/* Select buffer and Write Transmission Request */
if (Chip_CAN_GetMode(pCAN) == CAN_SELFTEST_MODE) {
Chip_CAN_SetCmd(pCAN, CAN_CMR_STB(TxBufID) | CAN_CMR_SRR);
}
else {
Chip_CAN_SetCmd(pCAN, CAN_CMR_STB(TxBufID) | CAN_CMR_TR);
}

return SUCCESS;
}

/* Receive CAN Message */
Status Chip_CAN_Receive(LPC_CAN_T *pCAN, CAN_MSG_T *pMsg) {
int8_t i;
IP_CAN_001_RX_T RxFrame;
if (getReceiveFrameInfo(pCAN, &RxFrame) == SUCCESS) {

/* Read Message Identifier */
if (RxFrame.RFS & CAN_RFS_FF) {
pMsg->ID = CAN_EXTEND_ID_USAGE | CAN_RID_ID_29(RxFrame.RID);
}
else {
pMsg->ID = CAN_RID_ID_11(RxFrame.RID);
}

/* Read Data Length */
pMsg->DLC = CAN_RFS_DLC(RxFrame.RFS);

/* Read Message Type */
pMsg->Type = 0;
if (RxFrame.RFS & CAN_RFS_RTR) {
pMsg->Type |= CAN_REMOTE_MSG;
}
else {
/* Read data only if the received message is not Remote message */
for (i = 0; i < CAN_MSG_MAX_DATA_LEN; i++) {
pMsg->Data[i] = (RxFrame.RD[i / 4] >> (8 * (i % 4))) & 0xFF;
}
}

/* Release received message */
Chip_CAN_SetCmd(pCAN, CAN_CMR_RRB);

return SUCCESS;
}
return ERROR;
}

/* Enable/Disable FullCAN interrupt */
void Chip_CAN_ConfigFullCANInt(LPC_CANAF_T *pCANAF, FunctionalState NewState)
{
CAN_AF_MODE_T CurMode = Chip_CAN_GetAFMode(pCANAF);

/* AF Off */
Chip_CAN_SetAFMode(pCANAF, CAN_AF_OFF_MODE);

if (NewState == ENABLE) {
pCANAF->FCANIE |= CANAF_FCANIE;
}
else {
pCANAF->FCANIE &= (~CANAF_FCANIE) & CANAF_FCANIE_BITMASK;
}

/* Return to previous mode */
Chip_CAN_SetAFMode(pCANAF, CurMode);
}

/* Get interrupt status of the given object */
uint32_t Chip_CAN_GetFullCANIntStatus(LPC_CANAF_T *pCANAF, uint8_t ObjID)
{
if (ObjID < 64) {
return (pCANAF->FCANIC[ObjID / 32] & (1 << (ObjID % 32))) ? SET : RESET;
}
return RESET;
}

/* Read FullCAN message received */
Status Chip_CAN_FullCANReceive(LPC_CANAF_T *pCANAF, LPC_CANAF_RAM_T *pCANAFRam
, uint8_t ObjID, CAN_MSG_T *pMsg, uint8_t *pSCC) {
uint32_t *pSrc;
uint16_t FullCANEntryCnt;
pSrc = (uint32_t *) pCANAFRam;

FullCANEntryCnt = getTotalEntryNum(pCANAF);
pSrc += FullCANEntryCnt + ObjID * 3;
/* If the AF hasn't finished updating msg info */
if (((pSrc[0] >> CANAF_FULLCAN_MSG_SEM_POS) & CANAF_FULLCAN_MSG_SEM_BITMASK) !=
CANAF_FULCAN_MSG_AF_FINISHED) {
return ERROR;
}

/* Mark that CPU is handling message */
pSrc[0] = CANAF_FULCAN_MSG_CPU_READING << CANAF_FULLCAN_MSG_SEM_POS;

/* Read Message */
*pSCC = (pSrc[0] >> CANAF_FULLCAN_MSG_SCC_POS) & CANAF_FULLCAN_MSG_SCC_BITMASK;
pMsg->ID = (pSrc[0] >> CANAF_FULLCAN_MSG_ID11_POS) & CANAF_FULLCAN_MSG_ID11_BITMASK;
pMsg->Type = 0;
if (pSrc[0] & (1 << CANAF_FULLCAN_MSG_RTR_POS)) {
pMsg->Type = CAN_REMOTE_MSG;
}
pMsg->DLC = (pSrc[0] >> CANAF_FULLCAN_MSG_DLC_POS) & CANAF_FULLCAN_MSG_DLC_BITMASK;
((uint32_t *) pMsg->Data)[0] = pSrc[1];
((uint32_t *) pMsg->Data)[1] = pSrc[2];

/* Recheck message status to make sure data is not be updated while CPU is reading */
if (((pSrc[0] >> CANAF_FULLCAN_MSG_SEM_POS) & CANAF_FULLCAN_MSG_SEM_BITMASK) !=
CANAF_FULCAN_MSG_CPU_READING) {
return ERROR;
}

return SUCCESS;
}

// TODO: insert code here

// Force the counter to be placed into memory
volatile static int i = 0 ;
// Enter an infinite loop, just incrementing a counter
while(1) {
i++ ;
}
return 0 ;
}

0 Kudos
2 Replies

463 Views
Carlos_Mendoza
NXP Employee
NXP Employee

Hi Sharuque,

Could you tell us more information about what you are trying to achieve? Which MCU are you using? Are you using the periph_can LPCOpen example as base for your application? Which error are you getting?

Thanks in advance!

Best Regards,
Carlos Mendoza
Technical Support Engineer

0 Kudos

463 Views
sharuqueshaji
Contributor I

THANK YOU FOR YOUR SUPPORT.

I am using lpc1769 and the program code is from the lpcopen given during program setup. Whe I replace the following code

#if defined (__USE_LPCOPEN)
#if defined(NO_BOARD_LIB)
#include "chip.h"
#else
#include "board.h"
#endif
#endif

#include <cr_section_macros.h>
#include <can_17xx_40xx.h>
#include<uart_17xx_40xx.h>
// TODO: insert other include files here

// TODO: insert other definitions and declarations here

int main(void) {

#if defined (__USE_LPCOPEN)
// Read clock settings and update SystemCoreClock variable
SystemCoreClockUpdate();
#if !defined(NO_BOARD_LIB)
// Set up and initialize all required blocks and
// functions related to the board hardware
Board_Init();


// Set the LED to the state of "On"
Board_LED_Set(0, true);
#endif
#endif

in the above program with #include "chip.h" only following error occurs.

../src/test3.c:717:24: warning: variable 'i' set but not used [-Wunused-but-set-variable]
volatile uint32_t i;
^
../src/test3.c: At top level:
../src/test3.c:1481:1: error: expected identifier or '(' before '}' token
}
^
make: *** [src/test3.o] Error 1

0 Kudos