1

     2

#include "canfestival.h"

     3

     4

%(nodes_includes)s

     5

     6

#define BOARD_DECL(nodename, busname, baudrate)\

     7

    s_BOARD nodename##Board = {busname, baudrate};

     8

     9

%(board_decls)s

    10

    11

static int init_level=0;

    12

extern int common_ticktime__;

    13

    14

static void Master_post_SlaveBootup(CO_Data* d, UNS8 nodeId)

    15

{

    16

    /* Put the master in operational mode */

    17

    setState(d, Operational);

    18

    19

    /* Ask slave node to go in operational mode */

    20

    masterSendNMTstateChange (d, 0, NMT_Start_Node);

    21

}

    22

    25

#define NODE_INIT(nodename, nodeid) \

    26

    /* Artificially force sync state to 1 so that it is not started */\

    27

    nodename##_Data.CurrentCommunicationState.csSYNC = -1;\

    28

    /* Force sync period to common_ticktime__ so that other node can read it*/\

    29

    *nodename##_Data.COB_ID_Sync = 0x40000080;\

    30

    *nodename##_Data.Sync_Cycle_Period = common_ticktime__ * 1000;\

    31

    /* Defining the node Id */\

    32

    setNodeId(&nodename##_Data, nodeid);\

    33

    /* init */\

    34

    setState(&nodename##_Data, Initialisation);

    35

    36

void InitNodes(CO_Data* d, UNS32 id)

    37

{

    38

    %(nodes_init)s

    39

}

    40

    41

void Exit(CO_Data* d, UNS32 id)

    42

{

    43

}

    44

    45

#define NODE_CLOSE(nodename) \

    46

    if(init_level-- > 0)\

    47

    {\

    48

        EnterMutex();\

    49

        masterSendNMTstateChange(&nodename##_Data, 0, NMT_Reset_Node);\

    50

        setState(&nodename##_Data, Stopped);\

    51

        LeaveMutex();\

    52

        canClose(&nodename##_Data);\

    53

    }

    54

    55

void __cleanup_%(locstr)s()

    56

{

    57

    %(nodes_close)s

    58

    59

    // Stop timer thread

    60

    if(init_level-- > 0)

    61

        StopTimerLoop(&Exit);

    62

    63

    #if !defined(WIN32) || defined(__CYGWIN__)

    64

   		TimerCleanup();

    65

    #endif

    66

}

    67

    68

#define NODE_OPEN(nodename)\

    69

    if(!canOpen(&nodename##Board,&nodename##_Data)){\

    70

        printf("Cannot open " #nodename " Board (%%s,%%s)\n",nodename##Board.busname, nodename##Board.baudrate);\

    71

        return -1;\

    72

    }\

    73

    init_level++;

    74

    75

/***************************  INIT  *****************************************/

    76

int __init_%(locstr)s(int argc,char **argv)

    77

{

    78

#ifndef NOT_USE_DYNAMIC_LOADING

    79

    if( !LoadCanDriver("%(candriver)s") ){

    80

        fprintf(stderr, "Cannot load CAN interface library for CanFestival (%(candriver)s)\n");\

    81

        return -1;

    82

    }

    83

#endif      

    84

	#if !defined(WIN32) || defined(__CYGWIN__)

    85

		TimerInit();

    86

	#endif

    87

    88

    %(nodes_open)s

    89

    90

    // Start timer thread

    91

    StartTimerLoop(&InitNodes);

    92

    init_level++;

    93

    return 0;

    94

}

    95

    96

#define NODE_SEND_SYNC(nodename)\

    97

    sendSYNCMessage(&nodename##_Data);

    98

    99

void __retrieve_%(locstr)s()

   100

{

   101

    /* Locks the stack, so that no changes occurs while PLC access variables

   102

     * TODO : implement buffers to avoid such a big lock  

   103

     *  */

   104

    EnterMutex();

   105

    /*Send Sync */

   106

    %(nodes_send_sync)s

   107

}

   108

   109

#define NODE_PROCEED_SYNC(nodename)\

   110

    proceedSYNC(&nodename##_Data);

   111

   112

void __publish_%(locstr)s()

   113

{

   114

    /*Call SendPDOEvent */

   115

    %(nodes_proceed_sync)s

   116

    LeaveMutex();

   117

}

   118