Skip to content

P
proview
Commit b3670e48 authored by claes's avatar claes
Browse files
Options

*** empty log message ***

parent 4a481a43
Hide whitespace changes
Inline Side-by-side
Showing with 24 additions and 10 deletions
profibus/lib/rt/src/os_linux/rt_io_m_pb_dp_slave.c
View file @ b3670e48
/* /*
* Proview $Id: rt_io_m_pb_dp_slave.c,v 1.4 2006-07-03 06:20:03 claes Exp $ * Proview $Id: rt_io_m_pb_dp_slave.c,v 1.5 2006-07-25 11:00:56 claes Exp $
* Copyright (C) 2005 SSAB Oxelsund AB. * Copyright (C) 2005 SSAB Oxelsund AB.
* *
* This program is free software; you can redistribute it and/or * This program is free software; you can redistribute it and/or
...@@ -224,7 +224,7 @@ static pwr_tStatus IoRackInit ( ...@@ -224,7 +224,7 @@ static pwr_tStatus IoRackInit (
if (chan_di->Representation == pwr_eDataRepEnum_Bit32 && op->ByteOrdering == pwr_eByteOrdering_BigEndian) if (chan_di->Representation == pwr_eDataRepEnum_Bit32 && op->ByteOrdering == pwr_eByteOrdering_BigEndian)
chanp->mask = swap32((unsigned short) chanp->mask); chanp->mask = swap32((unsigned short) chanp->mask);
if (chan_di->Number == 0) latent_input_count = GetChanSize(chan_di->Representation); if (chan_di->Number == 0) latent_input_count = GetChanSize(chan_di->Representation);
printf("Di channel found in %s, Number %d, Offset %d\n", cardp->Name, chan_di->Number, chanp->offset); // printf("Di channel found in %s, Number %d, Offset %d\n", cardp->Name, chan_di->Number, chanp->offset);
break; break;
case pwr_cClass_ChanAi: case pwr_cClass_ChanAi:
...@@ -235,7 +235,7 @@ static pwr_tStatus IoRackInit ( ...@@ -235,7 +235,7 @@ static pwr_tStatus IoRackInit (
chanp->mask = 0; chanp->mask = 0;
input_counter += chan_size; input_counter += chan_size;
io_AiRangeToCoef(chanp); io_AiRangeToCoef(chanp);
printf("Ai channel found in %s, Number %d, Offset %d\n", cardp->Name, chan_ai->Number, chanp->offset); // printf("Ai channel found in %s, Number %d, Offset %d\n", cardp->Name, chan_ai->Number, chanp->offset);
break; break;
case pwr_cClass_ChanAit: case pwr_cClass_ChanAit:
...@@ -255,7 +255,7 @@ static pwr_tStatus IoRackInit ( ...@@ -255,7 +255,7 @@ static pwr_tStatus IoRackInit (
chanp->size = chan_size; chanp->size = chan_size;
chanp->mask = 0; chanp->mask = 0;
input_counter += chan_size; input_counter += chan_size;
printf("Ii channel found in %s, Number %d, Offset %d\n", cardp->Name, chan_ii->Number, chanp->offset); // printf("Ii channel found in %s, Number %d, Offset %d\n", cardp->Name, chan_ii->Number, chanp->offset);
break; break;
case pwr_cClass_ChanDo: case pwr_cClass_ChanDo:
...@@ -272,7 +272,7 @@ static pwr_tStatus IoRackInit ( ...@@ -272,7 +272,7 @@ static pwr_tStatus IoRackInit (
if (chan_do->Representation == pwr_eDataRepEnum_Bit32 && op->ByteOrdering == pwr_eByteOrdering_BigEndian) if (chan_do->Representation == pwr_eDataRepEnum_Bit32 && op->ByteOrdering == pwr_eByteOrdering_BigEndian)
chanp->mask = swap32((unsigned short) chanp->mask); chanp->mask = swap32((unsigned short) chanp->mask);
if (chan_do->Number == 0) latent_output_count = GetChanSize(chan_do->Representation); if (chan_do->Number == 0) latent_output_count = GetChanSize(chan_do->Representation);
printf("Do channel found in %s, Number %d, Offset %d\n", cardp->Name, chan_do->Number, chanp->offset); // printf("Do channel found in %s, Number %d, Offset %d\n", cardp->Name, chan_do->Number, chanp->offset);
break; break;
case pwr_cClass_ChanAo: case pwr_cClass_ChanAo:
...@@ -283,7 +283,7 @@ static pwr_tStatus IoRackInit ( ...@@ -283,7 +283,7 @@ static pwr_tStatus IoRackInit (
chanp->mask = 0; chanp->mask = 0;
output_counter += chan_size; output_counter += chan_size;
io_AoRangeToCoef(chanp); io_AoRangeToCoef(chanp);
printf("Ao channel found in %s, Number %d, Offset %d\n", cardp->Name, chan_ao->Number, chanp->offset); // printf("Ao channel found in %s, Number %d, Offset %d\n", cardp->Name, chan_ao->Number, chanp->offset);
break; break;
case pwr_cClass_ChanIo: case pwr_cClass_ChanIo:
...@@ -293,7 +293,7 @@ static pwr_tStatus IoRackInit ( ...@@ -293,7 +293,7 @@ static pwr_tStatus IoRackInit (
chanp->size = chan_size; chanp->size = chan_size;
chanp->mask = 0; chanp->mask = 0;
output_counter += chan_size; output_counter += chan_size;
printf("Io channel found in %s, Number %d, Offset %d\n", cardp->Name, chan_io->Number, chanp->offset); // printf("Io channel found in %s, Number %d, Offset %d\n", cardp->Name, chan_io->Number, chanp->offset);
break; break;
} }
} }
......
profibus/lib/rt/src/os_linux/rt_io_m_pb_module.c
View file @ b3670e48
/* /*
* Proview $Id: rt_io_m_pb_module.c,v 1.4 2006-07-03 06:20:03 claes Exp $ * Proview $Id: rt_io_m_pb_module.c,v 1.5 2006-07-25 11:00:56 claes Exp $
* Copyright (C) 2005 SSAB Oxelsund AB. * Copyright (C) 2005 SSAB Oxelsund AB.
* *
* This program is free software; you can redistribute it and/or * This program is free software; you can redistribute it and/or
...@@ -216,35 +216,41 @@ static pwr_tStatus IoCardRead ( ...@@ -216,35 +216,41 @@ static pwr_tStatus IoCardRead (
case pwr_eDataRepEnum_Int8: case pwr_eDataRepEnum_Int8:
memcpy(&data8, local->input_area + cp->offset + chanp->offset, 1); memcpy(&data8, local->input_area + cp->offset + chanp->offset, 1);
f_raw = (float) data8; f_raw = (float) data8;
sig_ai->RawValue = data8;
break; break;
case pwr_eDataRepEnum_UInt8: case pwr_eDataRepEnum_UInt8:
memcpy(&udata8, local->input_area + cp->offset + chanp->offset, 1); memcpy(&udata8, local->input_area + cp->offset + chanp->offset, 1);
f_raw = (float) udata8; f_raw = (float) udata8;
sig_ai->RawValue = udata8;
break; break;
case pwr_eDataRepEnum_Int16: case pwr_eDataRepEnum_Int16:
memcpy(&data16, local->input_area + cp->offset + chanp->offset, 2); memcpy(&data16, local->input_area + cp->offset + chanp->offset, 2);
if (slave->ByteOrdering == pwr_eByteOrdering_BigEndian) data16 = swap16(data16); if (slave->ByteOrdering == pwr_eByteOrdering_BigEndian) data16 = swap16(data16);
f_raw = (float) data16; f_raw = (float) data16;
sig_ai->RawValue = data16;
break; break;
case pwr_eDataRepEnum_UInt16: case pwr_eDataRepEnum_UInt16:
memcpy(&udata16, local->input_area + cp->offset + chanp->offset, 2); memcpy(&udata16, local->input_area + cp->offset + chanp->offset, 2);
if (slave->ByteOrdering == pwr_eByteOrdering_BigEndian) data16 = swap16(udata16); if (slave->ByteOrdering == pwr_eByteOrdering_BigEndian) data16 = swap16(udata16);
f_raw = (float) udata16; f_raw = (float) udata16;
sig_ai->RawValue = udata16;
break; break;
case pwr_eDataRepEnum_Int32: case pwr_eDataRepEnum_Int32:
memcpy(&data32, local->input_area + cp->offset + chanp->offset, 4); memcpy(&data32, local->input_area + cp->offset + chanp->offset, 4);
if (slave->ByteOrdering == pwr_eByteOrdering_BigEndian) data32 = swap32(data32); if (slave->ByteOrdering == pwr_eByteOrdering_BigEndian) data32 = swap32(data32);
f_raw = (float) data32; f_raw = (float) data32;
sig_ai->RawValue = data32;
break; break;
case pwr_eDataRepEnum_UInt32: case pwr_eDataRepEnum_UInt32:
memcpy(&udata32, local->input_area + cp->offset + chanp->offset, 4); memcpy(&udata32, local->input_area + cp->offset + chanp->offset, 4);
if (slave->ByteOrdering == pwr_eByteOrdering_BigEndian) udata32 = swap32(udata32); if (slave->ByteOrdering == pwr_eByteOrdering_BigEndian) udata32 = swap32(udata32);
f_raw = (float) udata32; f_raw = (float) udata32;
sig_ai->RawValue = udata32;
break; break;
case pwr_eDataRepEnum_Float32: case pwr_eDataRepEnum_Float32:
...@@ -252,11 +258,12 @@ static pwr_tStatus IoCardRead ( ...@@ -252,11 +258,12 @@ static pwr_tStatus IoCardRead (
if (slave->ByteOrdering == pwr_eByteOrdering_BigEndian || if (slave->ByteOrdering == pwr_eByteOrdering_BigEndian ||
slave->FloatRepresentation == pwr_ePbNumberRep_FloatIEEE) udata32 = swap32(udata32); slave->FloatRepresentation == pwr_ePbNumberRep_FloatIEEE) udata32 = swap32(udata32);
memcpy(&f_raw, &udata32, 4); memcpy(&f_raw, &udata32, 4);
sig_ai->RawValue = udata32;
break; break;
} }
sig_ai->RawValue = 0; // sig_ai->RawValue = 0;
PbConvertAi(ctx, f_raw, chan_ai, sig_ai, chanp); PbConvertAi(ctx, f_raw, chan_ai, sig_ai, chanp);
} }
...@@ -462,7 +469,7 @@ static pwr_tStatus IoCardWrite ( ...@@ -462,7 +469,7 @@ static pwr_tStatus IoCardWrite (
else else
rawvalue = rawvalue - 0.5; rawvalue = rawvalue - 0.5;
sig_ao->RawValue = 0; // sig_ao->RawValue = 0;
sig_ao->SigValue = chan_ao->SigValPolyCoef1 * value + chan_ao->SigValPolyCoef0; sig_ao->SigValue = chan_ao->SigValPolyCoef1 * value + chan_ao->SigValPolyCoef0;
...@@ -471,39 +478,46 @@ static pwr_tStatus IoCardWrite ( ...@@ -471,39 +478,46 @@ static pwr_tStatus IoCardWrite (
case pwr_eDataRepEnum_Int8: case pwr_eDataRepEnum_Int8:
data8 = (pwr_tInt8) rawvalue; data8 = (pwr_tInt8) rawvalue;
memcpy(local->output_area + cp->offset + chanp->offset, &data8, 1); memcpy(local->output_area + cp->offset + chanp->offset, &data8, 1);
sig_ao->RawValue = data8;
break; break;
case pwr_eDataRepEnum_UInt8: case pwr_eDataRepEnum_UInt8:
udata8 = (pwr_tUInt8) rawvalue; udata8 = (pwr_tUInt8) rawvalue;
memcpy(local->output_area + cp->offset + chanp->offset, &udata8, 1); memcpy(local->output_area + cp->offset + chanp->offset, &udata8, 1);
sig_ao->RawValue = udata8;
break; break;
case pwr_eDataRepEnum_Int16: case pwr_eDataRepEnum_Int16:
data16 = (pwr_tInt16) rawvalue; data16 = (pwr_tInt16) rawvalue;
sig_ao->RawValue = data16;
if (slave->ByteOrdering == pwr_eByteOrdering_BigEndian) data16 = swap16(data16); if (slave->ByteOrdering == pwr_eByteOrdering_BigEndian) data16 = swap16(data16);
memcpy(local->output_area + cp->offset + chanp->offset, &data16, 2); memcpy(local->output_area + cp->offset + chanp->offset, &data16, 2);
break; break;
case pwr_eDataRepEnum_UInt16: case pwr_eDataRepEnum_UInt16:
udata16 = (pwr_tUInt16) rawvalue; udata16 = (pwr_tUInt16) rawvalue;
sig_ao->RawValue = udata16;
if (slave->ByteOrdering == pwr_eByteOrdering_BigEndian) udata16 = swap16(udata16); if (slave->ByteOrdering == pwr_eByteOrdering_BigEndian) udata16 = swap16(udata16);
memcpy(local->output_area + cp->offset + chanp->offset, &udata16, 2); memcpy(local->output_area + cp->offset + chanp->offset, &udata16, 2);
break; break;
case pwr_eDataRepEnum_Int32: case pwr_eDataRepEnum_Int32:
data32 = (pwr_tInt32) rawvalue; data32 = (pwr_tInt32) rawvalue;
sig_ao->RawValue = data32;
if (slave->ByteOrdering == pwr_eByteOrdering_BigEndian) data32 = swap32(data32); if (slave->ByteOrdering == pwr_eByteOrdering_BigEndian) data32 = swap32(data32);
memcpy(local->output_area + cp->offset + chanp->offset, &data32, 4); memcpy(local->output_area + cp->offset + chanp->offset, &data32, 4);
break; break;
case pwr_eDataRepEnum_UInt32: case pwr_eDataRepEnum_UInt32:
udata32 = (pwr_tUInt32) rawvalue; udata32 = (pwr_tUInt32) rawvalue;
sig_ao->RawValue = udata32;
if (slave->ByteOrdering == pwr_eByteOrdering_BigEndian) udata32 = swap32(udata32); if (slave->ByteOrdering == pwr_eByteOrdering_BigEndian) udata32 = swap32(udata32);
memcpy(local->output_area + cp->offset + chanp->offset, &udata32, 4); memcpy(local->output_area + cp->offset + chanp->offset, &udata32, 4);
break; break;
case pwr_eDataRepEnum_Float32: case pwr_eDataRepEnum_Float32:
memcpy(&udata32, &rawvalue, 4); memcpy(&udata32, &rawvalue, 4);
sig_ao->RawValue = udata32;
if (slave->ByteOrdering == pwr_eByteOrdering_BigEndian || if (slave->ByteOrdering == pwr_eByteOrdering_BigEndian ||
slave->FloatRepresentation == pwr_ePbNumberRep_FloatIEEE) udata32 = swap32(udata32); slave->FloatRepresentation == pwr_ePbNumberRep_FloatIEEE) udata32 = swap32(udata32);
memcpy(local->output_area + cp->offset + chanp->offset, &udata32, 4); memcpy(local->output_area + cp->offset + chanp->offset, &udata32, 4);
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment
GitLab Nexedi Edition | About GitLab | About Nexedi | 沪ICP备2021021310号-2 | 沪ICP备2021021310号-7