1

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

     2

 *

     3

 *  e t h e r n e t . c

     4

 *

     5

 *  Ethernet-over-EtherCAT (EoE)

     6

 *

     7

 *  $Id$

     8

 *

     9

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

    10

    11

#include "../include/ecrt.h"

    12

#include "globals.h"

    13

#include "master.h"

    14

#include "slave.h"

    15

#include "mailbox.h"

    16

#include "ethernet.h"

    17

    18

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

    19

    20

void ec_eoe_init(ec_eoe_t *eoe, ec_slave_t *slave)

    21

{

    22

    eoe->slave = slave;

    23

    eoe->rx_state = EC_EOE_IDLE;

    24

}

    25

    26

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

    27

    28

void ec_eoe_clear(ec_eoe_t *eoe)

    29

{

    30

}

    31

    32

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

    33

    34

void ec_eoe_run(ec_eoe_t *eoe)

    35

{

    36

    uint8_t *data;

    37

    ec_master_t *master;

    38

    size_t rec_size;

    39

#if 0

    40

    unsigned int i;

    41

    uint8_t fragment_number;

    42

    uint8_t complete_size;

    43

    uint8_t frame_number;

    44

    uint8_t last_fragment;

    45

#endif

    46

    47

    master = eoe->slave->master;

    48

    49

    if (eoe->rx_state == EC_EOE_IDLE) {

    50

        ec_slave_mbox_prepare_check(eoe->slave);

    51

        ec_master_queue_command(master, &eoe->slave->mbox_command);

    52

        eoe->rx_state = EC_EOE_CHECKING;

    53

        return;

    54

    }

    55

    56

    if (eoe->rx_state == EC_EOE_CHECKING) {

    57

        if (eoe->slave->mbox_command.state != EC_CMD_RECEIVED) {

    58

            master->stats.eoe_errors++;

    59

            eoe->rx_state = EC_EOE_IDLE;

    60

            return;

    61

        }

    62

        if (!ec_slave_mbox_check(eoe->slave)) {

    63

            eoe->rx_state = EC_EOE_IDLE;

    64

            return;

    65

        }

    66

        ec_slave_mbox_prepare_fetch(eoe->slave);

    67

        ec_master_queue_command(master, &eoe->slave->mbox_command);

    68

        eoe->rx_state = EC_EOE_FETCHING;

    69

        return;

    70

    }

    71

    72

    if (eoe->rx_state == EC_EOE_FETCHING) {

    73

        if (eoe->slave->mbox_command.state != EC_CMD_RECEIVED) {

    74

            master->stats.eoe_errors++;

    75

            eoe->rx_state = EC_EOE_IDLE;

    76

            return;

    77

        }

    78

        if (!(data = ec_slave_mbox_fetch(eoe->slave, 0x02, &rec_size))) {

    79

            master->stats.eoe_errors++;

    80

            eoe->rx_state = EC_EOE_IDLE;

    81

            return;

    82

        }

    83

    84

#if 0

    85

        fragment_number = EC_READ_U16(data + 2) & 0x003F;

    86

        complete_size = (EC_READ_U16(data + 2) >> 6) & 0x003F;

    87

        frame_number = (EC_READ_U16(data + 2) >> 12) & 0x0003;

    88

        last_fragment = (EC_READ_U16(data + 2) >> 15) & 0x0001;

    89

    90

        EC_DBG("EOE %s received, fragment: %i, complete size: %i (0x%02X),"

    91

               " frame %i%s\n",

    92

               fragment_number ? "fragment" : "initiate", fragment_number,

    93

               (complete_size - 31) / 32, complete_size, frame_number,

    94

               last_fragment ? ", last fragment" : "");

    95

        EC_DBG("");

    96

        for (i = 0; i < rec_size - 2; i++) {

    97

            printk("%02X ", data[i + 2]);

    98

            if ((i + 1) % 16 == 0) {

    99

                printk("\n");

   100

                EC_DBG("");

   101

            }

   102

        }

   103

        printk("\n");

   104

#endif

   105

   106

        eoe->rx_state = EC_EOE_IDLE;

   107

        return;

   108

    }

   109

}

   110

   111

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

   112

   113

void ec_eoe_print(const ec_eoe_t *eoe)

   114

{

   115

    EC_INFO("  EoE slave %i\n", eoe->slave->ring_position);

   116

    EC_INFO("    RX State %i\n", eoe->rx_state);

   117

}

   118

   119

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