1

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

     2

 *

     3

 *  $Id$

     4

 *

     5

 *  Copyright (C) 2006  Florian Pose, Ingenieurgemeinschaft IgH

     6

 *

     7

 *  This file is part of the IgH EtherCAT Master.

     8

 *

     9

 *  The IgH EtherCAT Master is free software; you can redistribute it

    10

 *  and/or modify it under the terms of the GNU General Public License

    11

 *  as published by the Free Software Foundation; either version 2 of the

    12

 *  License, or (at your option) any later version.

    13

 *

    14

 *  The IgH EtherCAT Master is distributed in the hope that it will be

    15

 *  useful, but WITHOUT ANY WARRANTY; without even the implied warranty of

    16

 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

    17

 *  GNU General Public License for more details.

    18

 *

    19

 *  You should have received a copy of the GNU General Public License

    20

 *  along with the IgH EtherCAT Master; if not, write to the Free Software

    21

 *  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA

    22

 *

    23

 *  The right to use EtherCAT Technology is granted and comes free of

    24

 *  charge under condition of compatibility of product made by

    25

 *  Licensee. People intending to distribute/sell products based on the

    26

 *  code, have to sign an agreement to guarantee that products using

    27

 *  software based on IgH EtherCAT master stay compatible with the actual

    28

 *  EtherCAT specification (which are released themselves as an open

    29

 *  standard) as the (only) precondition to have the right to use EtherCAT

    30

 *  Technology, IP and trade marks.

    31

 *

    32

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

    33

    34

/**

    35

   \file

    36

   EtherCAT domain methods.

    37

*/

    38

    39

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

    40

    41

#include <linux/module.h>

    42

    43

#include "globals.h"

    44

#include "master.h"

    45

#include "slave_config.h"

    46

    47

#include "domain.h"

    48

    49

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

    50

    51

void ec_domain_clear_data(ec_domain_t *);

    52

    53

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

    54

    55

/** Domain constructor.

    56

 */

    57

void ec_domain_init(

    58

        ec_domain_t *domain, /**< EtherCAT domain. */

    59

        ec_master_t *master, /**< Parent master. */

    60

        unsigned int index /**< Index. */

    61

        )

    62

{

    63

    domain->master = master;

    64

    domain->index = index;

    65

    INIT_LIST_HEAD(&domain->fmmu_configs);

    66

    domain->data_size = 0;

    67

    domain->data = NULL;

    68

    domain->data_origin = EC_ORIG_INTERNAL;

    69

    domain->logical_base_address = 0x00000000;

    70

    INIT_LIST_HEAD(&domain->datagrams);

    71

    domain->working_counter = 0x0000;

    72

    domain->expected_working_counter = 0x0000;

    73

    domain->working_counter_changes = 0;

    74

    domain->notify_jiffies = 0;

    75

}

    76

    77

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

    78

    79

/** Domain destructor.

    80

 */

    81

void ec_domain_clear(ec_domain_t *domain /**< EtherCAT domain */)

    82

{

    83

    ec_datagram_t *datagram, *next;

    84

    85

    // dequeue and free datagrams

    86

    list_for_each_entry_safe(datagram, next, &domain->datagrams, list) {

    87

        if (!list_empty(&datagram->queue)) // datagram queued?

    88

            list_del(&datagram->queue);

    89

        ec_datagram_clear(datagram);

    90

        kfree(datagram);

    91

    }

    92

    93

    ec_domain_clear_data(domain);

    94

}

    95

    96

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

    97

    98

/** Frees internally allocated memory.

    99

 */

   100

void ec_domain_clear_data(

   101

        ec_domain_t *domain /**< EtherCAT domain. */

   102

        )

   103

{

   104

    if (domain->data_origin == EC_ORIG_INTERNAL && domain->data)

   105

        kfree(domain->data);

   106

    domain->data = NULL;

   107

    domain->data_origin = EC_ORIG_INTERNAL;

   108

}

   109

   110

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

   111

   112

/** Adds an FMMU configuration to the domain.

   113

 */

   114

void ec_domain_add_fmmu_config(

   115

        ec_domain_t *domain, /**< EtherCAT domain. */

   116

        ec_fmmu_config_t *fmmu /**< FMMU configuration. */

   117

        )

   118

