Ability to send content of emergency data.
/*
This file is part of CanFestival, a library implementing CanOpen Stack.
Copyright (C): Edouard TISSERANT and Francis DUPIN
AVR Port: Andreas GLAUSER and Peter CHRISTEN
See COPYING file for copyrights details.
This library is free software; you can redistribute it and/or
modify it under the terms of the GNU Lesser General Public
License as published by the Free Software Foundation; either
version 2.1 of the License, or (at your option) any later version.
This library is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
Lesser General Public License for more details.
You should have received a copy of the GNU Lesser General Public
License along with this library; if not, write to the Free Software
Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
*/
//#define DEBUG_WAR_CONSOLE_ON
//#define DEBUG_ERR_CONSOLE_ON
#include "can_AVR.h"
#include "canfestival.h"
volatile unsigned char msg_received = 0;
unsigned char canInit(unsigned int bitrate)
/******************************************************************************
Initialize the hardware to receive CAN messages and start the timer for the
CANopen stack.
INPUT bitrate bitrate in kilobit
OUTPUT 1 if successful
******************************************************************************/
{
unsigned char i,k;
//- Pull-up on TxCAN & RxCAN one by one to use bit-addressing
CAN_PORT_DIR &= ~(1<<CAN_INPUT_PIN );
CAN_PORT_DIR &= ~(1<<CAN_OUTPUT_PIN);
CAN_PORT_OUT |= (1<<CAN_INPUT_PIN );
CAN_PORT_OUT |= (1<<CAN_OUTPUT_PIN);
Can_reset(); // Reset the CAN controller
if (bitrate <= 500)
{
// CANopen 10..500 kbit with 16 tq, sample point is at 14 tq
// all values are added to 1 by hardware
// Resynchronisation jump width (SJW) = 1 tq
// Propagation Time Segment (PRS) = 5 tq
// Phase Segment 1 (PHS1) = 8 tq
// Phase Segment 2 (PHS2) = 2 tq
// Total = 16 tq
CANBT1 = ((F_CPU/16/1000/bitrate-1) << BRP); // set bitrate
CANBT2 = ((1-1) << SJW) |((5-1) << PRS); // set SJW, PRS
CANBT3 = (((2-1) << PHS2) | ((8-1) << PHS1) | (1<<SMP)); // set PHS1, PHS2, 3 sample points
}
else
return 0;
// Reset all mailsboxes (MObs), filters are zero (accept all) by clear all MOb
// Set the lower MObs as rx buffer
for (i = 0; i < NB_MOB; i++)
{
Can_set_mob(i); // Change to MOb with the received message
Can_clear_mob(); // All MOb Registers=0
for (k = 0; k < NB_DATA_MAX; k++)
CANMSG = 0; // MOb data FIFO
if (i < NB_RX_MOB) // Is receive MOb
Can_config_rx_buffer(); // configure as receive buffer
}
// The tx MOb is still disabled, it will be set to tx mode when the first message will be sent
// Enable the general CAN interrupts
CANGIE = (1 << ENIT) | (1 << ENRX) | (1 << ENTX) | (0 << ENERR) | (0 << ENERG) | (0 << ENOVRT);
CANIE1 = 0x7F; // Enable the interrupts of all MObs (0..14)
CANIE2 = 0xFF;
Can_enable(); // Enable the CAN bus controller
return 1;
}
unsigned char canSend(CAN_PORT notused, Message *m)
/******************************************************************************
The driver send a CAN message passed from the CANopen stack
INPUT CAN_PORT is not used (only 1 avaiable)
Message *m pointer to message to send
OUTPUT 1 if hardware -> CAN frame
******************************************************************************/
{
unsigned char i;
for (i = START_TX_MOB; i < NB_MOB; i++) // Search the first free MOb
{
Can_set_mob(i); // Change to MOb
if ((CANCDMOB & CONMOB_MSK) == 0) // MOb disabled = free
{
break;
}
}
if (i < NB_MOB) // free MOb found
{
Can_set_mob(i); // Switch to the sending messagebox
Can_set_std_id(m->cob_id); // Set cob id
if (m->rtr) // Set remote transmission request
Can_set_rtr();
Can_set_dlc(m->len); // Set data lenght code
for (i= 0; i < (m->len); i++) // Add data bytes to the MOb
CANMSG = m->data[i];
// Start sending by writing the MB configuration register to transmit
Can_config_tx(); // Set the last MOb to transmit mode
return 1; // succesful
}
else
return 0; // not succesful
}
unsigned char canReceive(Message *m)
/******************************************************************************
The driver pass a received CAN message to the stack
INPUT Message *m pointer to received CAN message
OUTPUT 1 if a message received
******************************************************************************/
{
unsigned char i;
if (msg_received == 0)
return 0; // Nothing received
for (i = 0; i < NB_RX_MOB; i++) // Search the first MOb received
{
Can_set_mob(i); // Change to MOb
if ((CANCDMOB & CONMOB_MSK) == 0) // MOb disabled = received
{
msg_received--;
break;
}
}
if (i < NB_RX_MOB) // message found
{
Can_get_std_id(m->cob_id); // Get cob id
m->rtr = Can_get_rtr(); // Get remote transmission request
m->len = Can_get_dlc(); // Get data lenght code
for (i= 0; i < (m->len); i++) // get data bytes from the MOb
m->data[i] = CANMSG;
Can_config_rx_buffer(); // reset the MOb for receive
return 1; // message received
}
else // no message found
{
msg_received = 0; // reset counter
return 0; // no message received
}
}
/***************************************************************************/
unsigned char canChangeBaudRate_driver( CAN_HANDLE fd, char* baud)
{
return 0;
}
#ifdef __IAR_SYSTEMS_ICC__
#pragma type_attribute = __interrupt
#pragma vector=CANIT_vect
void CANIT_interrupt(void)
#else // GCC
ISR(CANIT_vect)
#endif // GCC
/******************************************************************************
CAN Interrupt
******************************************************************************/
{
unsigned char saved_page = CANPAGE;
unsigned char i;
if (CANGIT & (1 << CANIT)) // is a messagebox interrupt
{
if ((CANSIT1 & TX_INT_MSK) == 0) // is a Rx interrupt
{
for (i = 0; (i < NB_RX_MOB) && (CANGIT & (1 << CANIT)); i++) // Search the first MOb received
{
Can_set_mob(i); // Change to MOb
if (CANSTMOB & MOB_RX_COMPLETED) // receive ok
{
Can_clear_status_mob(); // Clear status register
Can_mob_abort(); // disable the MOb = received
msg_received++;
}
else if (CANSTMOB & ~MOB_RX_COMPLETED) // error
{
Can_clear_status_mob(); // Clear status register
Can_config_rx_buffer(); // reconfigure as receive buffer
}
}
}
else // is a Tx interrupt
{
for (i = NB_RX_MOB; i < NB_MOB; i++) // Search the first MOb transmitted
{
Can_set_mob(i); // change to MOb
if (CANSTMOB) // transmission ok or error
{
Can_clear_status_mob(); // clear status register
CANCDMOB = 0; // disable the MOb
break;
}
}
}
}
CANPAGE = saved_page;
// Bus Off Interrupt Flag
if (CANGIT & (1 << BOFFIT)) // Finaly clear the interrupt status register
{
CANGIT |= (1 << BOFFIT); // Clear the interrupt flag
}
else
CANGIT |= (1 << BXOK) | (1 << SERG) | (1 << CERG) | (1 << FERG) | (1 << AERG);// Finaly clear other interrupts
}
#ifdef __IAR_SYSTEMS_ICC__
#pragma type_attribute = __interrupt
#pragma vector=OVRIT_vect
void OVRIT_interrupt(void)
#else // GCC
ISR(OVRIT_vect)
#endif // GCC
/******************************************************************************
CAN Timer Interrupt
******************************************************************************/
{
CANGIT |= (1 << OVRTIM);
}