fix gestione scrittura targetPos

This commit is contained in:
Samuele E. Locatelli
2021-03-10 14:52:58 +01:00
parent 20beb1b139
commit ed05a26be4
+3 -3
View File
@@ -4640,7 +4640,7 @@ namespace CMS_CORE_Library.S7Net
if (WritePos)
{
MEMORY_CELL caTgtPos = new MEMORY_CELL(AXES_COMMAND.MemType, AXES_COMMAND.Address, AXES_COMMAND.SubAddress + ((AxisNum - 1) * 8), 2);
MEMORY_CELL caTgtPos = new MEMORY_CELL(AXES_COMMAND.MemType, AXES_COMMAND.Address, AXES_COMMAND.SubAddress + ((AxisNum - 1) * 8) + 4, 2);
// in primis scrivo la TargetPos nei 4 byte DWord...
libraryError = MEM_RWDouble(W, 0, caTgtPos.MemType, caTgtPos.Address, caTgtPos.SubAddress, ref TargetPos);
if (libraryError.IsError())
@@ -4648,7 +4648,7 @@ namespace CMS_CORE_Library.S7Net
}
// ...è permesso solo 0..7
if (CommandBit >=1 && CommandBit < 8)
if (CommandBit >= 1 && CommandBit < 8)
{
// posizione: è da array assi 0..n-1, 8byte ogni asse
MEMORY_CELL currAxAck = new MEMORY_CELL(AXES_COMMAND.MemType, AXES_COMMAND.Address, AXES_COMMAND.SubAddress + ((AxisNum - 1) * 8), 2);
@@ -4700,7 +4700,7 @@ namespace CMS_CORE_Library.S7Net
// preparo la word
ushort controlData = 0;
MEMORY_CELL caTgtPos = new MEMORY_CELL(AXES_GEN_STATUS.MemType, AXES_GEN_STATUS.Address, AXES_GEN_STATUS.SubAddress, 2);
// in primis scrivo la TargetPos nei 4 byte DWord...
libraryError = MEM_RWWord(R, 0, caTgtPos.MemType, caTgtPos.Address, caTgtPos.SubAddress, ref controlData);