# HG changeset patch # User Florian Pose # Date 1250771255 -7200 # Node ID 96629de2202b6dc61ac42eceffe38f0fc2238eac # Parent 079de3453c92ee498ed6c39fdf43f9263f6d5b27 Added ecrt_master_deactivate() to remove the bus configuration. diff -r 079de3453c92 -r 96629de2202b TODO --- a/TODO Tue Aug 18 10:30:12 2009 +0200 +++ b/TODO Thu Aug 20 14:27:35 2009 +0200 @@ -52,6 +52,7 @@ * Implement CompleteAccess for SDO uploads. * Implement identifier parameter for cstruct command. * Implement sync delimiter for cstruct command. +* Implement ecrt_master_deactivate() in userspace. Future issues: diff -r 079de3453c92 -r 96629de2202b include/ecrt.h --- a/include/ecrt.h Tue Aug 18 10:30:12 2009 +0200 +++ b/include/ecrt.h Thu Aug 20 14:27:35 2009 +0200 @@ -55,6 +55,7 @@ * ecrt_slave_config_sync_manager()). * - Added ecrt_slave_config_complete_sdo() method to download an SDO during * configuration via CompleteAccess. + * - Added ecrt_master_deactivate() to remove the bus configuration. * - Added ecrt_open_master() and ecrt_master_reserve() separation for * userspace. * - Added bus information interface (methods ecrt_master(), @@ -682,6 +683,18 @@ ec_master_t *master /**< EtherCAT master. */ ); +/** Deactivates the master. + * + * Removes the bus configuration. All objects created by + * ecrt_master_create_domain(), ecrt_master_slave_config(), ecrt_domain_data() + * ecrt_slave_config_create_sdo_request() and + * ecrt_slave_config_create_voe_handler() are freed, so pointers to them + * become invalid. + */ +void ecrt_master_deactivate( + ec_master_t *master /**< EtherCAT master. */ + ); + /** Sends all datagrams in the queue. * * This method takes all datagrams, that have been queued for transmission, diff -r 079de3453c92 -r 96629de2202b master/cdev.c --- a/master/cdev.c Tue Aug 18 10:30:12 2009 +0200 +++ b/master/cdev.c Thu Aug 20 14:27:35 2009 +0200 @@ -175,6 +175,7 @@ data.eoe_handler_count = ec_master_eoe_handler_count(master); #endif data.phase = (uint8_t) master->phase; + data.active = (uint8_t) master->active; data.scan_busy = master->scan_busy; up(&master->master_sem); diff -r 079de3453c92 -r 96629de2202b master/ioctl.h --- a/master/ioctl.h Tue Aug 18 10:30:12 2009 +0200 +++ b/master/ioctl.h Thu Aug 20 14:27:35 2009 +0200 @@ -135,6 +135,7 @@ uint32_t eoe_handler_count; #endif uint8_t phase; + uint8_t active; uint8_t scan_busy; struct { uint8_t address[6]; diff -r 079de3453c92 -r 96629de2202b master/master.c --- a/master/master.c Tue Aug 18 10:30:12 2009 +0200 +++ b/master/master.c Thu Aug 20 14:27:35 2009 +0200 @@ -121,6 +121,7 @@ init_MUTEX(&master->device_sem); master->phase = EC_ORPHANED; + master->active = 0; master->injection_seq_fsm = 0; master->injection_seq_rt = 0; @@ -592,67 +593,17 @@ /** Transition function from OPERATION to IDLE phase. */ -void ec_master_leave_operation_phase(ec_master_t *master - /**< EtherCAT master */) -{ - ec_slave_t *slave; -#ifdef EC_EOE - ec_eoe_t *eoe; -#endif +void ec_master_leave_operation_phase( + ec_master_t *master /**< EtherCAT master */ + ) +{ + if (master->active) + ecrt_master_deactivate(master); if (master->debug_level) EC_DBG("OPERATION -> IDLE.\n"); master->phase = EC_IDLE; - -#ifdef EC_EOE - ec_master_eoe_stop(master); -#endif - ec_master_thread_stop(master); - - master->send_cb = ec_master_internal_send_cb; - master->receive_cb = ec_master_internal_receive_cb; - master->cb_data = master; - - down(&master->master_sem); - ec_master_clear_domains(master); - ec_master_clear_slave_configs(master); - up(&master->master_sem); - - for (slave = master->slaves; - slave < master->slaves + master->slave_count; - slave++) { - - // set states for all slaves - ec_slave_request_state(slave, EC_SLAVE_STATE_PREOP); - - // mark for reconfiguration, because the master could have no - // possibility for a reconfiguration between two sequential operation - // phases. - slave->force_config = 1; - } - -#ifdef EC_EOE - // ... but leave EoE slaves in OP - list_for_each_entry(eoe, &master->eoe_handlers, list) { - if (ec_eoe_is_open(eoe)) - ec_slave_request_state(eoe->slave, EC_SLAVE_STATE_OP); - } -#endif - - master->app_time = 0ULL; - master->app_start_time = 0ULL; - master->has_start_time = 0; - - if (ec_master_thread_start(master, ec_master_idle_thread, - "EtherCAT-IDLE")) - EC_WARN("Failed to restart master thread!\n"); -#ifdef EC_EOE - ec_master_eoe_start(master); -#endif - - master->allow_scan = 1; - master->allow_config = 1; } /*****************************************************************************/ @@ -1635,6 +1586,11 @@ if (master->debug_level) EC_DBG("ecrt_master_activate(master = 0x%x)\n", (u32) master); + if (master->active) { + EC_WARN("%s: Master already active!\n", __func__); + return 0; + } + down(&master->master_sem); // finish all domains @@ -1684,11 +1640,80 @@ master->allow_config = 1; // request the current configuration master->allow_scan = 1; // allow re-scanning on topology change + master->active = 1; return 0; } /*****************************************************************************/ +void ecrt_master_deactivate(ec_master_t *master) +{ + ec_slave_t *slave; +#ifdef EC_EOE + ec_eoe_t *eoe; +#endif + + if (master->debug_level) + EC_DBG("ecrt_master_deactivate(master = 0x%x)\n", (u32) master); + + if (!master->active) { + EC_WARN("%s: Master not active.\n", __func__); + return; + } + +#ifdef EC_EOE + ec_master_eoe_stop(master); +#endif + ec_master_thread_stop(master); + + master->send_cb = ec_master_internal_send_cb; + master->receive_cb = ec_master_internal_receive_cb; + master->cb_data = master; + + down(&master->master_sem); + ec_master_clear_domains(master); + ec_master_clear_slave_configs(master); + up(&master->master_sem); + + for (slave = master->slaves; + slave < master->slaves + master->slave_count; + slave++) { + + // set states for all slaves + ec_slave_request_state(slave, EC_SLAVE_STATE_PREOP); + + // mark for reconfiguration, because the master could have no + // possibility for a reconfiguration between two sequential operation + // phases. + slave->force_config = 1; + } + +#ifdef EC_EOE + // ... but leave EoE slaves in OP + list_for_each_entry(eoe, &master->eoe_handlers, list) { + if (ec_eoe_is_open(eoe)) + ec_slave_request_state(eoe->slave, EC_SLAVE_STATE_OP); + } +#endif + + master->app_time = 0ULL; + master->app_start_time = 0ULL; + master->has_start_time = 0; + + if (ec_master_thread_start(master, ec_master_idle_thread, + "EtherCAT-IDLE")) + EC_WARN("Failed to restart master thread!\n"); +#ifdef EC_EOE + ec_master_eoe_start(master); +#endif + + master->allow_scan = 1; + master->allow_config = 1; + master->active = 0; +} + +/*****************************************************************************/ + void ecrt_master_send(ec_master_t *master) { ec_datagram_t *datagram, *n; @@ -1903,6 +1928,7 @@ EXPORT_SYMBOL(ecrt_master_create_domain); EXPORT_SYMBOL(ecrt_master_activate); +EXPORT_SYMBOL(ecrt_master_deactivate); EXPORT_SYMBOL(ecrt_master_send); EXPORT_SYMBOL(ecrt_master_send_ext); EXPORT_SYMBOL(ecrt_master_receive); diff -r 079de3453c92 -r 96629de2202b master/master.h --- a/master/master.h Tue Aug 18 10:30:12 2009 +0200 +++ b/master/master.h Thu Aug 20 14:27:35 2009 +0200 @@ -108,6 +108,7 @@ ec_fsm_master_t fsm; /**< Master state machine. */ ec_datagram_t fsm_datagram; /**< Datagram used for state machines. */ ec_master_phase_t phase; /**< Master phase. */ + unsigned int active; /**< Master has been activated. */ unsigned int injection_seq_fsm; /**< Datagram injection sequence number for the FSM side. */ unsigned int injection_seq_rt; /**< Datagram injection sequence number diff -r 079de3453c92 -r 96629de2202b tool/CommandMaster.cpp --- a/tool/CommandMaster.cpp Tue Aug 18 10:30:12 2009 +0200 +++ b/tool/CommandMaster.cpp Thu Aug 20 14:27:35 2009 +0200 @@ -91,6 +91,7 @@ } cout << endl + << " Active: " << (data.active ? "yes" : "no") << endl << " Slaves: " << data.slave_count << endl << " Ethernet devices:" << endl;