equal
deleted
inserted
replaced
583 /*****************************************************************************/ |
583 /*****************************************************************************/ |
584 |
584 |
585 void ecrt_domain_queue(ec_domain_t *domain) |
585 void ecrt_domain_queue(ec_domain_t *domain) |
586 { |
586 { |
587 ec_datagram_pair_t *datagram_pair; |
587 ec_datagram_pair_t *datagram_pair; |
588 unsigned int dev_idx; |
588 ec_device_index_t dev_idx; |
589 |
589 |
590 list_for_each_entry(datagram_pair, &domain->datagram_pairs, list) { |
590 list_for_each_entry(datagram_pair, &domain->datagram_pairs, list) { |
591 |
591 |
592 /* copy main data to send buffer */ |
592 /* copy main data to send buffer */ |
593 memcpy(datagram_pair->send_buffer, |
593 memcpy(datagram_pair->send_buffer, |
597 /* copy main data to backup datagram */ |
597 /* copy main data to backup datagram */ |
598 memcpy(datagram_pair->datagrams[EC_DEVICE_BACKUP].data, |
598 memcpy(datagram_pair->datagrams[EC_DEVICE_BACKUP].data, |
599 datagram_pair->datagrams[EC_DEVICE_MAIN].data, |
599 datagram_pair->datagrams[EC_DEVICE_MAIN].data, |
600 datagram_pair->datagrams[EC_DEVICE_MAIN].data_size); |
600 datagram_pair->datagrams[EC_DEVICE_MAIN].data_size); |
601 |
601 |
602 for (dev_idx = 0; dev_idx < EC_NUM_DEVICES; dev_idx++) { |
602 for (dev_idx = EC_DEVICE_MAIN; dev_idx < EC_NUM_DEVICES; dev_idx++) { |
603 ec_master_queue_datagram(domain->master, |
603 ec_master_queue_datagram(domain->master, |
604 &datagram_pair->datagrams[dev_idx], dev_idx); |
604 &datagram_pair->datagrams[dev_idx]); |
605 } |
605 } |
606 } |
606 } |
607 } |
607 } |
608 |
608 |
609 /*****************************************************************************/ |
609 /*****************************************************************************/ |