中级会员
 
- 积分
- 494
- 金钱
- 494
- 注册时间
- 2019-1-12
- 在线时间
- 65 小时
|
发表于 2019-2-14 19:07:13
|
显示全部楼层
一共两个C文件:
a.c:
[mw_shl_code=c,true]void trig_proc(void)
{
u32 tmp1, tmp2, tmp;
u32 i;
for (i=0; i<X_MAP_SIZE; i+=4)
{
tmp1 = *(__IO u32 *)(i+X_MAP_START);
tmp2 = *(__IO u32 *)(i+X_BAK_START);
tmp = (tmp1^tmp2);
*(__IO u32 *)(i+XP_MAP_START) = (tmp&tmp1);
*(__IO u32 *)(i+XF_MAP_START) = (tmp&tmp2);
}
memcpy((void *)X_BAK_START, (void *)X_MAP_START, X_MAP_SIZE);
for (i=0; i<Y_MAP_SIZE; i+=4)
{
tmp1 = *(__IO u32 *)(i+Y_MAP_START);
tmp2 = *(__IO u32 *)(i+Y_BAK_START);
tmp = (tmp1^tmp2);
*(__IO u32 *)(i+YP_MAP_START) = (tmp&tmp1);
*(__IO u32 *)(i+YF_MAP_START) = (tmp&tmp2);
}
memcpy((void *)Y_BAK_START, (void *)Y_MAP_START, Y_MAP_SIZE);
for (i=0; i<M_MAP_SIZE; i+=4)
{
tmp1 = (*(__IO u32 *)(i+M_MAP_START));
tmp2 = (*(__IO u32 *)(i+M_BAK_START));
tmp = (tmp1^tmp2);
*(__IO u32 *)(i+MP_MAP_START) = (tmp&tmp1);
*(__IO u32 *)(i+MF_MAP_START) = (tmp&tmp2);
}
memcpy((void *)M_BAK_START, (void *)M_MAP_START, M_MAP_SIZE);
}
[/mw_shl_code]
b.c:
[mw_shl_code=c,true]void instruct_exe(void)
{
u32 a1, a2;
u16 wTmp;
u16 n;
u32 i;
if (!(IS_HAVE_PRG_FLAG))
return;
a1 = PLC_PRG_ADDR_START + sizeof(T_PlcPrgHead) + 16;
a2 = a1 + __pPlcPrgHead->len;
START();
for (i=a1; i<a2; i+=8)
{
wTmp = *(u16 *)(i);
n = (wTmp>>12)&0x0f;
wTmp &= 0x03ff;
PAR_FLAG = *(u16 *)(i+2);
if (wTmp >= __BaseInstCodeStart && wTmp <= _BaseInstCodeEnd)
// if (n < 2)
{
_pBaseInstTbl[wTmp](*(u32 *)(i+4));
}
else if (wTmp >= _2InstCodeStart && wTmp <= _2CellInstCodeEnd)// if (n < 4)
{
_p2CellInstTbl[wTmp-_2InstCodeStart](*(u32 *)(i+4), *(u32 *)(i+8), *(u32 *)(i+12));
i += 8;
}
else if (wTmp >= _3InstCodeStart && wTmp <= _3InstCodeEnd)//if (n < 6)
{
_p3CellInstTbl[wTmp-_2InstCodeStart](*(u32 *)(i+4), *(u32 *)(i+8), *(u32 *)(i+12), *(u32 *)(i+16), *(u32 *)(i+20));
i += 16;
}
}
END();
}
[/mw_shl_code]
其余是广告,请叫我雷锋…… |
|