1

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

     2

 *

     3

 *  d o m a i n . c

     4

 *

     5

 *  Methoden für Gruppen von EtherCAT-Slaves.

     6

 *

     7

 *  $Id$

     8

 *

     9

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

    10

    11

#include "globals.h"

    12

#include "domain.h"

    13

#include "master.h"

    14

    15

void ec_domain_clear_field_regs(ec_domain_t *);

    16

    17

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

    18

    19

/**

    20

   Konstruktor einer EtherCAT-Domäne.

    21

*/

    22

    23

void ec_domain_init(ec_domain_t *domain, /**< Domäne */

    24

                    ec_master_t *master /**< Zugehöriger Master */

    25

                    )

    26

{

    27

    domain->master = master;

    28

    domain->data_size = 0;

    29

    domain->base_address = 0;

    30

    domain->response_count = 0xFFFFFFFF;

    31

    32

    INIT_LIST_HEAD(&domain->field_regs);

    33

    INIT_LIST_HEAD(&domain->commands);

    34

}

    35

    36

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

    37

    38

/**

    39

   Destruktor einer EtherCAT-Domäne.

    40

*/

    41

    42

void ec_domain_clear(ec_domain_t *domain /**< Domäne */)

    43

{

    44

    ec_command_t *command, *next;

    45

    46

    list_for_each_entry_safe(command, next, &domain->commands, list) {

    47

        ec_command_clear(command);

    48

        kfree(command);

    49

    }

    50

    51

    ec_domain_clear_field_regs(domain);

    52

}

    53

    54

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

    55

    56

/**

    57

   Registriert ein Feld in einer Domäne.

    58

    59

   \return 0 bei Erfolg, < 0 bei Fehler

    60

*/

    61

    62

int ec_domain_reg_field(ec_domain_t *domain, /**< Domäne */

    63

                        ec_slave_t *slave, /**< Slave */

    64

                        const ec_sync_t *sync, /**< Sync-Manager */

    65

                        uint32_t field_offset, /**< Datenfeld-Offset */

    66

                        void **data_ptr /**< Adresse des Prozessdatenzeigers */

    67

                        )

    68

{

    69

    ec_field_reg_t *field_reg;

    70

    71

    if (!(field_reg =

    72

          (ec_field_reg_t *) kmalloc(sizeof(ec_field_reg_t), GFP_KERNEL))) {

    73

        EC_ERR("Failed to allocate field registration.\n");

    74

        return -1;

    75

    }

    76

    77

    if (ec_slave_set_fmmu(slave, domain, sync)) {

    78

        EC_ERR("FMMU configuration failed.\n");

    79

        kfree(field_reg);

    80

        return -1;

    81

    }

    82

    83

    field_reg->slave = slave;

    84

    field_reg->sync = sync;

    85

    field_reg->field_offset = field_offset;

    86

    field_reg->data_ptr = data_ptr;

    87

    88

    list_add_tail(&field_reg->list, &domain->field_regs);

    89

    90

    return 0;

    91

}

    92

    93

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

    94

    95

/**

    96

   Gibt die Liste der registrierten Datenfelder frei.

    97

*/

    98

    99

void ec_domain_clear_field_regs(ec_domain_t *domain)

   100

{

   101

    ec_field_reg_t *field_reg, *next;

   102

   103

    list_for_each_entry_safe(field_reg, next, &domain->field_regs, list) {

   104

        list_del(&field_reg->list);

   105

        kfree(field_reg);

   106

    }

   107

}

   108

   109

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

   110

   111

/**

   112

   Alloziert ein Prozessdatenkommando und fügt es in die Liste ein.

   113

*/

   114

   115

int ec_domain_add_command(ec_domain_t *domain, /**< Domäne */

   116

                          uint32_t offset, /**< Logisches Offset */

   117

                          size_t data_size /**< Größe der Kommando-Daten */

   118

                          )

   119

