|
@@ -809,21 +809,15 @@ static void pci9111_ai_munge(struct comedi_device *dev,
|
|
|
unsigned int num_bytes,
|
|
|
unsigned int start_chan_index)
|
|
|
{
|
|
|
- unsigned int i, num_samples = num_bytes / sizeof(short);
|
|
|
short *array = data;
|
|
|
- int resolution =
|
|
|
- ((struct pci9111_board *)dev->board_ptr)->ai_resolution;
|
|
|
-
|
|
|
- for (i = 0; i < num_samples; i++) {
|
|
|
- if (resolution == PCI9111_HR_AI_RESOLUTION)
|
|
|
- array[i] =
|
|
|
- (array[i] & PCI9111_HR_AI_RESOLUTION_MASK) ^
|
|
|
- PCI9111_HR_AI_RESOLUTION_2_CMP_BIT;
|
|
|
- else
|
|
|
- array[i] =
|
|
|
- ((array[i] >> 4) & PCI9111_AI_RESOLUTION_MASK) ^
|
|
|
- PCI9111_AI_RESOLUTION_2_CMP_BIT;
|
|
|
- }
|
|
|
+ unsigned int maxdata = s->maxdata;
|
|
|
+ unsigned int invert = (maxdata + 1) >> 1;
|
|
|
+ unsigned int shift = (maxdata == 0xffff) ? 0 : 4;
|
|
|
+ unsigned int num_samples = num_bytes / sizeof(short);
|
|
|
+ unsigned int i;
|
|
|
+
|
|
|
+ for (i = 0; i < num_samples; i++)
|
|
|
+ array[i] = ((array[i] >> shift) & maxdata) ^ invert;
|
|
|
}
|
|
|
|
|
|
/* ------------------------------------------------------------------ */
|