{

   119

    fmmu->domain = domain;

   120

   121

    domain->data_size += fmmu->data_size;

   122

    list_add_tail(&fmmu->list, &domain->fmmu_configs);

   123

   124

    if (domain->master->debug_level)

   125

        EC_DBG("Domain %u: Added %u bytes, total %u.\n", domain->index,

   126

                fmmu->data_size, domain->data_size);

   127

}

   128

   129

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

   130

   131

/** Allocates a domain datagram and appends it to the list.

   132

 *

   133

 * The datagram type and expected working counters are determined by the

   134

 * number of input and output fmmus that share the datagram.

   135

 *

   136

 * \return 0 in case of success, else < 0

   137

 */

   138

int ec_domain_add_datagram(

   139

        ec_domain_t *domain, /**< EtherCAT domain. */

   140

        uint32_t logical_offset, /**< Logical offset. */

   141

        size_t data_size, /**< Size of the data. */

   142

        uint8_t *data, /**< Process data. */

   143

        const unsigned int used[] /**< Used by inputs/outputs. */

   144

        )

   145

{

   146

    ec_datagram_t *datagram;

   147

   148

    if (!(datagram = kmalloc(sizeof(ec_datagram_t), GFP_KERNEL))) {

   149

        EC_ERR("Failed to allocate domain datagram!\n");

   150

        return -1;

   151

    }

   152

   153

    ec_datagram_init(datagram);

   154

    snprintf(datagram->name, EC_DATAGRAM_NAME_SIZE,

   155

            "domain%u-%u", domain->index, logical_offset);

   156

   157

    if (used[EC_DIR_OUTPUT] && used[EC_DIR_INPUT]) { // inputs and outputs

   158

        if (ec_datagram_lrw(datagram, logical_offset, data_size, data)) {

   159

            kfree(datagram);

   160

            return -1;

   161

        }

   162

        // If LRW is used, output FMMUs increment the working counter by 2,

   163

        // while input FMMUs increment it by 1.

   164

        domain->expected_working_counter +=

   165

            used[EC_DIR_OUTPUT] * 2 + used[EC_DIR_INPUT];

   166

    } else if (used[EC_DIR_OUTPUT]) { // outputs only

   167

        if (ec_datagram_lwr(datagram, logical_offset, data_size, data)) {

   168

            kfree(datagram);

   169

            return -1;

   170

        }

   171

        domain->expected_working_counter += used[EC_DIR_OUTPUT];

   172

    } else { // inputs only (or nothing)

   173

        if (ec_datagram_lrd(datagram, logical_offset, data_size, data)) {

   174

            kfree(datagram);

   175

            return -1;

   176

        }

   177

        domain->expected_working_counter += used[EC_DIR_INPUT];

   178

    }

   179

   180

    ec_datagram_zero(datagram);

   181

    list_add_tail(&datagram->list, &domain->datagrams);

   182

    return 0;

   183

}

   184

   185

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

   186

   187

/** Finishes a domain.

   188

 *

   189

 * This allocates the necessary datagrams and writes the correct logical

   190

 * addresses to every configured FMMU.

   191

 *

   192

 * \todo Check for FMMUs that do not fit into any datagram.

   193

 *

   194

 * \retval 0 in case of success

   195

 * \retval <0 on failure.

   196

 */

   197

int ec_domain_finish(

   198

        ec_domain_t *domain, /**< EtherCAT domain. */

   199

        uint32_t base_address /**< Logical base address. */

   200

        )

   201