{

   120

    ec_command_t *command;

   121

   122

    if (!(command = kmalloc(sizeof(ec_command_t), GFP_KERNEL))) {

   123

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

   124

        return -1;

   125

    }

   126

   127

    ec_command_init(command);

   128

   129

    if (ec_command_lrw(command, offset, data_size)) {

   130

        kfree(command);

   131

        return -1;

   132

    }

   133

   134

    list_add_tail(&command->list, &domain->commands);

   135

    return 0;

   136

}

   137

   138

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

   139

   140

/**

   141

   Erzeugt eine Domäne.

   142

   143

   Reserviert den Speicher einer Domäne, berechnet die logischen Adressen der

   144

   FMMUs und setzt die Prozessdatenzeiger der registrierten Felder.

   145

   146

   \return 0 bei Erfolg, < 0 bei Fehler

   147

*/

   148

   149

int ec_domain_alloc(ec_domain_t *domain, /**< Domäne */

   150

                    uint32_t base_address /**< Logische Basisadresse */

   151

                    )

   152

{

   153

    ec_field_reg_t *field_reg;

   154

    ec_slave_t *slave;

   155

    ec_fmmu_t *fmmu;

   156

    unsigned int i, j, cmd_count;

   157

    uint32_t field_off, field_off_cmd;

   158

    uint32_t cmd_offset;

   159

    size_t cmd_data_size;

   160

    ec_command_t *command;

   161

   162

    domain->base_address = base_address;

   163

   164

    // Größe der Prozessdaten berechnen und Kommandos allozieren

   165

    domain->data_size = 0;

   166

    cmd_offset = base_address;

   167

    cmd_data_size = 0;

   168

    cmd_count = 0;

   169

    for (i = 0; i < domain->master->slave_count; i++) {

   170

        slave = &domain->master->slaves[i];

   171

        for (j = 0; j < slave->fmmu_count; j++) {

   172

            fmmu = &slave->fmmus[j];

   173

            if (fmmu->domain == domain) {

   174

                fmmu->logical_start_address = base_address + domain->data_size;

   175

                domain->data_size += fmmu->sync->size;

   176

                if (cmd_data_size + fmmu->sync->size > EC_MAX_DATA_SIZE) {

   177

                    if (ec_domain_add_command(domain, cmd_offset,

   178

                                              cmd_data_size)) return -1;

   179

                    cmd_offset += cmd_data_size;

   180

                    cmd_data_size = 0;

   181

                    cmd_count++;

   182

                }

   183

                cmd_data_size += fmmu->sync->size;

   184

            }

   185

        }

   186

    }

   187

   188

    // Letztes Kommando allozieren

   189

    if (cmd_data_size) {

   190

        if (ec_domain_add_command(domain, cmd_offset, cmd_data_size))

   191

            return -1;

   192

        cmd_count++;

   193

    }

   194

   195

    if (!cmd_count) {

   196

        EC_WARN("Domain 0x%08X contains no data!\n", (u32) domain);

   197

        ec_domain_clear_field_regs(domain);

   198

        return 0;

   199

    }

   200

   201

    // Alle Prozessdatenzeiger setzen

   202

    list_for_each_entry(field_reg, &domain->field_regs, list) {

   203

        for (i = 0; i < field_reg->slave->fmmu_count; i++) {

   204

            fmmu = &field_reg->slave->fmmus[i];

   205

            if (fmmu->domain == domain && fmmu->sync == field_reg->sync) {

   206

                field_off = fmmu->logical_start_address +

   207

                    field_reg->field_offset;

   208

                // Kommando suchen

   209

                list_for_each_entry(command, &domain->commands, list) {

   210

                    field_off_cmd = field_off - command->address.logical;

   211

                    if (field_off >= command->address.logical &&

   212

                        field_off_cmd < command->mem_size) {

   213

                        *field_reg->data_ptr = command->data + field_off_cmd;

   214

                    }

   215

                }

   216

                if (!field_reg->data_ptr) {

   217

                    EC_ERR("Failed to assign data pointer!\n");

   218

                    return -1;

   219

                }

   220

                break;

   221

            }

   222

        }

   223

    }

   224

   225

    EC_INFO("Domain %X - Allocated %i bytes in %i command(s)\n",

   226

            (u32) domain, domain->data_size, cmd_count);

   227

   228

    ec_domain_clear_field_regs(domain);

   229

   230

    return 0;

   231

}

   232

   233

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

   234

   235

