ln-dotnet
/
SOEM
3
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

improve groups, make memory usage more efficient, fix erroneous byte calculations and dc frame handling

pull/260/head
Andreas Karlsson 2019-03-08 16:35:16 +01:00
parent 8832ef0f2f
commit 930d6e07c8
4 changed files with 47 additions and 15 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

55
soem/ethercatconfig.c
View File

@ -111,7 +111,8 @@ void ecx_init_context(ecx_contextt *context)
ecx_siigetbyte(context, 0, EC_MAXEEPBUF); ecx_siigetbyte(context, 0, EC_MAXEEPBUF);
for(lp = 0; lp < context->maxgroup; lp++) for(lp = 0; lp < context->maxgroup; lp++)
{ {
context->grouplist[lp].logstartaddr = lp << 16; /* default start address per group entry */ /* default start address per group entry */
context->grouplist[lp].logstartaddr = lp << EC_LOGGROUPOFFSET;
} }
} }
@ -992,8 +993,19 @@ static void ecx_config_create_input_mappings(ecx_contextt *context, void *pIOmap
} }
if (!context->slavelist[slave].inputs) if (!context->slavelist[slave].inputs)
{ {
context->slavelist[slave].inputs = if (group)
(uint8 *)(pIOmap)+etohl(context->slavelist[slave].FMMU[FMMUc].LogStart); {
context->slavelist[slave].inputs =
(uint8 *)(pIOmap) +
etohl(context->slavelist[slave].FMMU[FMMUc].LogStart) -
context->grouplist[group].logstartaddr;
}
else
{
context->slavelist[slave].inputs =
(uint8 *)(pIOmap) +
etohl(context->slavelist[slave].FMMU[FMMUc].LogStart);
}
context->slavelist[slave].Istartbit = context->slavelist[slave].Istartbit =
context->slavelist[slave].FMMU[FMMUc].LogStartbit; context->slavelist[slave].FMMU[FMMUc].LogStartbit;
EC_PRINT(" Inputs %p startbit %d\n", EC_PRINT(" Inputs %p startbit %d\n",
@ -1109,8 +1121,19 @@ static void ecx_config_create_output_mappings(ecx_contextt *context, void *pIOma
context->grouplist[group].outputsWKC++; context->grouplist[group].outputsWKC++;
if (!context->slavelist[slave].outputs) if (!context->slavelist[slave].outputs)
{ {
context->slavelist[slave].outputs = if (group)
(uint8 *)(pIOmap)+etohl(context->slavelist[slave].FMMU[FMMUc].LogStart); {
context->slavelist[slave].outputs =
(uint8 *)(pIOmap) +
etohl(context->slavelist[slave].FMMU[FMMUc].LogStart) -
context->grouplist[group].logstartaddr;
}
else
{
context->slavelist[slave].outputs =
(uint8 *)(pIOmap) +
etohl(context->slavelist[slave].FMMU[FMMUc].LogStart);
}
context->slavelist[slave].Ostartbit = context->slavelist[slave].Ostartbit =
context->slavelist[slave].FMMU[FMMUc].LogStartbit; context->slavelist[slave].FMMU[FMMUc].LogStartbit;
EC_PRINT(" slave %d Outputs %p startbit %d\n", EC_PRINT(" slave %d Outputs %p startbit %d\n",
@ -1204,14 +1227,15 @@ int ecx_config_map_group(ecx_contextt *context, void *pIOmap, uint8 group)
} }
} }
context->grouplist[group].outputs = pIOmap; context->grouplist[group].outputs = pIOmap;
context->grouplist[group].Obytes = LogAddr; context->grouplist[group].Obytes = LogAddr - context->grouplist[group].logstartaddr;
context->grouplist[group].nsegments = currentsegment + 1; context->grouplist[group].nsegments = currentsegment + 1;
context->grouplist[group].Isegment = currentsegment; context->grouplist[group].Isegment = currentsegment;
context->grouplist[group].Ioffset = segmentsize; context->grouplist[group].Ioffset = segmentsize;
if (!group) if (!group)
{ {
context->slavelist[0].outputs = pIOmap; context->slavelist[0].outputs = pIOmap;
context->slavelist[0].Obytes = LogAddr; /* store output bytes in master record */ context->slavelist[0].Obytes = LogAddr -
context->grouplist[group].logstartaddr; /* store output bytes in master record */
} }
/* do input mapping of slave and program FMMUs */ /* do input mapping of slave and program FMMUs */
@ -1274,11 +1298,15 @@ int ecx_config_map_group(ecx_contextt *context, void *pIOmap, uint8 group)
context->grouplist[group].IOsegment[currentsegment] = segmentsize; context->grouplist[group].IOsegment[currentsegment] = segmentsize;
context->grouplist[group].nsegments = currentsegment + 1; context->grouplist[group].nsegments = currentsegment + 1;
context->grouplist[group].inputs = (uint8 *)(pIOmap) + context->grouplist[group].Obytes; context->grouplist[group].inputs = (uint8 *)(pIOmap) + context->grouplist[group].Obytes;
context->grouplist[group].Ibytes = LogAddr - context->grouplist[group].Obytes; context->grouplist[group].Ibytes = LogAddr -
context->grouplist[group].logstartaddr -
context->grouplist[group].Obytes;
if (!group) if (!group)
{ {
context->slavelist[0].inputs = (uint8 *)(pIOmap) + context->slavelist[0].Obytes; context->slavelist[0].inputs = (uint8 *)(pIOmap) + context->slavelist[0].Obytes;
context->slavelist[0].Ibytes = LogAddr - context->slavelist[0].Obytes; /* store input bytes in master record */ context->slavelist[0].Ibytes = LogAddr -
context->grouplist[group].logstartaddr -
context->slavelist[0].Obytes; /* store input bytes in master record */
} }
EC_PRINT("IOmapSize %d\n", LogAddr - context->grouplist[group].logstartaddr); EC_PRINT("IOmapSize %d\n", LogAddr - context->grouplist[group].logstartaddr);
@ -1391,8 +1419,8 @@ int ecx_config_overlap_map_group(ecx_contextt *context, void *pIOmap, uint8 grou
context->grouplist[group].Isegment = 0; context->grouplist[group].Isegment = 0;
context->grouplist[group].Ioffset = 0; context->grouplist[group].Ioffset = 0;
context->grouplist[group].Obytes = soLogAddr; context->grouplist[group].Obytes = soLogAddr - context->grouplist[group].logstartaddr;
context->grouplist[group].Ibytes = siLogAddr; context->grouplist[group].Ibytes = siLogAddr - context->grouplist[group].logstartaddr;
context->grouplist[group].outputs = pIOmap; context->grouplist[group].outputs = pIOmap;
context->grouplist[group].inputs = (uint8 *)pIOmap + context->grouplist[group].Obytes; context->grouplist[group].inputs = (uint8 *)pIOmap + context->grouplist[group].Obytes;
@ -1404,10 +1432,11 @@ int ecx_config_overlap_map_group(ecx_contextt *context, void *pIOmap, uint8 grou
if (!group) if (!group)
{ {
/* store output bytes in master record */
context->slavelist[0].outputs = pIOmap; context->slavelist[0].outputs = pIOmap;
context->slavelist[0].Obytes = soLogAddr; /* store output bytes in master record */ context->slavelist[0].Obytes = soLogAddr - context->grouplist[group].logstartaddr;
context->slavelist[0].inputs = (uint8 *)pIOmap + context->slavelist[0].Obytes; context->slavelist[0].inputs = (uint8 *)pIOmap + context->slavelist[0].Obytes;
context->slavelist[0].Ibytes = siLogAddr; context->slavelist[0].Ibytes = siLogAddr - context->grouplist[group].logstartaddr;
} }
EC_PRINT("IOmapSize %d\n", context->grouplist[group].Obytes + context->grouplist[group].Ibytes); EC_PRINT("IOmapSize %d\n", context->grouplist[group].Obytes + context->grouplist[group].Ibytes);

4
soem/ethercatdc.c
View File

@ -281,8 +281,8 @@ boolean ecx_configdc(ecx_contextt *context)
context->slavelist[0].hasdc = TRUE; context->slavelist[0].hasdc = TRUE;
context->slavelist[0].DCnext = i; context->slavelist[0].DCnext = i;
context->slavelist[i].DCprevious = 0; context->slavelist[i].DCprevious = 0;
context->grouplist[0].hasdc = TRUE; context->grouplist[context->slavelist[i].group].hasdc = TRUE;
context->grouplist[0].DCnext = i; context->grouplist[context->slavelist[i].group].DCnext = i;
} }
else else
{ {

1
soem/ethercatmain.h
View File

@ -517,6 +517,7 @@ int ecx_receive_processdata_group(ecx_contextt *context, uint8 group, int timeou
int ecx_send_processdata(ecx_contextt *context); int ecx_send_processdata(ecx_contextt *context);
int ecx_send_overlap_processdata(ecx_contextt *context); int ecx_send_overlap_processdata(ecx_contextt *context);
int ecx_receive_processdata(ecx_contextt *context, int timeout); int ecx_receive_processdata(ecx_contextt *context, int timeout);
int ecx_send_processdata_group(ecx_contextt *context, uint8 group);
#ifdef __cplusplus #ifdef __cplusplus
} }

2
soem/ethercattype.h
View File

@ -71,6 +71,8 @@ extern "C"
#define EC_MAXEEPBUF EC_MAXEEPBITMAP << 5 #define EC_MAXEEPBUF EC_MAXEEPBITMAP << 5
/** default number of retries if wkc <= 0 */ /** default number of retries if wkc <= 0 */
#define EC_DEFAULTRETRIES 3 #define EC_DEFAULTRETRIES 3
/** default group size in 2^x */
#define EC_LOGGROUPOFFSET 16
/** definition for frame buffers */ /** definition for frame buffers */
typedef uint8 ec_bufT[EC_BUFSIZE]; typedef uint8 ec_bufT[EC_BUFSIZE];