examples/TestMasterSlave/TestMasterSlave.h
author lbessard
Wed, 13 Dec 2006 18:48:01 +0100
changeset 59 3a553c789116
parent 31 a82b70738e5c
child 145 e747d2e26af0
permissions -rw-r--r--
Some bugs reported by Francis Dupin corrected.
0
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
     1
/*
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
     2
This file is part of CanFestival, a library implementing CanOpen Stack. 
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
     3
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
     4
Copyright (C): Edouard TISSERANT and Francis DUPIN
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
     5
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
     6
See COPYING file for copyrights details.
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
     7
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
     8
This library is free software; you can redistribute it and/or
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
     9
modify it under the terms of the GNU Lesser General Public
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    10
License as published by the Free Software Foundation; either
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    11
version 2.1 of the License, or (at your option) any later version.
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    12
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    13
This library is distributed in the hope that it will be useful,
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    14
but WITHOUT ANY WARRANTY; without even the implied warranty of
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    15
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    16
Lesser General Public License for more details.
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    17
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    18
You should have received a copy of the GNU Lesser General Public
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    19
License along with this library; if not, write to the Free Software
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    20
Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    21
*/
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    22
#ifdef USE_XENO
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    23
#define eprintf(...)
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    24
#else
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    25
#define eprintf(...) printf (__VA_ARGS__)
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    26
#endif
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    27
void print_message(Message *m);
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    28
31
a82b70738e5c Code clean-up and fixed xenomai compile problem
lbessard
parents: 0
diff changeset
    29
UNS8 canSend(CAN_HANDLE fd0, Message *m);
a82b70738e5c Code clean-up and fixed xenomai compile problem
lbessard
parents: 0
diff changeset
    30
0
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    31
extern CAN_HANDLE SlaveCanHandle;
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    32
extern CAN_HANDLE MasterCanHandle;
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    33
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    34
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    35
/*
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    36
#define CAN_FIFO_LENGTH 100
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    37
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    38
#define DECLARE_A_CAN_FIFO \
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    39
static Message FIFO[CAN_FIFO_LENGTH];\
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    40
static int FIFO_First = 0;\
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    41
static int FIFO_Last = 0;\
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    42
\
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    43
static void PutInFIFO(Message *m)\
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    44
{\
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    45
	FIFO[FIFO_Last++] = *m;\
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    46
	FIFO_Last %= CAN_FIFO_LENGTH;\
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    47
}\
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    48
\
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    49
static void GetFromFIFO(Message *m)\
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    50
{\
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    51
	*m = FIFO[FIFO_First++];\
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    52
	FIFO_First %= CAN_FIFO_LENGTH;\
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    53
}\
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    54
\
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    55
static void TransmitMessage(CO_Data* d, UNS32 id)\
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    56
{\
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    57
	Message m;\
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    58
	GetFromFIFO(&m);\
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    59
	canDispatch(d, &m);\
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    60
}
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    61
*/