fp@98: /******************************************************************************
fp@98:  *
fp@98:  *  c o m m a n d . c
fp@98:  *
fp@98:  *  Methoden für ein EtherCAT-Kommando.
fp@98:  *
fp@98:  *  $Id$
fp@98:  *
fp@98:  *****************************************************************************/
fp@98: 
fp@98: #include <linux/slab.h>
fp@98: #include <linux/delay.h>
fp@98: 
fp@98: #include "command.h"
fp@98: #include "master.h"
fp@98: 
fp@98: /*****************************************************************************/
fp@98: 
fp@98: #define EC_FUNC_HEADER \
fp@98:     command->index = 0; \
fp@98:     command->working_counter = 0; \
fp@98:     command->state = EC_CMD_INIT;
fp@98: 
fp@98: #define EC_FUNC_WRITE_FOOTER \
fp@98:     command->data_size = data_size; \
fp@98:     memcpy(command->data, data, data_size);
fp@98: 
fp@98: #define EC_FUNC_READ_FOOTER \
fp@98:     command->data_size = data_size; \
fp@98:     memset(command->data, 0x00, data_size);
fp@98: 
fp@98: /*****************************************************************************/
fp@98: 
fp@98: /**
fp@98:    Initialisiert ein EtherCAT-NPRD-Kommando.
fp@98: 
fp@98:    Node-adressed physical read.
fp@98: */
fp@98: 
fp@98: void ec_command_init_nprd(ec_command_t *command,
fp@98:                           /**< EtherCAT-Rahmen */
fp@98:                           uint16_t node_address,
fp@98:                           /**< Adresse des Knotens (Slaves) */
fp@98:                           uint16_t offset,
fp@98:                           /**< Physikalische Speicheradresse im Slave */
fp@98:                           size_t data_size
fp@98:                           /**< Länge der zu lesenden Daten */
fp@98:                           )
fp@98: {
fp@98:     if (unlikely(node_address == 0x0000))
fp@98:         EC_WARN("Using node address 0x0000!\n");
fp@98: 
fp@98:     EC_FUNC_HEADER;
fp@98: 
fp@98:     command->type = EC_CMD_NPRD;
fp@98:     command->address.physical.slave = node_address;
fp@98:     command->address.physical.mem = offset;
fp@98: 
fp@98:     EC_FUNC_READ_FOOTER;
fp@98: }
fp@98: 
fp@98: /*****************************************************************************/
fp@98: 
fp@98: /**
fp@98:    Initialisiert ein EtherCAT-NPWR-Kommando.
fp@98: 
fp@98:    Node-adressed physical write.
fp@98: */
fp@98: 
fp@98: void ec_command_init_npwr(ec_command_t *command,
fp@98:                           /**< EtherCAT-Rahmen */
fp@98:                           uint16_t node_address,
fp@98:                           /**< Adresse des Knotens (Slaves) */
fp@98:                           uint16_t offset,
fp@98:                           /**< Physikalische Speicheradresse im Slave */
fp@98:                           size_t data_size,
fp@98:                           /**< Länge der zu schreibenden Daten */
fp@98:                           const uint8_t *data
fp@98:                           /**< Zeiger auf Speicher mit zu schreibenden Daten */
fp@98:                           )
fp@98: {
fp@98:     if (unlikely(node_address == 0x0000))
fp@98:         EC_WARN("Using node address 0x0000!\n");
fp@98: 
fp@98:     EC_FUNC_HEADER;
fp@98: 
fp@98:     command->type = EC_CMD_NPWR;
fp@98:     command->address.physical.slave = node_address;
fp@98:     command->address.physical.mem = offset;
fp@98: 
fp@98:     EC_FUNC_WRITE_FOOTER;
fp@98: }
fp@98: 
fp@98: /*****************************************************************************/
fp@98: 
fp@98: /**
fp@98:    Initialisiert ein EtherCAT-APRD-Kommando.
fp@98: 
fp@98:    Autoincrement physical read.
fp@98: */
fp@98: 
fp@98: void ec_command_init_aprd(ec_command_t *command,
fp@98:                           /**< EtherCAT-Rahmen */
fp@98:                           uint16_t ring_position,
fp@98:                           /**< Position des Slaves im Bus */
fp@98:                           uint16_t offset,
fp@98:                           /**< Physikalische Speicheradresse im Slave */
fp@98:                           size_t data_size
fp@98:                           /**< Länge der zu lesenden Daten */
fp@98:                           )
fp@98: {
fp@98:     EC_FUNC_HEADER;
fp@98: 
fp@98:     command->type = EC_CMD_APRD;
fp@98:     command->address.physical.slave = (int16_t) ring_position * (-1);
fp@98:     command->address.physical.mem = offset;
fp@98: 
fp@98:     EC_FUNC_READ_FOOTER;
fp@98: }
fp@98: 
fp@98: /*****************************************************************************/
fp@98: 
fp@98: /**
fp@98:    Initialisiert ein EtherCAT-APWR-Kommando.
fp@98: 
fp@98:    Autoincrement physical write.
fp@98: */
fp@98: 
fp@98: void ec_command_init_apwr(ec_command_t *command,
fp@98:                           /**< EtherCAT-Rahmen */
fp@98:                           uint16_t ring_position,
fp@98:                           /**< Position des Slaves im Bus */
fp@98:                           uint16_t offset,
fp@98:                           /**< Physikalische Speicheradresse im Slave */
fp@98:                           size_t data_size,
fp@98:                           /**< Länge der zu schreibenden Daten */
fp@98:                           const uint8_t *data
fp@98:                           /**< Zeiger auf Speicher mit zu schreibenden Daten */
fp@98:                           )
fp@98: {
fp@98:     EC_FUNC_HEADER;
fp@98: 
fp@98:     command->type = EC_CMD_APWR;
fp@98:     command->address.physical.slave = (int16_t) ring_position * (-1);
fp@98:     command->address.physical.mem = offset;
fp@98: 
fp@98:     EC_FUNC_WRITE_FOOTER;
fp@98: }
fp@98: 
fp@98: /*****************************************************************************/
fp@98: 
fp@98: /**
fp@98:    Initialisiert ein EtherCAT-BRD-Kommando.
fp@98: 
fp@98:    Broadcast read.
fp@98: */
fp@98: 
fp@98: void ec_command_init_brd(ec_command_t *command,
fp@98:                          /**< EtherCAT-Rahmen */
fp@98:                          uint16_t offset,
fp@98:                          /**< Physikalische Speicheradresse im Slave */
fp@98:                          size_t data_size
fp@98:                          /**< Länge der zu lesenden Daten */
fp@98:                          )
fp@98: {
fp@98:     EC_FUNC_HEADER;
fp@98: 
fp@98:     command->type = EC_CMD_BRD;
fp@98:     command->address.physical.slave = 0x0000;
fp@98:     command->address.physical.mem = offset;
fp@98: 
fp@98:     EC_FUNC_READ_FOOTER;
fp@98: }
fp@98: 
fp@98: /*****************************************************************************/
fp@98: 
fp@98: /**
fp@98:    Initialisiert ein EtherCAT-BWR-Kommando.
fp@98: 
fp@98:    Broadcast write.
fp@98: */
fp@98: 
fp@98: void ec_command_init_bwr(ec_command_t *command,
fp@98:                          /**< EtherCAT-Rahmen */
fp@98:                          uint16_t offset,
fp@98:                          /**< Physikalische Speicheradresse im Slave */
fp@98:                          size_t data_size,
fp@98:                          /**< Länge der zu schreibenden Daten */
fp@98:                          const uint8_t *data
fp@98:                          /**< Zeiger auf Speicher mit zu schreibenden Daten */
fp@98:                          )
fp@98: {
fp@98:     EC_FUNC_HEADER;
fp@98: 
fp@98:     command->type = EC_CMD_BWR;
fp@98:     command->address.physical.slave = 0x0000;
fp@98:     command->address.physical.mem = offset;
fp@98: 
fp@98:     EC_FUNC_WRITE_FOOTER;
fp@98: }
fp@98: 
fp@98: /*****************************************************************************/
fp@98: 
fp@98: /**
fp@98:    Initialisiert ein EtherCAT-LRW-Kommando.
fp@98: 
fp@98:    Logical read write.
fp@98: */
fp@98: 
fp@98: void ec_command_init_lrw(ec_command_t *command,
fp@98:                          /**< EtherCAT-Rahmen */
fp@98:                          uint32_t offset,
fp@98:                          /**< Logische Startadresse */
fp@98:                          size_t data_size,
fp@98:                          /**< Länge der zu lesenden/schreibenden Daten */
fp@98:                          uint8_t *data
fp@98:                          /**< Zeiger auf die Daten */
fp@98:                          )
fp@98: {
fp@98:     EC_FUNC_HEADER;
fp@98: 
fp@98:     command->type = EC_CMD_LRW;
fp@98:     command->address.logical = offset;
fp@98: 
fp@98:     EC_FUNC_WRITE_FOOTER;
fp@98: }
fp@98: 
fp@98: /*****************************************************************************/
fp@98: 
fp@98: /* Emacs-Konfiguration
fp@98: ;;; Local Variables: ***
fp@98: ;;; c-basic-offset:4 ***
fp@98: ;;; End: ***
fp@98: */