unpack_hld seems to work

diff --git a/tools/preview/unpack_hld.pl b/tools/preview/unpack_hld.pl
index e833d2cb6e2714516997f8bac1be7c0d32f94b95..3e531087175e35fde58fb21cb53587c1b1d27d8d 100755 (executable)
--- a/tools/preview/unpack_hld.pl
+++ b/tools/preview/unpack_hld.pl
@@ -7,22 +7,29 @@ use Data::Dumper;
 use FileHandle;
 use feature "switch";
 
+my $SensorHeaderLength = 7;
+
+my $Statistics;
+my $PMap;
+
+
 ###############################################################################
 ## Configuration ##############################################################
 ###############################################################################
 
-my $SensorHeaderLength = 7;
 
 my $file;
 my $opt_help = 0;
 my $opt_verb = 0;
 my $opt_debug = 0;
+my $opt_frameinfo = 0;
 my $totalevents = 1E9;
 my $mode = "";
 
 GetOptions ('h|help'      => \$opt_help,
             'f|file=s'    => \$file,
             'v|verb'      => \$opt_verb,
+            'i|info'      => \$opt_frameinfo,
             'd|debug'     => \$opt_debug,
             'e|events=i'  => \$totalevents);
 
@@ -34,6 +41,7 @@ if($opt_help) {
   printf("[-h|--help]         Show this help\n");
   printf("-f|--file <file>    Path to hld file\n");
   printf("[-v|--verb]         Dump hld file content\n");
+  printf("[-i|--info]         Show frame information\n");
   printf("[-d|--debug]        More debugging output\n");
   printf("\n");
   exit;
@@ -105,6 +113,8 @@ while(1){
     }
 }
 
+WriteResults();
+
 $fh->close();
 
 exit(0);
@@ -181,7 +191,10 @@ sub getEvtHeader()
     }
 
     my $decoding = unpack("V*", $tmp_list[1]);