{

   202

    uint32_t datagram_offset;

   203

    size_t datagram_size;

   204

    unsigned int datagram_count;

   205

    unsigned int datagram_used[EC_DIR_COUNT];

   206

    ec_fmmu_config_t *fmmu;

   207

    const ec_datagram_t *datagram;

   208

   209

    domain->logical_base_address = base_address;

   210

   211

    if (domain->data_size && domain->data_origin == EC_ORIG_INTERNAL) {

   212

        if (!(domain->data =

   213

                    (uint8_t *) kmalloc(domain->data_size, GFP_KERNEL))) {

   214

            EC_ERR("Failed to allocate %u bytes internal memory for"

   215

                    " domain %u!\n", domain->data_size, domain->index);

   216

            return -1;

   217

        }

   218

    }

   219

   220

    // Cycle through all domain FMMUS and

   221

    // - correct the logical base addresses

   222

    // - set up the datagrams to carry the process data

   223

    datagram_offset = 0;

   224

    datagram_size = 0;

   225

    datagram_count = 0;

   226

    datagram_used[EC_DIR_OUTPUT] = 0;

   227

    datagram_used[EC_DIR_INPUT] = 0;

   228

   229

    list_for_each_entry(fmmu, &domain->fmmu_configs, list) {

   230

        // Correct logical FMMU address

   231

        fmmu->logical_start_address += base_address;

   232

   233

        // Increment Input/Output counter to determine datagram types

   234

        // and calculate expected working counters

   235

        datagram_used[fmmu->dir]++;

   236

   237

        // If the current FMMU's data do not fit in the current datagram,

   238

        // allocate a new one.

   239

        if (datagram_size + fmmu->data_size > EC_MAX_DATA_SIZE) {

   240

            if (ec_domain_add_datagram(domain,

   241

                        domain->logical_base_address + datagram_offset,

   242

                        datagram_size, domain->data + datagram_offset,

   243

                        datagram_used))

   244

                return -1;

   245

            datagram_offset += datagram_size;

   246

            datagram_size = 0;

   247

            datagram_count++;

   248

            datagram_used[EC_DIR_OUTPUT] = 0;

   249

            datagram_used[EC_DIR_INPUT] = 0;

   250

        }

   251

   252

        datagram_size += fmmu->data_size;

   253

    }

   254

   255

    // Allocate last datagram, if data are left (this is also the case if the

   256

    // process data fit into a single datagram)

   257

    if (datagram_size) {

   258

        if (ec_domain_add_datagram(domain,

   259

                    domain->logical_base_address + datagram_offset,

   260

                    datagram_size, domain->data + datagram_offset,

   261

                    datagram_used))

   262

            return -1;

   263

        datagram_count++;

   264

    }

   265

   266

    EC_INFO("Domain%u: Logical address 0x%08x, %u byte, "

   267

            "expected working counter %u.\n", domain->index,

   268

            domain->logical_base_address, domain->data_size,

   269

            domain->expected_working_counter);

   270

    list_for_each_entry(datagram, &domain->datagrams, list) {

   271

        EC_INFO("  Datagram %s: Logical offset 0x%08x, %u byte, type %s.\n",

   272

                datagram->name, EC_READ_U32(datagram->address),

   273

                datagram->data_size, ec_datagram_type_string(datagram));

   274

    }

   275

   276

    return 0;

   277

}

   278

   279

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

   280

   281

/** Get the number of FMMU configurations of the domain.

   282

 */

   283

unsigned int ec_domain_fmmu_count(const ec_domain_t *domain)

   284

{

   285

    const ec_fmmu_config_t *fmmu;

   286

    unsigned int num = 0;

   287

   288

    list_for_each_entry(fmmu, &domain->fmmu_configs, list) {

   289

        num++;

   290

    }

   291

   292

    return num;

   293

}

   294

   295

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

   296

   297

/** Get a certain FMMU configuration via its position in the list.

   298

 */

   299

const ec_fmmu_config_t *ec_domain_find_fmmu(

   300

        const ec_domain_t *domain, /**< EtherCAT domain. */

   301

        unsigned int pos /**< List position. */

   302

        )

   303

{

   304

    const ec_fmmu_config_t *fmmu;

   305

   306

    list_for_each_entry(fmmu, &domain->fmmu_configs, list) {

   307

        if (pos--)

   308

            continue;

   309

        return fmmu;

   310

    }

   311

   312

    return NULL;

   313

}

   314

   315

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

   316

 *  Realtime interface

   317

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

   318

   319

int ecrt_domain_reg_pdo_entry_list(ec_domain_t *domain,

   320

        const ec_pdo_entry_reg_t *regs)

   321

{

   322

    const ec_pdo_entry_reg_t *reg;

   323

    ec_slave_config_t *sc;

   324

    int ret;

   325

   326

    if (domain->master->debug_level)

   327

        EC_DBG("ecrt_domain_reg_pdo_entry_list(domain = 0x%x, regs = 0x%x)\n",

   328

                (u32) domain, (u32) regs);

   329

   330

    for (reg = regs; reg->index; reg++) {

   331

        if (!(sc = ecrt_master_slave_config(domain->master, reg->alias,

   332

                        reg->position, reg->vendor_id, reg->product_code)))

   333

            return -1;

   334

   335

        if ((ret = ecrt_slave_config_reg_pdo_entry(sc, reg->index,

   336

                        reg->subindex, domain, reg->bit_position)) < 0)

   337

            return -1;

   338

   339

        *reg->offset = ret;

   340

    }

   341

   342

    return 0;

   343

}

   344

   345

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

   346

   347

