1

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

     2

 *

     3

 *  $Id$

     4

 *

     5

 *  Copyright (C) 2006  Florian Pose, Ingenieurgemeinschaft IgH

     6

 *

     7

 *  This file is part of the IgH EtherCAT Master.

     8

 *

     9

 *  The IgH EtherCAT Master is free software; you can redistribute it

    10

 *  and/or modify it under the terms of the GNU General Public License

    11

 *  as published by the Free Software Foundation; either version 2 of the

    12

 *  License, or (at your option) any later version.

    13

 *

    14

 *  The IgH EtherCAT Master is distributed in the hope that it will be

    15

 *  useful, but WITHOUT ANY WARRANTY; without even the implied warranty of

    16

 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

    17

 *  GNU General Public License for more details.

    18

 *

    19

 *  You should have received a copy of the GNU General Public License

    20

 *  along with the IgH EtherCAT Master; if not, write to the Free Software

    21

 *  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA

    22

 *

    23

 *  The right to use EtherCAT Technology is granted and comes free of

    24

 *  charge under condition of compatibility of product made by

    25

 *  Licensee. People intending to distribute/sell products based on the

    26

 *  code, have to sign an agreement to guarantee that products using

    27

 *  software based on IgH EtherCAT master stay compatible with the actual

    28

 *  EtherCAT specification (which are released themselves as an open

    29

 *  standard) as the (only) precondition to have the right to use EtherCAT

    30

 *  Technology, IP and trade marks.

    31

 *

    32

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

    33

    34

#include <errno.h>

    35

#include <signal.h>

    36

#include <stdio.h>

    37

#include <string.h>

    38

#include <sys/resource.h>

    39

#include <sys/time.h>

    40

#include <sys/types.h>

    41

#include <unistd.h>

    42

    43

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

    44

    45

#include "ecrt.h"

    46

    47

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

    48

    52

// Optional features

    53

#define CONFIGURE_PDOS  1

    72

    73

#define BusCouplerPos  0, 0

    74

#define AnaOutSlavePos 0, 1

    75

#define AnaInSlavePos  0, 2

    76

#define DigOutSlavePos 0, 3

    77

    78

#define Beckhoff_EK1100 0x00000002, 0x044C2C52

    79

#define Beckhoff_EL2004 0x00000002, 0x07D43052

    80

#define Beckhoff_EL3152 0x00000002, 0x0c503052

    81

#define Beckhoff_EL4102 0x00000002, 0x10063052

    82

    83

// offsets for Pdo entries

    86

static unsigned int off_ana_out;

    87

static unsigned int off_dig_out;

    88

    89

const static ec_pdo_entry_reg_t domain1_regs[] = {

    92

	{AnaOutSlavePos, Beckhoff_EL4102, 0x3001, 1, &off_ana_out},

    93

	{DigOutSlavePos, Beckhoff_EL2004, 0x3001, 1, &off_dig_out},

    94

	{}

    95

};

    96

    97

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

    98

    99

#if CONFIGURE_PDOS

   100

   101

// Analog in --------------------------

   102

   103

static ec_pdo_entry_info_t el3152_pdo_entries[] = {

   104

    {0x3101, 1,  8}, // channel 1 status

   105

    {0x3101, 2, 16}, // channel 1 value

   106

    {0x3102, 1,  8}, // channel 2 status

   107

    {0x3102, 2, 16}, // channel 2 value

   108

    {0x6401, 1, 16}, // channel 1 value (alt.)

   109

    {0x6401, 2, 16}  // channel 2 value (alt.)

   110

};

   111

   112

static ec_pdo_info_t el3152_pdos[] = {

   113

    {0x1A00, 2, el3152_pdo_entries},

   114

    {0x1A01, 2, el3152_pdo_entries + 2}

   115

};

   116

   117

static ec_sync_info_t el3152_syncs[] = {

   118

    {2, EC_DIR_OUTPUT},

   119

    {3, EC_DIR_INPUT, 2, el3152_pdos},

   120

    {0xff}

   121

};

   122

   123

// Analog out -------------------------

   124

   125

static ec_pdo_entry_info_t el4102_pdo_entries[] = {

   126

    {0x3001, 1, 16}, // channel 1 value

   127

    {0x3002, 1, 16}, // channel 2 value

   128

};

   129

   130

static ec_pdo_info_t el4102_pdos[] = {

   131

    {0x1600, 1, el4102_pdo_entries},

   132

    {0x1601, 1, el4102_pdo_entries + 1}

   133

};

   134

   135

static ec_sync_info_t el4102_syncs[] = {

   136

    {2, EC_DIR_OUTPUT, 2, el4102_pdos},

   137

    {3, EC_DIR_INPUT},

   138

    {0xff}

   139

};

   140

   141

// Digital out ------------------------

   142

   143

static ec_pdo_entry_info_t el2004_channels[] = {

   144

    {0x3001, 1, 1}, // Value 1

   145

    {0x3001, 2, 1}, // Value 2

   146

    {0x3001, 3, 1}, // Value 3

   147

    {0x3001, 4, 1}  // Value 4

   148

};

   149

   150

