--- /dev/null
+#!/usr/bin/perl -w
+
+use English;
+use strict;
+use Getopt::Long;
+use Data::Dumper;
+use FileHandle;
+use feature "switch";
+
+my $SensorHeaderLength = 7;
+
+my $Statistics;
+my $PMap;
+
+
+###############################################################################
+## Configuration ##############################################################
+###############################################################################
+
+
+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);
+
+
+
+
+if($opt_help) {
+ printf("Usage: unpack_hld.pl \n");
+ 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;
+ }
+
+
+
+###############################################################################
+## HLD Reader #################################################################
+###############################################################################
+
+
+if(&checkArgs()){
+ exit(0);
+}
+
+my @evtHeader_list = ();
+my $evtHeader_aref = \@evtHeader_list;
+
+my @subEvtHeader_list = ();
+my $subEvtHeader_aref = \@subEvtHeader_list;
+
+my @data_list = ();
+my $data_aref = \@data_list;
+
+my $fh = new FileHandle("$file", "r");
+
+while(1){
+ @evtHeader_list = ();
+
+ &getEvtHeader($fh,$evtHeader_aref);
+ &printEvtHeader($evtHeader_aref) if($opt_verb);
+
+ my $evtSize = $evtHeader_aref->[0];
+ if (!defined $evtSize || $evtSize < 0x10) {last;}
+
+ #- If the size is only 32 Bytes -> goto to
+ # the next Event Header since there are no subevents
+ next unless defined $evtSize;
+ next if($evtSize == 32);
+
+ my $size_cntr = 32; # Bytes
+
+ while($evtSize > $size_cntr){
+
+ @subEvtHeader_list = ();
+
+ my $decoding = &getSubEvtHeader($fh,$subEvtHeader_aref);
+ &printSubEvtHeader($subEvtHeader_aref) if($opt_verb);
+
+ my $subEvtSize = $subEvtHeader_aref->[0];
+
+ $size_cntr = $size_cntr + $subEvtSize;
+
+ #- If the size is only 16 Bytes -> goto to
+ # the next Sub Event Header since there are no subevents
+ next if($subEvtSize == 16);
+
+ @data_list = ();
+ &getSubEvtData($fh, $data_aref, $subEvtSize, $decoding);
+ &printData($data_aref) if($opt_verb);
+
+ my $paddedSize = &padding($fh, $subEvtSize);
+
+ $size_cntr = $size_cntr + $paddedSize;
+
+ #----------> User function <---------
+ &analyzeData($evtHeader_aref, $subEvtHeader_aref, $data_aref);
+ }
+}
+
+WriteResults();
+
+$fh->close();
+
+exit(0);
+
+####################### END OF MAIN ###################
+
+sub printEvtHeader()
+{
+ my ($data_aref) = @_;
+
+ print "\n";
+
+ printf("size: %08x ", $data_aref->[0]);
+ printf("decoding: %08x ", $data_aref->[1]);
+ printf("id: %08x ", $data_aref->[2]);
+ printf("seqNr: %08x\n", $data_aref->[3]);
+
+ my $year = (($data_aref->[4] >> 16) & 0xff) + 1900;
+ my $mon = (($data_aref->[4] >> 8) & 0xff) + 1;
+ my $mday = ($data_aref->[4] >> 0) & 0xff;
+
+ my $hour = ($data_aref->[5] >> 16) & 0xff;
+ my $min = ($data_aref->[5] >> 8) & 0xff;
+ my $sec = ($data_aref->[5] >> 0) & 0xff;
+
+ printf("date: %04d-%02d-%02d ", $year, $mon, $mday);
+ printf("time: %02d:%02d:%02d ", $hour, $min, $sec);
+ printf("runNr: %08x ", $data_aref->[6]);
+ printf("expId: %08x\n", $data_aref->[7]);
+}
+
+sub printSubEvtHeader()
+{
+ my ($data_aref) = @_;
+
+ print "\n";
+
+ printf("size: %08x ", $data_aref->[0]);
+ printf("decoding: %08x ", $data_aref->[1]);
+ printf("id: %08x ", $data_aref->[2]);
+ printf("trigNr: %08x\n", $data_aref->[3]);
+}
+
+sub printData()
+{
+ my ($data_aref) = @_;
+
+ my $cntr = 0;
+
+ print "\n";
+
+ foreach my $word (@$data_aref){
+ printf("%08x ", $word);
+
+ $cntr++;
+
+ print "\n" if( ($cntr%4) == 0);
+ }
+}
+
+sub getEvtHeader()
+{
+ my ($fh, $data_aref) = @_;
+
+ my @tmp_list;
+
+ foreach my $i (1..8){
+ my $header;
+
+ read($fh, $header, 4);
+ &checkEndOfFile($fh, $header);
+
+ push(@tmp_list, $header);
+ }
+
+ my $decoding = unpack("V*", $tmp_list[1]);
+ unless(defined $decoding) {
+ printf "This seems to be the end\n" if $opt_verb;
+ return -1;
+ }
+
+ if($opt_debug){
+ if(&getEndianess($decoding)){
+ printf("\n Event Decoding: %08x Byte Order: Little Endian\n", $decoding);
+ }
+ else{
+ printf("\n Event Decoding: %08x Byte Order: Big Endian\n", $decoding);
+ }
+ }
+
+ foreach my $tmp (@tmp_list){
+ my $word;
+
+ if(&getEndianess($decoding)){
+ $word = unpack("V*", $tmp); # Small Endian
+ }
+ else{
+ $word = unpack("N*", $tmp); # Big Endian
+ }
+
+ push(@$data_aref, $word);
+ }
+}
+
+sub getSubEvtHeader()
+{
+ my ($fh, $data_aref) = @_;
+
+ my @tmp_list;
+
+ foreach my $i (1..4){
+ my $header;
+
+ read($fh, $header, 4);
+ &checkEndOfFile($fh, $header);
+
+ push(@tmp_list, $header);
+ }
+
+ my $decoding = unpack("V*", $tmp_list[1]);
+
+ if($opt_debug){
+ if(&getEndianess($decoding)){
+ printf("\n SubEvent Decoding: %08x Byte Order: Little Endian\n", $decoding);
+ }
+ else{
+ printf("\n SubEvent Decoding: %08x Byte Order: Big Endian\n", $decoding);
+ }
+ }
+
+ foreach my $tmp (@tmp_list){
+ my $word;
+
+ if(&getEndianess($decoding)){
+ $word = unpack("V*", $tmp); # Small Endian
+ }
+ else{
+ $word = unpack("N*", $tmp); # Big Endian
+ }
+
+ push(@$data_aref, $word);
+ }
+
+ return &getEndianess($decoding);
+}
+
+sub getEndianess()
+{
+ my ($decoding) = @_;
+
+ # Return values:
+ # 0 : Big Endian
+ # 1 : Little Endian
+ #
+ # Usually (when sent by GbE-FPGAs) Event Headers are Little Endian
+ # SubEvent Headers and data are Big Endian
+
+ my $retVal = 0;
+
+ if(defined($decoding) && ($decoding & 0x000000ff) > 0){
+ $retVal = 1; # This is Little Endian
+ }
+
+ return $retVal;
+}
+
+sub getSubEvtData()
+{
+ my ($fh, $data_aref, $size, $decoding) = @_;
+
+ #- Subtract subevent header size and devide by word size
+ my $nrOfWords = ($size - 16)/4;
+
+ foreach my $i (1..$nrOfWords){
+
+ my $tmp;
+ read($fh, $tmp, 4);
+ &checkEndOfFile($fh, $tmp);
+
+ my $word;
+
+ if(&getEndianess($decoding)){
+ $word = unpack("V*", $tmp); # Little Endian
+ }
+ else{
+ $word = unpack("N*", $tmp); # Big Endian
+ }
+
+ push(@$data_aref, $word);
+ }
+}
+
+sub padding()
+{
+ my ($fh, $size) = @_;
+
+ my $retVal = 0; # Size of the padded word
+
+ #- Check 64-bit (8-Byte) alignment
+ unless( ($size%8) == 0){
+ my $tmp;
+ read($fh, $tmp, 4);
+
+ my $word;
+ $word = unpack("V*", $tmp); # Little Endian
+
+ unless($word == 0){
+ #- Padding word is not zero
+
+ printf("\n Padding word is not zero: %08x! \n", $word) if($opt_debug);
+ #$fh->close();
+ #exit(0);
+ }
+
+ $retVal = 4; # Bytes
+ }
+
+ return $retVal;
+}
+
+sub checkEndOfFile()
+{
+ my ($fh, $tmp) = @_;
+
+ unless( defined $tmp){
+ #- The end of the file
+ print "\n End of file\n";
+ $fh->close();
+ exit(0);
+ }
+}
+
+sub checkArgs()
+{
+ my $retVal = 0;
+
+ unless( defined $file){
+ print "\n You must provide a path to the hld file!\n";
+ print " Read help.\n";
+ $retVal = 1;
+ }
+
+ return $retVal;
+}
+
+
+
+
+
+
+
+###############################################################################
+## MVD Unpacker ###############################################################
+###############################################################################
+
+
+
+sub analyzeData() {
+ my ($evtHeader, $subEvtHeader, $data) = @_;
+ my $EvtId = $evtHeader->[3];
+ my $pos = 0;
+ my $time = 0;
+ my $SubEvtSize = $subEvtHeader->[1]/4-6;
+
+ 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++;
+
+ 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;
+
+ #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();
+ }
+
+
+ }
+
jspc29 / mvdsensorcontrol.git / commitdiff