Better EMCY support. Now EMCY COB-ID depend on OD 1014h entry, as told in DS-301.
/*
This file is part of CanFestival, a library implementing CanOpen Stack.
Copyright (C): Edouard TISSERANT and Francis DUPIN
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
*/
#ifdef USE_XENO
//#define eprintf(...) if(0){}
#define eprintf(...)
#else
#define eprintf(...) printf (__VA_ARGS__)
#endif
/*UNS8 canSend(CAN_HANDLE fd0, Message *m);*/
#include "canfestival.h"
/*
#define CAN_FIFO_LENGTH 100
#define DECLARE_A_CAN_FIFO \
static Message FIFO[CAN_FIFO_LENGTH];\
static int FIFO_First = 0;\
static int FIFO_Last = 0;\
\
static void PutInFIFO(Message *m)\
{\
FIFO[FIFO_Last++] = *m;\
FIFO_Last %= CAN_FIFO_LENGTH;\
}\
\
static void GetFromFIFO(Message *m)\
{\
*m = FIFO[FIFO_First++];\
FIFO_First %= CAN_FIFO_LENGTH;\
}\
\
static void TransmitMessage(CO_Data* d, UNS32 id)\
{\
Message m;\
GetFromFIFO(&m);\
canDispatch(d, &m);\
}
*/