1

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

     2

 *

     3

 * m i n i . c

     4

 *

     5

 * Minimalmodul für EtherCAT

     6

 *

     7

 * $Id$

     8

 *

     9

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

    10

    11

#include <linux/module.h>

    12

#include <linux/delay.h>

    13

#include <linux/timer.h>

    14

    15

#include "../include/EtherCAT_rt.h" // Echtzeitschnittstelle

    16

#include "../include/EtherCAT_si.h" // Slave-Interface-Makros

    17

    18

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

    19

    20

ec_master_t *master = NULL;

    21

ec_slave_t *s_in, *s_out, *s_ssi;

    22

    23

struct timer_list timer;

    24

    25

ec_slave_init_t slaves[] = {

    26

    // Zeiger, Index, Herstellername, Produktname, Domäne

    27

    {  &s_out, 2,     "Beckhoff",     "EL2004",    1      },

    28

    {  &s_in,  1,     "Beckhoff",     "EL3102",    1      },

    29

    {  &s_ssi, 7,     "Beckhoff",     "EL5001",    1      }

    30

};

    31

    32

#define SLAVE_COUNT (sizeof(slaves) / sizeof(ec_slave_init_t))

    33

    34

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

    35

    36

void run(unsigned long data)

    37

{

    38

    // Klemmen-IO

    39

    EC_WRITE_EL20XX(s_out, 3, EC_READ_EL31XX(s_in, 0) < 0);

    40

    41

    // Prozessdaten lesen und schreiben

    42

    EtherCAT_rt_domain_xio(master, 1, 100);

    43

    44

    // Timer neu starten

    45

    timer.expires += HZ / 1000;

    46

    add_timer(&timer);

    47

}

    48

    49

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

    50

    51

int __init init_mini_module(void)

    52

{

    53

    printk(KERN_INFO "=== Starting Minimal EtherCAT environment... ===\n");

    54

    55

    if ((master = EtherCAT_rt_request_master(0)) == NULL) {

    56

        printk(KERN_ERR "EtherCAT master 0 not available!\n");

    57

        goto out_return;

    58

    }

    59

    60

    if (EtherCAT_rt_register_slave_list(master, slaves, SLAVE_COUNT)) {

    61

        printk(KERN_ERR "Could not register slaves!\n");

    62

        goto out_release_master;

    63

    }

    64

    65

    printk("Activating all EtherCAT slaves.\n");

    66

    67

    if (EtherCAT_rt_activate_slaves(master)) {

    68

        printk(KERN_ERR "EtherCAT: Could not activate slaves!\n");

    69

        goto out_release_master;

    70

    }

    71

    72

    printk("Configuring EtherCAT slaves.\n");

    73

    74

    EtherCAT_rt_debug_level(master, 2);

    75

    77

        printk(KERN_ERR "EtherCAT: Could not set SSI baud rate!\n");

    78

        goto out_release_master;

    79

    }

    80

    81

    EtherCAT_rt_debug_level(master, 0);

    82

    83

    printk("Starting cyclic sample thread.\n");

    84

    85

    init_timer(&timer);

    86

    87

    timer.function = run;

    88

    timer.expires = jiffies + 10; // Das erste Mal sofort feuern

    89

    add_timer(&timer);

    90

    91

    printk(KERN_INFO "=== Minimal EtherCAT environment started. ===\n");

    92

    93

    return 0;

    94

    95

 out_release_master:

    96

  EtherCAT_rt_release_master(master);

    97

    98

 out_return:

    99

  return -1;

   100

}

   101

   102

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

   103

   104

void __exit cleanup_mini_module(void)

   105

{

   106

    printk(KERN_INFO "=== Stopping Minimal EtherCAT environment... ===\n");

   107

   108

    if (master)

   109

    {

   110

        del_timer_sync(&timer);

   111

   112

        printk(KERN_INFO "Deactivating slaves.\n");

   113

   114

        EtherCAT_rt_deactivate_slaves(master);

   115

        EtherCAT_rt_release_master(master);

   116

    }

   117

   118

    printk(KERN_INFO "=== Minimal EtherCAT environment stopped. ===\n");

   119

}

   120

   121

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

   122

   123

MODULE_LICENSE("GPL");

   124

MODULE_AUTHOR ("Florian Pose <fp@igh-essen.com>");

   125

MODULE_DESCRIPTION ("Minimal EtherCAT environment");

   126

   127

module_init(init_mini_module);

   128

module_exit(cleanup_mini_module);

   129

   130

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

   131

   132

/* Emacs-Konfiguration

   133

;;; Local Variables: ***

   134

;;; c-basic-offset:4 ***

   135

;;; End: ***

   136

*/