1

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

     2

 *

     4

 *

     6

 *

     7

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

     8

    11

    12

#include <asm/byteorder.h>

    13

    14

#ifdef __KERNEL__

    15

#include <linux/types.h>

    16

#else

    17

#include <stdint.h>

    18

#endif

    19

    20

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

    21

    22

struct ec_master;

    23

typedef struct ec_master ec_master_t;

    24

    25

struct ec_domain;

    26

typedef struct ec_domain ec_domain_t;

    27

    28

struct ec_slave;

    29

typedef struct ec_slave ec_slave_t;

    30

    31

typedef struct

    32

{

    33

    void **data_ptr;

    34

    const char *slave_address;

    35

    const char *vendor_name;

    36

    const char *product_name;

    37

    const char *field_name;

    38

    unsigned int field_index;

    39

    unsigned int field_count;

    40

}

    41

ec_field_init_t;

    42

    43

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

    44

// Master request functions

    45

    46

ec_master_t *ecrt_request_master(unsigned int master_index);

    47

void ecrt_release_master(ec_master_t *master);

    48

    49

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

    50

// Master methods

    51

    52

ec_domain_t *ecrt_master_create_domain(ec_master_t *master);

    53

int ecrt_master_activate(ec_master_t *master);

    54

void ecrt_master_deactivate(ec_master_t *master);

    55

void ecrt_master_sync_io(ec_master_t *master);

    56

void ecrt_master_async_send(ec_master_t *master);

    57

void ecrt_master_async_receive(ec_master_t *master);

    58

void ecrt_master_prepare_async_io(ec_master_t *master);

    59

void ecrt_master_debug(ec_master_t *master, int level);

    60

void ecrt_master_print(const ec_master_t *master);

    61

int ecrt_master_sdo_write(ec_master_t *master,

    62

                          const char *slave_addr,

    63

                          uint16_t sdo_index,

    64

                          uint8_t sdo_subindex,

    65

                          uint32_t value,

    66

                          size_t size);

    67

int ecrt_master_sdo_read(ec_master_t *master,

    68

                         const char *slave_addr,

    69

                         uint16_t sdo_index,

    70

                         uint8_t sdo_subindex,

    71

                         uint32_t *value);

    72

int ecrt_master_write_slave_alias(ec_master_t *master,

    73

                                  const char *slave_address, uint16_t alias);

    74

    75

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

    76

// Domain Methods

    77

    78

ec_slave_t *ecrt_domain_register_field(ec_domain_t *domain,

    79

                                       const char *address,

    80

                                       const char *vendor_name,

    81

                                       const char *product_name,

    82

                                       void **data_ptr,

    83

                                       const char *field_name,

    84

                                       unsigned int field_index,

    85

                                       unsigned int field_count);

    86

int ecrt_domain_register_field_list(ec_domain_t *domain,

    87

                                    ec_field_init_t *fields);

    88

void ecrt_domain_queue(ec_domain_t *domain);

    89

void ecrt_domain_process(ec_domain_t *domain);

    90

int ecrt_domain_state(ec_domain_t *domain);

    91

    92

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

    93

// Slave Methods

    94

    95

int ecrt_slave_sdo_write(ec_slave_t *slave,

    96

                         uint16_t sdo_index,

    97

                         uint8_t sdo_subindex,

    98

                         uint32_t value,

    99

                         size_t size);

   100

int ecrt_slave_sdo_read(ec_slave_t *slave,

   101

                        uint16_t sdo_index,

   102

                        uint8_t sdo_subindex,

   103

                        uint32_t *value);

   104

   105

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

   106

// Bitwise read/write macros

   107

   108

#define EC_READ_BIT(PD, CH) (*((uint8_t *) (PD)) >> (CH)) & 0x01)

   109

   110

#define EC_WRITE_BIT(PD, CH, VAL) \

   111

    do { \

   112

        if (VAL) *((uint8_t *) (PD)) |=  (1 << (CH)); \

   113

        else     *((uint8_t *) (PD)) &= ~(1 << (CH)); \

   114

    } while (0)

   115

   116

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

   117

// Read macros

   118

   119

#define EC_READ_U8(PD) ((uint8_t) *((uint8_t *) (PD)))

   120

#define EC_READ_S8(PD) ((int8_t)  *((uint8_t *) (PD)))

   121

   122

#define EC_READ_U16(PD) ((uint16_t) le16_to_cpup((void *) (PD)))

   123

#define EC_READ_S16(PD) ((int16_t)  le16_to_cpup((void *) (PD)))

   124

   125

#define EC_READ_U32(PD) ((uint32_t) le32_to_cpup((void *) (PD)))

   126

#define EC_READ_S32(PD) ((int32_t)  le32_to_cpup((void *) (PD)))

   127

   128

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

   129

// Write macros

   130

   131

#define EC_WRITE_U8(PD, VAL) \

   132

    do { \

   133

        *((uint8_t *)(PD)) = ((uint8_t) (VAL)); \

   134

    } while (0)

   135

   136

#define EC_WRITE_S8(PD, VAL) EC_WRITE_U8(PD, VAL)

   137

   138

#define EC_WRITE_U16(PD, VAL) \

   139

    do { \

   140

        *((uint16_t *) (PD)) = (uint16_t) (VAL); \

   141

        cpu_to_le16s(PD); \

   142

    } while (0)

   143

   144

#define EC_WRITE_S16(PD, VAL) EC_WRITE_U16(PD, VAL)

   145

   146

#define EC_WRITE_U32(PD, VAL) \

   147

    do { \

   148

        *((uint32_t *) (PD)) = (uint32_t) (VAL); \

   149

        cpu_to_le16s(PD); \

   150

    } while (0)

   151

   152

#define EC_WRITE_S32(PD, VAL) EC_WRITE_U32(PD, VAL)

   153

   154

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

   155

   156

#endif