/**

   236

   Gibt die Anzahl der antwortenden Slaves aus.

   237

*/

   238

   239

void ec_domain_response_count(ec_domain_t *domain, /**< Domäne */

   240

                              unsigned int count /**< Neue Anzahl */

   241

                              )

   242

{

   243

    if (count != domain->response_count) {

   244

        domain->response_count = count;

   245

        EC_INFO("Domain %08X state change - %i slave%s responding.\n",

   246

                (u32) domain, count, count == 1 ? "" : "s");

   247

    }

   248

}

   249

   250

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

   251

 *

   252

 * Echtzeitschnittstelle

   253

 *

   254

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

   255

   256

/**

   257

   Registriert ein Datenfeld innerhalb einer Domäne.

   258

   259

   - Ist \a data_ptr NULL, so wird der Slave nur auf den Typ überprüft.

   260

   - Wenn \a field_count 0 ist, wird angenommen, dass 1 Feld registriert werden

   261

     soll.

   262

   - Wenn \a field_count größer als 1 ist, wird angenommen, dass \a data_ptr

   263

     auf ein entsprechend großes Array zeigt.

   264

   265

   \return Zeiger auf den Slave bei Erfolg, sonst NULL

   266

*/

   267

   268

ec_slave_t *ecrt_domain_register_field(ec_domain_t *domain,

   269

                                       /**< Domäne */

   270

                                       const char *address,

   271

                                       /**< ASCII-Addresse des Slaves,

   272

                                          siehe ecrt_master_get_slave() */

   273

                                       const char *vendor_name,

   274

                                       /**< Herstellername */

   275

                                       const char *product_name,

   276

                                       /**< Produktname */

   277

                                       void **data_ptr,

   278

                                       /**< Adresse des Zeigers auf die

   279

                                          Prozessdaten */

   280

                                       const char *field_name,

   281

                                       /**< Name des Datenfeldes */

   282

                                       unsigned int field_index,

   283

                                       /**< Gibt an, ab welchem Feld mit

   284

                                          Typ \a field_type gezählt

   285

                                          werden soll. */

   286

                                       unsigned int field_count

   287

                                       /**< Anzahl Felder selben Typs */

   288

                                       )

   289

{

   290

    ec_slave_t *slave;

   291

    const ec_slave_type_t *type;

   292

    ec_master_t *master;

   293

    const ec_sync_t *sync;

   294

    const ec_field_t *field;

   295

    unsigned int field_counter, i, j, orig_field_index, orig_field_count;

   296

    uint32_t field_offset;

   297

   298

    master = domain->master;

   299

   300

    // Adresse übersetzen

   301

    if (!(slave = ecrt_master_get_slave(master, address))) return NULL;

   302

   303

    if (!(type = slave->type)) {

   304

        EC_ERR("Slave \"%s\" (position %i) has unknown type!\n", address,

   305

               slave->ring_position);

   306

        return NULL;

   307

    }

   308

   309

    if (strcmp(vendor_name, type->vendor_name) ||

   310

        strcmp(product_name, type->product_name)) {

   311

        EC_ERR("Invalid slave type at position %i - Requested: \"%s %s\","

   312

               " found: \"%s %s\".\n", slave->ring_position, vendor_name,

   313

               product_name, type->vendor_name, type->product_name);

   314

        return NULL;

   315

    }

   316

   317

    if (!data_ptr) {

   318

        // Wenn data_ptr NULL, Slave als registriert ansehen (nicht warnen).

   319

        slave->registered = 1;

   320

    }

   321

   322

    if (!field_count) field_count = 1;

   323

    orig_field_index = field_index;

   324

    orig_field_count = field_count;

   325

   326

    field_counter = 0;

   327

    for (i = 0; type->sync_managers[i]; i++) {

   328

        sync = type->sync_managers[i];

   329

        field_offset = 0;

   330

        for (j = 0; sync->fields[j]; j++) {

   331

            field = sync->fields[j];

   332

            if (!strcmp(field->name, field_name)) {

   333

                if (field_counter++ == field_index) {

   334

                    if (data_ptr)

   335

                        ec_domain_reg_field(domain, slave, sync, field_offset,

   336

                                            data_ptr++);

   337

                    if (!(--field_count)) return slave;

   338

                    field_index++;

   339

                }

   340

            }

   341

            field_offset += field->size;

   342

        }

   343

    }

   344

   345

    EC_ERR("Slave %i (\"%s %s\") registration mismatch: Field \"%s\","

   346

           " index %i, count %i.\n", slave->ring_position, vendor_name,

   347

           product_name, field_name, orig_field_index, orig_field_count);

   348

    return NULL;

   349

}

   350

   351

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

   352

   353