static ec_pdo_info_t el2004_pdos[] = {

   151

    {0x1600, 1, &el2004_channels[0]},

   152

    {0x1601, 1, &el2004_channels[1]},

   153

    {0x1602, 1, &el2004_channels[2]},

   154

    {0x1603, 1, &el2004_channels[3]}

   155

};

   156

   157

static ec_sync_info_t el2004_syncs[] = {

   158

    {0, EC_DIR_OUTPUT, 4, el2004_pdos},

   159

    {1, EC_DIR_INPUT},

   160

    {0xff}

   161

};

   162

#endif

   163

   164

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

   165

   188

void signal_handler(int signum) {

   189

    switch (signum) {

   190

        case SIGALRM:

   191

            sig_alarms++;

   192

            break;

   193

    }

   194

}

   195

   196

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

   197

   198

int main(int argc, char **argv)

   199

{

   200

	ec_slave_config_t *sc;

   201

    struct sigaction sa;

   202

    struct itimerval tv;

   203

   204

    master = ecrt_request_master(0);

   205

	if (!master)

   206

		return -1;

   207

   208

    domain1 = ecrt_master_create_domain(master);

   209

    if (!domain1)

   210

        return -1;

   211

   212

    if (!(sc_ana_in = ecrt_master_slave_config(

   213

                    master, AnaInSlavePos, Beckhoff_EL3152))) {

   214

        fprintf(stderr, "Failed to get slave configuration.\n");

   215

        return -1;

   216

    }

   217

   218

#if CONFIGURE_PDOS

   219

    printf("Configuring Pdos...\n");

   220

    if (ecrt_slave_config_pdos(sc_ana_in, EC_END, el3152_syncs)) {

   221

        fprintf(stderr, "Failed to configure Pdos.\n");

   222

        return -1;

   223

    }

   224

   225

    if (!(sc = ecrt_master_slave_config(

   226

                    master, AnaOutSlavePos, Beckhoff_EL4102))) {

   227

        fprintf(stderr, "Failed to get slave configuration.\n");

   228

        return -1;

   229

    }

   230

   231

    if (ecrt_slave_config_pdos(sc, EC_END, el4102_syncs)) {

   232

        fprintf(stderr, "Failed to configure Pdos.\n");

   233

        return -1;

   234

    }

   235

   236

    if (!(sc = ecrt_master_slave_config(

   237

                    master, DigOutSlavePos, Beckhoff_EL2004))) {

   238

        fprintf(stderr, "Failed to get slave configuration.\n");

   239

        return -1;

   240

    }

   241

   242

    if (ecrt_slave_config_pdos(sc, EC_END, el2004_syncs)) {

   243

        fprintf(stderr, "Failed to configure Pdos.\n");

   244

        return -1;

   245

    }

   246

#endif

   247

   248

    // Create configuration for bus coupler

   249

    sc = ecrt_master_slave_config(master, BusCouplerPos, Beckhoff_EK1100);

   250

    if (!sc)

   251

        return -1;

   252

   253

    if (ecrt_domain_reg_pdo_entry_list(domain1, domain1_regs)) {

   254

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

   255

		return -1;

   256

    }

   257

   258

    printf("Activating master...\n");

   259

    if (ecrt_master_activate(master))

   260

        return -1;

   261

   266

#if PRIORITY

   267

    pid_t pid = getpid();

   268

    if (setpriority(PRIO_PROCESS, pid, -19))

   269

        fprintf(stderr, "Warning: Failed to set priority: %s\n",

   270

                strerror(errno));

   271

#endif

   272

   273

    sa.sa_handler = signal_handler;

   274

    sigemptyset(&sa.sa_mask);

   275

    sa.sa_flags = 0;

   276

    if (sigaction(SIGALRM, &sa, 0)) {

   277

        fprintf(stderr, "Failed to install signal handler!\n");

   278

        return -1;

   279

    }

   280

   281

    printf("Starting timer...\n");

   282

    tv.it_interval.tv_sec = 0;

   283

    tv.it_interval.tv_usec = 10000;

   284

    tv.it_value.tv_sec = 0;

   285

    tv.it_value.tv_usec = 1000;

   286

    if (setitimer(ITIMER_REAL, &tv, NULL)) {

   287

        fprintf(stderr, "Failed to start timer: %s\n", strerror(errno));

   288

        return 1;

   289

    }

   290

   291

    printf("Started.\n");

   292

	while (1) {

   294

   295

#if 0

   296

        struct timeval t;

   297

        gettimeofday(&t, NULL);

   298

        printf("%u.%06u\n", t.tv_sec, t.tv_usec);

   299

#endif

   300

   301

        while (sig_alarms != user_alarms) {

   303

            user_alarms++;

   304

        }

   305

	}

   306

   307

	return 0;

   308

}

   309

   310

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