<html xmlns:v="urn:schemas-microsoft-com:vml" xmlns:o="urn:schemas-microsoft-com:office:office" xmlns:w="urn:schemas-microsoft-com:office:word" xmlns:m="http://schemas.microsoft.com/office/2004/12/omml" xmlns="http://www.w3.org/TR/REC-html40">
<head>
<meta http-equiv="Content-Type" content="text/html; charset=us-ascii">
<meta name="Generator" content="Microsoft Word 15 (filtered medium)">
<style><!--
/* Font Definitions */
@font-face
{font-family:"Cambria Math";
panose-1:2 4 5 3 5 4 6 3 2 4;}
@font-face
{font-family:Calibri;
panose-1:2 15 5 2 2 2 4 3 2 4;}
/* Style Definitions */
p.MsoNormal, li.MsoNormal, div.MsoNormal
{margin:0cm;
font-size:11.0pt;
font-family:"Calibri",sans-serif;}
a:link, span.MsoHyperlink
{mso-style-priority:99;
color:#0563C1;
text-decoration:underline;}
span.EmailStyle20
{mso-style-type:personal-reply;
font-family:"Calibri",sans-serif;
color:windowtext;}
.MsoChpDefault
{mso-style-type:export-only;
font-size:10.0pt;
mso-ligatures:none;}
@page WordSection1
{size:612.0pt 792.0pt;
margin:72.0pt 72.0pt 72.0pt 72.0pt;}
div.WordSection1
{page:WordSection1;}
--></style><!--[if gte mso 9]><xml>
<o:shapedefaults v:ext="edit" spidmax="1026" />
</xml><![endif]--><!--[if gte mso 9]><xml>
<o:shapelayout v:ext="edit">
<o:idmap v:ext="edit" data="1" />
</o:shapelayout></xml><![endif]-->
</head>
<body lang="EN-NZ" link="#0563C1" vlink="#954F72" style="word-wrap:break-word">
<div class="WordSection1">
<p class="MsoNormal"><span style="mso-fareast-language:EN-US">Hi David,<o:p></o:p></span></p>
<p class="MsoNormal"><span style="mso-fareast-language:EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span style="mso-fareast-language:EN-US">In </span><span lang="EN-US">cyclic_task() it looks like you are missing ecrt_domain_queue(domain1) just before ecrt_master_send().<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">I haven’t checked for any further problems.<o:p></o:p></span></p>
<p class="MsoNormal"><span style="mso-fareast-language:EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span style="mso-fareast-language:EN-US">Regards,<o:p></o:p></span></p>
<p class="MsoNormal"><span style="mso-fareast-language:EN-US">Graeme.<o:p></o:p></span></p>
<p class="MsoNormal"><span style="mso-fareast-language:EN-US"><o:p> </o:p></span></p>
<div>
<div style="border:none;border-top:solid #E1E1E1 1.0pt;padding:3.0pt 0cm 0cm 0cm">
<p class="MsoNormal"><b><span lang="EN-US">From:</span></b><span lang="EN-US"> Etherlab-users <etherlab-users-bounces@etherlab.org>
<b>On Behalf Of </b>David Meehan<br>
<b>Sent:</b> Thursday, November 9, 2023 7:15 AM<br>
<b>To:</b> etherlab-users@etherlab.org<br>
<b>Subject:</b> [Etherlab-users] EL3204 Analog PDO Data Issue<o:p></o:p></span></p>
</div>
</div>
<p class="MsoNormal"><o:p> </o:p></p>
<p class="MsoNormal"><span lang="EN-US">Hi all,<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">I’m completely new to EtherCAT, so bear with me. I’m in the process of trying to bring up an EL3204 4-channel analog input terminal. I’m running into an issue where it doesn’t look like I’m getting any PDO data back.
The working counter seems stuck at [0/1]. I have some code based on the dc_user example project (see code below). Our system has the following slave terminals.<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">// Taken from:<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">// > ethercat slaves<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">// 0 0:0 PREOP + EK1100 EtherCAT-Koppler (2A E-Bus)<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">// 1 0:1 PREOP + EL1809 16K. Dig. Eingang 24V, 3ms<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">// 2 0:2 PREOP + EL2809 16K. Dig. Ausgang 24V, 0.5A<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">// 3 0:3 PREOP + EL6224 (IO Link Master)<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">// 4 0:4 PREOP + EL7031 1K. Schrittmotor-Endstufe (24V, 1.5A)<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">// 5 0:5 PREOP + EL3204-0200 4K. Ana. Ein. PT1000 (RTD)<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">For right now I’m only interested in setting up the EL3204. I ran the “ethercat cstruct” command to get the sync manager and pdo listings for slave 5. Using those I was able to create a ec_pdo_entry_reg_t registration
list containing the 4 channel values. I pass the sync info objects through ecrt_slave_config_pdos, and pass the domain registration list through ecrt_domain_reg_pdo_entry_list. Everything seems to work and the slave node goes to OP state after activating the
master. I printed out the byte offset mappings and it looks like ec master was able to allocate a data buffer and assign the PDOs. Everything looks good.<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">But I’m still not getting any PDO data. Everything is reporting back as 0 and the WC is not incrementing. I ran a little experiment and setup some SDO request objects and tried reading back the sensor values using SDOs
instead of PDOs, and it worked! The readings I’m getting back from the SDOs match the values I was seeing in TwinCAT. So I know the comms are good.<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">Anyway, if anyone has any suggestions, it would be appreciated.<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">Thanks,<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">Dave M<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">/*****************************************************************************<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">*<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">* Copyright (C) 2007-2022 Florian Pose, Ingenieurgemeinschaft IgH<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">*<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">* This file is part of the IgH EtherCAT Master.<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">*<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">* The IgH EtherCAT Master is free software; you can redistribute it and/or<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">* modify it under the terms of the GNU General Public License version 2, as<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">* published by the Free Software Foundation.<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">*<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">* The IgH EtherCAT Master is distributed in the hope that it will be useful,<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">* but WITHOUT ANY WARRANTY; without even the implied warranty of<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">* Public License for more details.<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">*<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">* You should have received a copy of the GNU General Public License along<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">* with the IgH EtherCAT Master; if not, write to the Free Software<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">*<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">* ---<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">*<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">* The license mentioned above concerns the source code only. Using the<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">* EtherCAT technology and brand is only permitted in compliance with the<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">* industrial property and similar rights of Beckhoff Automation GmbH.<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">*<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">****************************************************************************/<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">#include <errno.h><o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">#include <signal.h><o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">#include <stdio.h><o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">#include <string.h><o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">#include <sys/resource.h><o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">#include <sys/time.h><o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">#include <sys/types.h><o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">#include <unistd.h><o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">#include <time.h><o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">#include <sys/mman.h><o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">#include <malloc.h><o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">#include <sched.h> /* sched_setscheduler() */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">#include "ecrt.h"<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">/****************************************************************************/<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">// Application parameters<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">#define FREQUENCY 1000<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">#define CLOCK_TO_USE CLOCK_MONOTONIC<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">#define MEASURE_TIMING<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">// Taken from ethercat slaves<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">// 0 0:0 PREOP + EK1100 EtherCAT-Koppler (2A E-Bus)<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">// 1 0:1 PREOP + EL1809 16K. Dig. Eingang 24V, 3ms<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">// 2 0:2 PREOP + EL2809 16K. Dig. Ausgang 24V, 0.5A<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">// 3 0:3 PREOP + EL6224 (IO Link Master)<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">// 4 0:4 PREOP + EL7031 1K. Schrittmotor-Endstufe (24V, 1.5A)<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">// 5 0:5 PREOP + EL3204-0200 4K. Ana. Ein. PT1000 (RTD)<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">// Taken from ethercat cstruct<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">/* Master 0, Slave 5, "EL3204-0200"<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">* Vendor ID: 0x00000002<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">* Product code: 0x0c843052<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">* Revision number: 0x001200c8<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">*/<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">ec_pdo_entry_info_t slave_5_pdo_entries[] = {<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x6000, 0x01, 1}, /* Underrange */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x6000, 0x02, 1}, /* Overrange */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x0000, 0x00, 4}, /* Gap */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x6000, 0x07, 1}, /* Error */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x0000, 0x00, 7}, /* Gap */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x6000, 0x0f, 1}, /* TxPDO State */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x6000, 0x10, 1}, /* TxPDO Toggle */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x6000, 0x11, 16}, /* Value */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x6010, 0x01, 1}, /* Underrange */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x6010, 0x02, 1}, /* Overrange */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x0000, 0x00, 4}, /* Gap */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x6010, 0x07, 1}, /* Error */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x0000, 0x00, 7}, /* Gap */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x6010, 0x0f, 1}, /* TxPDO State */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x6010, 0x10, 1}, /* TxPDO Toggle */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x6010, 0x11, 16}, /* Value */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x6020, 0x01, 1}, /* Underrange */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x6020, 0x02, 1}, /* Overrange */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x0000, 0x00, 4}, /* Gap */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x6020, 0x07, 1}, /* Error */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x0000, 0x00, 7}, /* Gap */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x6020, 0x0f, 1}, /* TxPDO State */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x6020, 0x10, 1}, /* TxPDO Toggle */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x6020, 0x11, 16}, /* Value */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x6030, 0x01, 1}, /* Underrange */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x6030, 0x02, 1}, /* Overrange */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x0000, 0x00, 4}, /* Gap */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x6030, 0x07, 1}, /* Error */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x0000, 0x00, 7}, /* Gap */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x6030, 0x0f, 1}, /* TxPDO State */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x6030, 0x10, 1}, /* TxPDO Toggle */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x6030, 0x11, 16}, /* Value */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">};<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">ec_pdo_info_t slave_5_pdos[] = {<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x1a00, 8, slave_5_pdo_entries + 0}, /* RTD TxPDO-Map Ch.1 */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x1a01, 8, slave_5_pdo_entries + 8}, /* RTD TxPDO-Map Ch.2 */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x1a02, 8, slave_5_pdo_entries + 16}, /* RTD TxPDO-Map Ch.3 */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {0x1a03, 8, slave_5_pdo_entries + 24}, /* RTD TxPDO-Map Ch.4 */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="FR">};<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="FR"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="FR">ec_sync_info_t slave_5_syncs[] = {<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="FR"> </span><span lang="EN-US">{0, EC_DIR_OUTPUT, 0, NULL, EC_WD_DISABLE},<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {1, EC_DIR_INPUT, 0, NULL, EC_WD_DISABLE},<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {2, EC_DIR_OUTPUT, 0, NULL, EC_WD_DISABLE},<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {3, EC_DIR_INPUT, 4, slave_5_pdos + 0, EC_WD_DISABLE},<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> </span><span lang="FR">{0xff}<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="FR">};<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="FR"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="FR">// typedef struct {<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="FR">// uint16_t alias;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="FR">// uint16_t position;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="FR">// uint32_t vendor_id;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="FR">// uint32_t product_code;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="FR">// uint16_t index;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="FR">// uint8_t subindex;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">// unsigned int *offset;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">// unsigned int *bit_position;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">// } ec_pdo_entry_reg_t;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">unsigned int val1Offset = 0u;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">unsigned int val1bit = 0u;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">unsigned int val2Offset = 0u;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">unsigned int val2bit = 0u;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">unsigned int val3Offset = 0u;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">unsigned int val3bit = 0u;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">unsigned int val4Offset = 0u;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">unsigned int val4bit = 0u;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">// Taken from ethercat cstruct<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">ec_pdo_entry_reg_t registrationList[] = {<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> { 0, 5, 2, 0xc843052, 0x6000, 0x11, &val1Offset, &val1bit },<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> { 0, 5, 2, 0xc843052, 0x6010, 0x11, &val2Offset, &val2bit },<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> { 0, 5, 2, 0xc843052, 0x6020, 0x11, &val3Offset, &val3bit },<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> { 0, 5, 2, 0xc843052, 0x6030, 0x11, &val4Offset, &val4bit }<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">};<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">/****************************************************************************/<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">#define NSEC_PER_SEC (1000000000L)<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">#define PERIOD_NS (NSEC_PER_SEC / FREQUENCY)<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">#define DIFF_NS(A, B) (((B).tv_sec - (A).tv_sec) * NSEC_PER_SEC + \<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> (B).tv_nsec - (A).tv_nsec)<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">#define TIMESPEC2NS(T) ((uint64_t) (T).tv_sec * NSEC_PER_SEC + (T).tv_nsec)<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">/****************************************************************************/<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">// EtherCAT<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">static ec_master_t *master = NULL;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">static ec_master_state_t master_state = {};<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="FR">static ec_domain_t *domain1 = NULL;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">static ec_domain_state_t domain1_state = {};<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">/****************************************************************************/<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">// process data<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">static uint8_t *domain1_pd = NULL;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">#define BusCouplerPos 0, 0<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">#define DigInSlavePos 0, 1<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">#define CounterSlavePos 0, 2<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">#define Beckhoff_EK1100 0x00000002, 0x044c2c52<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">#define Beckhoff_EL3204 0x00000002, 0x0c843052 // TODO Set to the EL3204<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">// offsets for PDO entries<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">static int off_dig_out;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">static int off_counter_in;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">static int off_counter_out;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">static unsigned int counter = 0;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">static unsigned int blink = 0;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">static unsigned int sync_ref_counter = 0;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">const struct timespec cycletime = {0, PERIOD_NS};<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">/****************************************************************************/<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">struct timespec timespec_add(struct timespec time1, struct timespec time2)<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">{<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> struct timespec result;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> if ((time1.tv_nsec + time2.tv_nsec) >= NSEC_PER_SEC) {<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> result.tv_sec = time1.tv_sec + time2.tv_sec + 1;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> result.tv_nsec = time1.tv_nsec + time2.tv_nsec - NSEC_PER_SEC;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> } else {<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> result.tv_sec = time1.tv_sec + time2.tv_sec;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> result.tv_nsec = time1.tv_nsec + time2.tv_nsec;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> }<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> return result;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">}<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">/****************************************************************************/<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">void check_domain1_state(void)<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">{<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> ec_domain_state_t ds;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> ecrt_domain_state(domain1, &ds);<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> if (ds.working_counter != domain1_state.working_counter)<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> printf("Domain1: WC %u.\n", ds.working_counter);<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> if (ds.wc_state != domain1_state.wc_state)<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> printf("Domain1: State %u.\n", ds.wc_state);<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> domain1_state = ds;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">}<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">/****************************************************************************/<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">void check_master_state(void)<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">{<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> ec_master_state_t ms;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> ecrt_master_state(master, &ms);<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> if (ms.slaves_responding != master_state.slaves_responding)<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> printf("%u slave(s).\n", ms.slaves_responding);<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> if (ms.al_states != master_state.al_states)<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> printf("AL states: 0x%02X.\n", ms.al_states);<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> if (ms.link_up != master_state.link_up)<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> printf("Link is %s.\n", ms.link_up ? "up" : "down");<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> master_state = ms;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">}<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">/****************************************************************************/<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">void cyclic_task()<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">{<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> struct timespec wakeupTime, time;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">#ifdef MEASURE_TIMING<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> struct timespec startTime, endTime, lastStartTime = {};<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> uint32_t period_ns = 0, exec_ns = 0, latency_ns = 0,<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> latency_min_ns = 0, latency_max_ns = 0,<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> period_min_ns = 0, period_max_ns = 0,<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> </span><span lang="FR">exec_min_ns = 0, exec_max_ns = 0;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">#endif<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> // get current time<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> clock_gettime(CLOCK_TO_USE, &wakeupTime);<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> while(1) {<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> wakeupTime = timespec_add(wakeupTime, cycletime);<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> clock_nanosleep(CLOCK_TO_USE, TIMER_ABSTIME, &wakeupTime, NULL);<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> // Write application time to master<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> //<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> // It is a good idea to use the target time (not the measured time) as<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> // application time, because it is more stable.<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> //<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> ecrt_master_application_time(master, TIMESPEC2NS(wakeupTime));<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">#ifdef MEASURE_TIMING<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> clock_gettime(CLOCK_TO_USE, &startTime);<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> latency_ns = DIFF_NS(wakeupTime, startTime);<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> period_ns = DIFF_NS(lastStartTime, startTime);<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> exec_ns = DIFF_NS(lastStartTime, endTime);<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> lastStartTime = startTime;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> if (latency_ns > latency_max_ns) {<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> latency_max_ns = latency_ns;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> }<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> if (latency_ns < latency_min_ns) {<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> latency_min_ns = latency_ns;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> }<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> if (period_ns > period_max_ns) {<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> period_max_ns = period_ns;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> }<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> if (period_ns < period_min_ns) {<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> period_min_ns = period_ns;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> }<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> if (exec_ns > exec_max_ns) {<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> exec_max_ns = exec_ns;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> }<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> if (exec_ns < exec_min_ns) {<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> </span><span lang="FR">exec_min_ns = exec_ns;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="FR"> </span><span lang="EN-US">}<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">#endif<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> // receive process data<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> ecrt_master_receive(master);<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> ecrt_domain_process(domain1);<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> // check process data state (optional)<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> check_domain1_state();<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> if (counter) {<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> counter--;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> } else { // do this at 1 Hz<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> counter = FREQUENCY;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> // check for master state (optional)<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> check_master_state();<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">#ifdef MEASURE_TIMING<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> // output timing stats<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> printf("period %10u ... %10u\n",<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> period_min_ns, period_max_ns);<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> printf("exec %10u ... %10u\n",<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> exec_min_ns, exec_max_ns);<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> printf("latency %10u ... %10u\n",<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> latency_min_ns, latency_max_ns);<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> period_max_ns = 0;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> period_min_ns = 0xffffffff;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> exec_max_ns = 0;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> exec_min_ns = 0xffffffff;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> latency_max_ns = 0;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> latency_min_ns = 0xffffffff;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">#endif<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> }<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> // Read process data<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> int16_t val1 = EC_READ_S16(domain1_pd + val1Offset);<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> int16_t val2 = EC_READ_S16(domain1_pd + val1Offset);<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> int16_t val3 = EC_READ_S16(domain1_pd + val1Offset);<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> int16_t val4 = EC_READ_S16(domain1_pd + val1Offset);<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> </span><span lang="FR">printf("Val1: %d\nVal2: %d\nVal3: %d\nVal4: %d\n\n", val1, val2, val3, val4);<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="FR"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="FR"> </span><span lang="EN-US">if (sync_ref_counter) {<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> sync_ref_counter--;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> } else {<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> sync_ref_counter = 1; // sync every cycle<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> clock_gettime(CLOCK_TO_USE, &time);<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> ecrt_master_sync_reference_clock_to(master, TIMESPEC2NS(time));<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> }<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> ecrt_master_sync_slave_clocks(master);<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> ecrt_master_send(master);<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">#ifdef MEASURE_TIMING<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> clock_gettime(CLOCK_TO_USE, &endTime);<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">#endif<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> }<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">}<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">/****************************************************************************/<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">int main(int argc, char **argv)<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">{<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> ec_slave_config_t *sc;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> if (mlockall(MCL_CURRENT | MCL_FUTURE) == -1) {<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> perror("mlockall failed");<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> return -1;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> }<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> master = ecrt_request_master(0);<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> if (!master)<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> return -1;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> domain1 = ecrt_master_create_domain(master);<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> if (!domain1)<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> return -1;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> // Create configuration for bus coupler<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> sc = ecrt_master_slave_config(master, BusCouplerPos, Beckhoff_EK1100);<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> if (!sc)<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> return -1;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> if (!(sc = ecrt_master_slave_config(master,<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> DigInSlavePos, Beckhoff_EL3204))) {<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> fprintf(stderr, "Failed to get slave configuration.\n");<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> return -1;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> }<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> if ( ecrt_slave_config_pdos(sc, 5, &slave_5_syncs[0] ) )<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> {<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> printf("Failed to set sync manager data\n");<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> return -1;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> }<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> printf("Registering PDO entries...\n");<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> if (ecrt_domain_reg_pdo_entry_list(domain1, ®istrationList[0])) {<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> fprintf(stderr, "Failed to set slave pdos.\n");<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> return -1;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> }<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> // configure SYNC signals for this slave<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> // NOTE: EL3204 uses the same assignActivate value<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> ecrt_slave_config_dc(sc, 0x0700, PERIOD_NS, 4400000, 0, 0);<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> printf("Activating master...\n");<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> if (ecrt_master_activate(master))<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> return -1;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> if (!(domain1_pd = ecrt_domain_data(domain1))) {<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> return -1;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> }<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> printf( "Domain Size Is %d bytes\n", ecrt_domain_size( domain1 ) );<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> printf( " Domain Val1 Offset Is %d\n", val1Offset );<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> printf( " Domain Val2 Offset Is %d\n", val2Offset );<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> printf( " Domain Val3 Offset Is %d\n", val3Offset );<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> printf( " Domain Val4 Offset Is %d\n", val4Offset );<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> /* Set priority */<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> struct sched_param param = {};<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> param.sched_priority = sched_get_priority_max(SCHED_FIFO);<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> printf("Using priority %i.", param.sched_priority);<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> if (sched_setscheduler(0, SCHED_FIFO, ¶m) == -1) {<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> perror("sched_setscheduler failed");<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> }<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> printf("Starting cyclic function.\n");<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> cyclic_task();<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"> return 0;<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">}<o:p></o:p></span></p>
<p class="MsoNormal"><span lang="EN-US"><o:p> </o:p></span></p>
<p class="MsoNormal"><span lang="EN-US">/****************************************************************************/<o:p></o:p></span></p>
<p class="MsoNormal" style="margin-bottom:12.0pt"><span lang="EN-US">This e-mail and the information, including any attachments it contains, are intended to be a confidential communication only to the person or entity to whom it is addressed and may contain
information that is privileged. If the reader of this message is not the intended recipient, you are hereby notified that any dissemination, distribution or copying of this communication is strictly prohibited. If you have received this communication in error,
please immediately notify the sender and destroy the original message. Thank you. Please consider the environment before printing this email.
<o:p></o:p></span></p>
<p align="center" style="text-align:center"><span lang="EN-US" style="color:black;background:white">This message has been scanned for malware by Websense.
</span><span lang="EN-US"><a href="http://www.websense.com/"><span style="color:black;background:white">www.websense.com</span></a><o:p></o:p></span></p>
</div>
</body>
</html>