/**

   354

   Registriert eine ganze Liste von Datenfeldern innerhalb einer Domäne.

   355

   356

   Achtung: Die Liste muss mit einer NULL-Struktur ({}) abgeschlossen sein!

   357

   358

   \return 0 bei Erfolg, sonst < 0

   359

*/

   360

   361

int ecrt_domain_register_field_list(ec_domain_t *domain,

   362

                                    /**< Domäne */

   363

                                    ec_field_init_t *fields

   364

                                    /**< Array mit Datenfeldern */

   365

                                    )

   366

{

   367

    ec_field_init_t *field;

   368

   369

    for (field = fields; field->slave_address; field++)

   370

        if (!ecrt_domain_register_field(domain, field->slave_address,

   371

                                        field->vendor_name,

   372

                                        field->product_name, field->data_ptr,

   373

                                        field->field_name, field->field_index,

   374

                                        field->field_count))

   375

            return -1;

   376

   377

    return 0;

   378

}

   379

   380

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

   381

   382

/**

   383

   Setzt Prozessdaten-Kommandos in die Warteschlange des Masters.

   384

*/

   385

   386

void ecrt_domain_queue(ec_domain_t *domain /**< Domäne */)

   387

{

   388

    ec_command_t *command;

   389

   390

    list_for_each_entry(command, &domain->commands, list) {

   391

        ec_master_queue_command(domain->master, command);

   392

    }

   393

}

   394

   395

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

   396

   397

/**

   398

   Verarbeitet empfangene Prozessdaten.

   399

*/

   400

   401

void ecrt_domain_process(ec_domain_t *domain /**< Domäne */)

   402

{

   403

    unsigned int working_counter_sum;

   404

    ec_command_t *command;

   405

   406

    working_counter_sum = 0;

   407

   408

    list_for_each_entry(command, &domain->commands, list) {

   409

        if (command->state == EC_CMD_RECEIVED) {

   410

            working_counter_sum += command->working_counter;

   411

        }

   412

    }

   413

   414

    ec_domain_response_count(domain, working_counter_sum);

   415

}

   416

   417

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

   418

   419

/**

   420

   Gibt den Status einer Domäne zurück.

   421

   422

   \return 0 wenn alle Kommandos empfangen wurden, sonst -1.

   423

*/

   424

   425

int ecrt_domain_state(ec_domain_t *domain /**< Domäne */)

   426

{

   427

    ec_command_t *command;

   428

   429

    list_for_each_entry(command, &domain->commands, list) {

   430

        if (command->state != EC_CMD_RECEIVED) return -1;

   431

    }

   432

   433

    return 0;

   434

}

   435

   436

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

   437

   438

EXPORT_SYMBOL(ecrt_domain_register_field);

   439

EXPORT_SYMBOL(ecrt_domain_register_field_list);

   440

EXPORT_SYMBOL(ecrt_domain_queue);

   441

EXPORT_SYMBOL(ecrt_domain_process);

   442

EXPORT_SYMBOL(ecrt_domain_state);

   443

   444

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

   445

   446

/* Emacs-Konfiguration

   447

;;; Local Variables: ***

   448

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

   449

;;; End: ***

   450

*/