master/fsm_coe.c
changeset 459 f0da52cf6b5b
parent 446 8fede404c01f
child 461 b9eda9235173
equal deleted inserted replaced
458:6467f0f6e370 459:f0da52cf6b5b
   850     ec_datagram_t *datagram = fsm->datagram;
   850     ec_datagram_t *datagram = fsm->datagram;
   851     ec_slave_t *slave = fsm->slave;
   851     ec_slave_t *slave = fsm->slave;
   852     ec_sdo_data_t *sdodata = fsm->sdodata;
   852     ec_sdo_data_t *sdodata = fsm->sdodata;
   853     uint8_t *data;
   853     uint8_t *data;
   854 
   854 
   855     EC_INFO("Downloading SDO 0x%04X:%i to slave %i.\n",
   855     if (fsm->slave->master->debug_level)
   856             sdodata->index, sdodata->subindex, slave->ring_position);
   856         EC_DBG("Downloading SDO 0x%04X:%i to slave %i.\n",
       
   857                sdodata->index, sdodata->subindex, slave->ring_position);
   857 
   858 
   858     if (slave->sii_rx_mailbox_size < 6 + 10 + sdodata->size) {
   859     if (slave->sii_rx_mailbox_size < 6 + 10 + sdodata->size) {
   859         EC_ERR("SDO fragmenting not supported yet!\n");
   860         EC_ERR("SDO fragmenting not supported yet!\n");
   860         fsm->state = ec_fsm_coe_error;
   861         fsm->state = ec_fsm_coe_error;
   861         return;
   862         return;
  1027     ec_sdo_request_t *request = fsm->request;
  1028     ec_sdo_request_t *request = fsm->request;
  1028     ec_sdo_t *sdo = request->sdo;
  1029     ec_sdo_t *sdo = request->sdo;
  1029     ec_sdo_entry_t *entry = request->entry;
  1030     ec_sdo_entry_t *entry = request->entry;
  1030     uint8_t *data;
  1031     uint8_t *data;
  1031 
  1032 
  1032     EC_INFO("Uploading SDO 0x%04X:%i from slave %i.\n",
  1033     if (master->debug_level)
  1033             sdo->index, entry->subindex, slave->ring_position);
  1034         EC_DBG("Uploading SDO 0x%04X:%i from slave %i.\n",
       
  1035                sdo->index, entry->subindex, slave->ring_position);
  1034 
  1036 
  1035     if (!(data = ec_slave_mbox_prepare_send(slave, datagram, 0x03, 6))) {
  1037     if (!(data = ec_slave_mbox_prepare_send(slave, datagram, 0x03, 6))) {
  1036         fsm->state = ec_fsm_coe_error;
  1038         fsm->state = ec_fsm_coe_error;
  1037         return;
  1039         return;
  1038     }
  1040     }