1

/*

     2

 * Etherlab execution code

     3

 *

     4

 * */

     5

     6

#include <rtdm/rtdm.h>

     7

#include <native/task.h>

     8

#include <native/timer.h>

     9

    10

#include "ecrt.h"

    11

#include "ec_rtdm.h"

    12

    13

#ifdef _WINDOWS_H

    14

  #include "iec_types.h"

    15

#else

    16

  #include "iec_std_lib.h"

    17

#endif

    18

    19

// declaration of interface variables

    20

%(located_variables_declaration)s

    21

    22

// Optional features

    23

#define CONFIGURE_PDOS  %(configure_pdos)d

    24

    25

// process data

    26

uint8_t *domain1_pd = NULL;

    27

%(used_pdo_entry_offset_variables_declaration)s

    28

    29

const static ec_pdo_entry_reg_t domain1_regs[] = {

    30

%(used_pdo_entry_configuration)s

    31

    {}

    32

};

    33

/*****************************************************************************/

    34

    35

#if CONFIGURE_PDOS

    36

%(pdos_configuration_declaration)s

    37

#endif

    38

    39

int rt_fd = -1;

    40

CstructMstrAttach MstrAttach;

    41

char rt_dev_file[64];

    42

long long wait_period_ns = 100000LL;

    43

    44

// EtherCAT

    45

static ec_master_t *master = NULL;

    46

static ec_domain_t *domain1 = NULL;

    47

%(slaves_declaration)s

    48

    49

/* Beremiz plugin functions */

    50

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

    51

{

    52

    uint32_t abort_code;

    53

    int rtstatus;

    54

    55

	MstrAttach.masterindex = %(master_number)d;

    56

    57

	master = ecrt_request_master(MstrAttach.masterindex);

    58

	if (!master) return -1;

    59

    60

	domain1 = ecrt_master_create_domain(master);

    61

	if (!domain1) return -1;

    62

    63

#if CONFIGURE_PDOS

    64

    fprintf(stdout, "Configure PDOs...\n");

    65

	%(slaves_configuration)s

    66

#endif

    67

    68

    if (ecrt_domain_reg_pdo_entry_list(domain1, domain1_regs)) {

    69

        fprintf(stderr, "PDO entry registration failed!\n");

    70

        return -1;

    71

    }

    72

    73

%(slaves_initialization)s

    74

    75

    sprintf(&rt_dev_file[0],"%%s%%u",EC_RTDM_DEV_FILE_NAME,0);

    76

    rt_fd = rt_dev_open( &rt_dev_file[0], 0);

    77

    if (rt_fd < 0) {

    78

        fprintf(stderr, "Can't open %%s\n", &rt_dev_file[0]);

    79

        return -1;

    80

    }

    81

    82

    // attach the master over rtdm driver

    83

    MstrAttach.domainindex = ecrt_domain_index(domain1);

    84

    rtstatus = ecrt_rtdm_master_attach(rt_fd, &MstrAttach);

    85

    if (rtstatus < 0) {

    86

        fprintf(stderr, "Cannot attach to master over rtdm\n");

    87

        return -1;

    88

    }

    89

    90

    if (ecrt_master_activate(master))

    91

        return -1;

    92

    93

    if (!(domain1_pd = ecrt_domain_data(domain1))) {

    94

        fprintf(stderr, "domain1_pd:  0x%%.6lx\n", (unsigned long)domain1_pd);

    95

        return -1;

    96

    }

    97

    98

    fprintf(stdout, "Master %(master_number)d activated...\n");

    99

   100

    return 0;

   101

}

   102

   103

void __cleanup_%(location)s(void)

   104

{

   105

	if (rt_fd >= 0) {

   106

		rt_dev_close(rt_fd);

   107

	}

   108

	//release master

   109

	ecrt_release_master(master);

   110

}

   111

   112

void __retrieve_%(location)s(void)

   113

{

   114

    // receive ethercat

   115

    ecrt_rtdm_master_recieve(rt_fd);

   116

    ecrt_rtdm_domain_process(rt_fd);

   117

   118

    rt_task_sleep(rt_timer_ns2tsc(wait_period_ns));

   119

   120

    // send process data

   121

    ecrt_rtdm_domain_queque(rt_fd);

   122

    ecrt_rtdm_master_send(rt_fd);

   123

   124

%(retrieve_variables)s

   125

}

   126

   127

void __publish_%(location)s(void)

   128

{

   129

%(publish_variables)s

   130

}