ethercat master用户程序初始化

（1）定义配置信息 

键入命令：ethercat cstruct 得到从机的配置信息，复制下来（我用的从机是简单的io开发板）

信息如下：

chenpeng@chenpeng-M219F-6C:/lib/modules$ ethercat cstruct
/* Master 0, Slave 0, "ServoDrive_FSMC"* Vendor ID:       0x00000009* Product code:    0x26483052* Revision number: 0x00020111*/ec_pdo_entry_info_t slave_0_pdo_entries[] = {{0x7010, 0x01, 1}, /* LED 1 */{0x7010, 0x02, 1}, /* LED 2 */{0x7010, 0x03, 1}, /* LED 3 */{0x7010, 0x04, 1}, /* LED 4 */{0x7010, 0x05, 1}, /* LED 5 */{0x7010, 0x06, 1}, /* LED 6 */{0x7010, 0x07, 1}, /* LED 7 */{0x7010, 0x08, 1}, /* LED 8 */{0x0000, 0x00, 8}, /* Gap */{0x7011, 0x00, 32}, /* Var0x7011_OUTPUTS */{0x6000, 0x01, 1}, /* Switch 1 */{0x6000, 0x02, 1}, /* Switch 2 */{0x6000, 0x03, 1}, /* Switch 3 */{0x6000, 0x04, 1}, /* Switch 4 */{0x6000, 0x05, 1}, /* Switch 5 */{0x6000, 0x06, 1}, /* Switch 6 */{0x6000, 0x07, 1}, /* Switch 7 */{0x6000, 0x08, 1}, /* Switch 8 */{0x0000, 0x00, 8}, /* Gap */{0x6020, 0x01, 1}, /* Underrange */{0x6020, 0x02, 1}, /* Overrange */{0x6020, 0x03, 2}, /* Limit 1 */{0x6020, 0x05, 2}, /* Limit 2 */{0x0000, 0x00, 8}, /* Gap */{0x1802, 0x07, 1}, /* TxPDOState */{0x1802, 0x09, 1}, /* TxPDO Toggle */{0x6020, 0x11, 16}, /* Analog input */
};ec_pdo_info_t slave_0_pdos[] = {{0x1601, 10, slave_0_pdo_entries + 0}, /* DO RxPDO-Map */{0x1a00, 9, slave_0_pdo_entries + 10}, /* DI TxPDO-Map */{0x1a02, 8, slave_0_pdo_entries + 19}, /* AI TxPDO-Map */
};ec_sync_info_t slave_0_syncs[] = {{0, EC_DIR_OUTPUT, 0, NULL, EC_WD_DISABLE},{1, EC_DIR_INPUT, 0, NULL, EC_WD_DISABLE},{2, EC_DIR_OUTPUT, 1, slave_0_pdos + 0, EC_WD_ENABLE},{3, EC_DIR_INPUT, 2, slave_0_pdos + 1, EC_WD_DISABLE},{0xff}
};

自己再定义需要注册的pdo entry

我的是：

const static ec_pdo_entry_reg_t domain1_regs[] = {{IO_OPS, IO_INFO, 0x7010, 0x01, &off_led1,&off_led1_bit},{IO_OPS, IO_INFO, 0x7010, 0x02, &off_led2,&off_led2_bit},{IO_OPS, IO_INFO, 0x7010, 0x03, &off_led3,&off_led3_bit},{IO_OPS, IO_INFO, 0x7010, 0x04, &off_led4,&off_led4_bit},{IO_OPS, IO_INFO, 0x7010, 0x05, &off_led5,&off_led5_bit},{IO_OPS, IO_INFO, 0x7010, 0x06, &off_led6,&off_led6_bit},{IO_OPS, IO_INFO, 0x7010, 0x07, &off_led7,&off_led7_bit},{IO_OPS, IO_INFO, 0x7010, 0x08, &off_led8,&off_led8_bit},{IO_OPS, IO_INFO, 0x6000, 0x01, &off_switch1,&off_switch1_bit},{IO_OPS, IO_INFO, 0x6000, 0x02, &off_switch2,&off_switch2_bit},{IO_OPS, IO_INFO, 0x6000, 0x03, &off_switch3,&off_switch3_bit},{IO_OPS, IO_INFO, 0x6000, 0x04, &off_switch4,&off_switch4_bit},{IO_OPS, IO_INFO, 0x6000, 0x05, &off_switch5,&off_switch5_bit},{IO_OPS, IO_INFO, 0x6000, 0x06, &off_switch6,&off_switch6_bit},{IO_OPS, IO_INFO, 0x6000, 0x07, &off_switch7,&off_switch7_bit},{IO_OPS, IO_INFO, 0x6000, 0x08, &off_switch8,&off_switch8_bit},{}
};

（2）程序初始化

在实时操作系统中请求一个master

master	  = ecrt_request_master( 0 );if(master == NULL) goto error_out;printf("master found\n");

创建新的过程数据domain,domain用来注册pods以及在循环周期中交换pdos的。

domain  = ecrt_master_create_domain(master);if (!domain) {printf("config domain failed\n");return 0;}

创建从机配置信息

slave   = ecrt_master_slave_config(master,0,0,IO_INFO);if (!slave) {printf("config slave failed\n");return 0;}

指定一个完整的pdo配置信息

if (ecrt_slave_config_pdos(slave, EC_END, slave_0_syncs)){fprintf(stderr, "Failed to configure PDOs.\n");return 1;}

把pdo的entry注册到domain中去

if (ecrt_domain_reg_pdo_entry_list(domain, domain1_regs)) {fprintf(stderr, "PDO entry registration failed!\n" );return 1;}

激活master

if ( ecrt_master_activate((ec_master_t*)master) )return -1;

获取被映射的domain内存（在用户空间中，必须在激活master后来调用他）

if (!(domain_pd = ecrt_domain_data(domain))) {fprintf(stderr, "config Domain Data failed!\n" );return 1;}

执行周期任务

 while (1) {usleep( 1 );cyclic_task(master,domain,&(domain_pd));}

周期任务，仅当参考

void cyclic_task(ec_master_t* master,ec_domain_t* domain1, uint8_t **domain1_pd )
{static unsigned int counter = 0;/* receive process data */ecrt_master_receive(master);ecrt_domain_process(domain1);if (counter) {counter--;} else { /* do this at 1 Hz */counter = FREQUENCY;/* read process data */printf("SWITCH = %d ,  %d , %d\n",EC_READ_U8(*domain1_pd + off_switch1),EC_READ_U8(*domain1_pd + off_switch2),EC_READ_U8(*domain1_pd + off_switch3));printf( "LED= %d ,  %d , %d\n",EC_READ_U8(*domain1_pd + off_led1),EC_READ_U8(*domain1_pd + off_led2),EC_READ_U8(*domain1_pd + off_led3));}/* send process data */EC_WRITE_U8(*domain1_pd + off_led1,0x20);ecrt_domain_queue(domain1);ecrt_master_send(master);
}

本文来自互联网用户投稿，文章观点仅代表作者本人，不代表本站立场，不承担相关法律责任。如若转载，请注明出处。 如若内容造成侵权/违法违规/事实不符，请点击【内容举报】进行投诉反馈！