-    unless(defined $decoding) {printf "This seems to be the end\n"; return -1;}
+    unless(defined $decoding) {
+      printf "This seems to be the end\n" if $opt_verb; 
+      return -1;
+      }
     
     if($opt_debug){
         if(&getEndianess($decoding)){  
@@ -358,6 +371,7 @@ sub checkArgs()
 ###############################################################################
 
 
+
 sub analyzeData() {
   my ($evtHeader, $subEvtHeader, $data) = @_;
   my $EvtId = $evtHeader->[3];
@@ -365,35 +379,133 @@ sub analyzeData() {
   my $time = 0;
   my $SubEvtSize =  $subEvtHeader->[1]/4-6;
   
-  while(1) { #Loop over SubSubEvents
+  SSELoop: while(1) { #Loop over SubSubEvents
+  
+    #Read SubSubEvent Header
     my $RocId      = $data->[$pos] & 0xffff;
     my $RocLength  = ($data->[$pos]>>16) & 0xffff;
     if($RocId == 0x5555) {last;}
     my $RocEnd = $pos + $RocLength;
     $pos++;
     
-    for(my $i = 0; $i < $SensorHeaderLength;$i++) {
-      for($i) {
-        when (1)  {printf("Sensor ID:  %8x\t",$data->[$pos]&0xffff);}
-        when (2)  {printf("Status:     %08x\t",$data->[$pos]);}
-        when (3)  {printf("Error Code: %08x\t",$data->[$pos]);}
-        when (4)  {printf("Debug:      %08x\t",$data->[$pos]);}
-        when (5)  {$time = $data->[$pos];}
-        when (6)  {printf("Time: %08x%08x\n",$data->[$pos],$time);}
-        }
-      
-      $pos++;
-      }
-    
-    while(1) {
-      if($pos >= $RocEnd) {$pos++;last;}
-#       printf("$pos %08x\n",$data->[$pos]);
+    SensLoop: while(1) { #Loop over Sensors
+      #Read Sensor Header
+      my $SensorHead   = $data->[$pos++];
+      my $SensorId     = $data->[$pos++] & 0xffff;
+      my $SensorStatus = $data->[$pos++];
+      my $SensorError  = $data->[$pos++];
+      my $SensorDebug  = $data->[$pos++];
+      my $SensorTime   = sprintf("%08x%08x",$data->[$pos+1],$data->[$pos]);
+      $pos+= 2;
       
+      printf("ID\t%8x\tStatus\t%08x\tError\t%08x\tDebug\t%08x\tTime\t%s\n",
+              $SensorId, $SensorStatus, $SensorError, $SensorDebug, $SensorTime)   if $opt_frameinfo;
       
-      $pos++;
+      #Could it be...?
+      if($SensorHead != 0xffffffff) {
+        #Something is really wrong with data. Skip SubEvent!
+        printf("Broken Sensor Header\n") if $opt_frameinfo;
+        $Statistics->{$SensorId}->{Broken}++;
+        last SSELoop;
+        }
+        
+      #Check Status Word
+      my $SensorIsValid = 0;
+      if($SensorStatus == 0xf000000f) {
+        $SensorIsValid = 1;
+        $Statistics->{$SensorId}->{Valid}++;
+        }
+      else {
+        $SensorIsValid = 0;
+        $Statistics->{$SensorId}->{Broken}++;
+        }
+
+      if($SensorIsValid){
+        #Hey Sensor, tell me who you are!
+        my $SensorDummy  = $data->[$pos++];
+        my $SensorNumber = $data->[$pos++];
+        my $SensorLength = $data->[$pos++] & 0xffff;
+        
+        printf("\t\t\tHeader\t%08x\tFrame\t%08x\tLength\t%i\n",
+                $SensorDummy, $SensorNumber, $SensorLength)  if $opt_frameinfo;
+
+        my $FrameEndPos = $pos + $SensorLength;
+        my ($i, $d, $line, $column, $pixels, $statecnt, $ovf) = (0,0,0,0,0,0,0);
+        while(1) {
+          #Disentangle 16 Bit words
+          if($i++%2) {$d = $data->[$pos++] & 0xffff;}
+          else       {$d = ($data->[$pos] >> 16) & 0xffff;}
+          
+          #Is new line?
+          if($statecnt-- == 0) {
+            $ovf      += $d >> 15;
+            $line      = ($d >> 4) & 0x7FF;
+            $statecnt  = $d & 0xF;
+            }
+          else {
+            $pixels = ($d & 0x3) + 1;
+            $column = ($d >> 2) & 0x7FF;
+            printf("\t$line, $column x $pixels\n") if $opt_frameinfo;
+            
+            $PMap->{$SensorId}->[$line]->[$column]++;
+            $PMap->{$SensorId}->[$line]->[$column+1]++ if $pixels > 1;
+            $PMap->{$SensorId}->[$line]->[$column+2]++ if $pixels > 2;
+            $PMap->{$SensorId}->[$line]->[$column+3]++ if $pixels > 3;
+            }
+          
+          last if $pos >= $FrameEndPos;
+          }
+        
+        
+        #Read end of frame marker without check
+        $pos++; 
+        }
+      if($pos >= $RocEnd){
+        last SensLoop;
+        }
       }
+    }
+  }
+  
+  
+sub WriteResults {
+
+
+  foreach my $id (keys $Statistics) {
+    #No frames? No plot!
+    if(!defined $Statistics->{$id}->{Valid}) {next;}
     
-   
+    my $fn = "gnuplot";
+    $fh = new FileHandle ("|$fn") or  die "error: no gnuplot";
+    $fh->autoflush(1);
+
+    print $fh  "set terminal pngcairo;\n";
+    print $fh  "set palette model RGB;\n";
+    print $fh  "set xrange [0:1152];\n";
+    print $fh  "set yrange [0:576];\n";
+    print $fh  "set cbrange [0:20000];\n";
+    print $fh  "set palette defined ( 0 'white', 1 'red', 5 'black', 10 'blue', 20000 'green');\n";
+    my $s = sprintf("%04x",$id);
+    print $fh  "set output './image_recalibrated_$s.png';\n";
+    print $fh  "plot '-' matrix with image\n";
+
+
+    for(my $y = 0; $y < 576; $y++) {
+      my $l = "";
+      for(my $x = 0; $x < 1152; $x++) {
+        if (defined $PMap->{$id}->[$y]->[$x]) {
+          $l .= $PMap->{$id}->[$y]->[$x]." " ;
+          }
+        else {
+          $l .= "0 ";
+          }
+        }
+      print $fh $l."\n";
+      }
+    print $fh "e\nexit\n";
+    $fh->close();
     }
+    
+
   }