unsigned getSensor(unsigned sensorId);
void writeResults();
-#define DEBUG 0
+#define DEBUG 2
#define MAX_SENSORS 12
unsigned pixelMap[MAX_SENSORS][576][1152] = {{0}};
if (source == 0x5555) return -32;
if (datalen == 0) return -33;
unsigned RocEnd = ix + datalen -1;
+ int v2 = 0;
while(1) {
unsigned sensorHead = sub->Data(ix++);
unsigned sensorId = 0x0;
internal_fr_num = sub->Data(ix++);
sensorError = 0x0;
sensorDebug = 0x0;
+ v2 = 1;
}
else{
sensorId = (source << 16)|(sub->Data(ix++)>>16);
sensorError = sub->Data(ix++);
sensorDebug = sub->Data(ix++);
ix += 2; //Skip time
+ v2 = 0;
}
mySensor = getSensor(sensorId);
while(1) {
for(unsigned i = 0; i<=1; i++) {
- if(i==0) d = sub->Data(ix) >> 16;
- else d = sub->Data(ix++);
+
+ if (v2==1){
+ if(i==0) d = (sub->Data(ix) << 16) >> 16;
+ else d = sub->Data(ix++) >> 16;
+ }
+ else{
+ if(i==0) d = sub->Data(ix) >> 16;
+ else d = sub->Data(ix++);
+ }
if(statecnt-- == 0) {
ovf += (d >> 15) & 1;