size_t ecrt_domain_size(const ec_domain_t *domain)

   348

{

   349

    return domain->data_size;

   350

}

   351

   352

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

   353

   354

void ecrt_domain_external_memory(ec_domain_t *domain, uint8_t *mem)

   355

{

   356

    if (domain->master->debug_level)

   357

        EC_DBG("ecrt_domain_external_memory(domain = 0x%x, mem = 0x%x)\n",

   358

                (u32) domain, (u32) mem);

   359

   360

    down(&domain->master->master_sem);

   361

   362

    ec_domain_clear_data(domain);

   363

   364

    domain->data = mem;

   365

    domain->data_origin = EC_ORIG_EXTERNAL;

   366

   367

    up(&domain->master->master_sem);

   368

}

   369

   370

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

   371

   372

uint8_t *ecrt_domain_data(ec_domain_t *domain)

   373

{

   374

    return domain->data;

   375

}

   376

   377

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

   378

   379

void ecrt_domain_process(ec_domain_t *domain)

   380

{

   381

    uint16_t working_counter_sum;

   382

    ec_datagram_t *datagram;

   383

   384

    working_counter_sum = 0x0000;

   385

    list_for_each_entry(datagram, &domain->datagrams, list) {

   386

        ec_datagram_output_stats(datagram);

   387

        if (datagram->state == EC_DATAGRAM_RECEIVED) {

   388

            working_counter_sum += datagram->working_counter;

   389

        }

   390

    }

   391

   392

    if (working_counter_sum != domain->working_counter) {

   393

        domain->working_counter_changes++;

   394

        domain->working_counter = working_counter_sum;

   395

    }

   396

   397

    if (domain->working_counter_changes &&

   398

        jiffies - domain->notify_jiffies > HZ) {

   399

        domain->notify_jiffies = jiffies;

   400

        if (domain->working_counter_changes == 1) {

   401

            EC_INFO("Domain %u: Working counter changed to %u/%u.\n",

   402

                    domain->index, domain->working_counter,

   403

                    domain->expected_working_counter);

   404

        } else {

   405

            EC_INFO("Domain %u: %u working counter changes - now %u/%u.\n",

   406

                    domain->index, domain->working_counter_changes,

   407

                    domain->working_counter, domain->expected_working_counter);

   408

        }

   409

        domain->working_counter_changes = 0;

   410

    }

   411

}

   412

   413

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

   414

   415

void ecrt_domain_queue(ec_domain_t *domain)

   416

{

   417

    ec_datagram_t *datagram;

   418

   419

    list_for_each_entry(datagram, &domain->datagrams, list) {

   420

        ec_master_queue_datagram(domain->master, datagram);

   421

    }

   422

}

   423

   424

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

   425

   426

void ecrt_domain_state(const ec_domain_t *domain, ec_domain_state_t *state)

   427

{

   428

    state->working_counter = domain->working_counter;

   429

   430

    if (domain->working_counter) {

   431

        if (domain->working_counter == domain->expected_working_counter) {

   432

            state->wc_state = EC_WC_COMPLETE;

   433

        } else {

   434

            state->wc_state = EC_WC_INCOMPLETE;

   435

        }

   436

    } else {

   437

        state->wc_state = EC_WC_ZERO;

   438

    }

   439

}

   440

   441

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

   442

   443

/** \cond */

   444

   445

EXPORT_SYMBOL(ecrt_domain_reg_pdo_entry_list);

   446

EXPORT_SYMBOL(ecrt_domain_size);

   447

EXPORT_SYMBOL(ecrt_domain_external_memory);

   448

EXPORT_SYMBOL(ecrt_domain_data);

   449

EXPORT_SYMBOL(ecrt_domain_process);

   450

EXPORT_SYMBOL(ecrt_domain_queue);

   451

EXPORT_SYMBOL(ecrt_domain_state);

   452

   453

/** \endcond */

   454

   455

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