/[RFID]/3m-810.pl
This is repository of my old source code which isn't updated any more. Go to git.rot13.org for current projects!
ViewVC logotype

Diff of /3m-810.pl

Parent Directory Parent Directory | Revision Log Revision Log | View Patch Patch

revision 23 by dpavlin, Sat Mar 28 03:47:10 2009 UTC revision 62 by dpavlin, Tue Feb 9 14:52:13 2010 UTC
# Line 7  use warnings; Line 7  use warnings;
7  use Data::Dump qw/dump/;  use Data::Dump qw/dump/;
8  use Carp qw/confess/;  use Carp qw/confess/;
9  use Getopt::Long;  use Getopt::Long;
10    use File::Slurp;
11    use JSON;
12    use POSIX qw(strftime);
13    
14  use IO::Socket::INET;  use IO::Socket::INET;
15    
16  my $meteor = IO::Socket::INET->new( '192.168.1.13:4671' ) || die "can't connect to meteor: $!";  my $debug = 0;
17    
18    my $tags_data;
19    my $tags_security;
20    my $visible_tags;
21    
22    my $meteor_server; # = '192.168.1.13:4671';
23    my $meteor_fh;
24    
25  sub meteor {  sub meteor {
26          my ( $item, $html ) = @_;          my @a = @_;
27          warn ">> meteor $item $html\n";          push @a, scalar localtime() if $a[0] =~ m{^info};
28          print $meteor "ADDMESSAGE test $item|" . localtime() . "<br>$html\n";  
29            if ( ! defined $meteor_fh ) {
30                    if ( $meteor_fh =
31                                    IO::Socket::INET->new(
32                                            PeerAddr => $meteor_server,
33                                            Timeout => 1,
34                                    )
35                    ) {
36                            warn "# meteor connected to $meteor_server";
37                    } else {
38                            warn "can't connect to meteor $meteor_server: $!";
39                            $meteor_fh = 0;
40                    }
41            }
42    
43            if ( $meteor_fh ) {
44                    warn ">> meteor ",dump( @a );
45                    print $meteor_fh "ADDMESSAGE test ",join('|',@a),"\n"
46            }
47  }  }
48    
49  my $debug = 0;  my $listen_port = 9000;                  # pick something not in use
50    my $server_url  = "http://localhost:$listen_port";
51    
52    sub http_server {
53    
54            my $server = IO::Socket::INET->new(
55                    Proto     => 'tcp',
56                    LocalPort => $listen_port,
57                    Listen    => SOMAXCONN,
58                    Reuse     => 1
59            );
60                                                                      
61            die "can't setup server" unless $server;
62    
63            print "Server $0 ready at $server_url\n";
64    
65            sub static {
66                    my ($client,$path) = @_;
67    
68                    $path = "www/$path";
69                    $path .= 'rfid.html' if $path =~ m{/$};
70    
71                    return unless -e $path;
72    
73                    my $type = 'text/plain';
74                    $type = 'text/html' if $path =~ m{\.htm};
75                    $type = 'application/javascript' if $path =~ m{\.js};
76    
77                    print $client "HTTP/1.0 200 OK\r\nContent-Type: $type\r\n\r\n";
78                    open(my $html, $path);
79                    while(<$html>) {
80                            print $client $_;
81                    }
82                    close($html);
83    
84                    return $path;
85            }
86    
87            while (my $client = $server->accept()) {
88                    $client->autoflush(1);
89                    my $request = <$client>;
90    
91                    warn "WEB << $request\n" if $debug;
92    
93                    if ($request =~ m{^GET (/.*) HTTP/1.[01]}) {
94                            my $method = $1;
95                            my $param;
96                            if ( $method =~ s{\?(.+)}{} ) {
97                                    foreach my $p ( split(/[&;]/, $1) ) {
98                                            my ($n,$v) = split(/=/, $p, 2);
99                                            $param->{$n} = $v;
100                                    }
101                                    warn "WEB << param: ",dump( $param ) if $debug;
102                            }
103                            if ( my $path = static( $client,$1 ) ) {
104                                    warn "WEB >> $path" if $debug;
105                            } elsif ( $method =~ m{/scan} ) {
106                                    my $tags = scan_for_tags();
107                                    my $json = { time => time() };
108                                    map {
109                                            my $d = decode_tag($_);
110                                            $d->{sid} = $_;
111                                            $d->{security} = $tags_security->{$_};
112                                            push @{ $json->{tags} },  $d;
113                                    } keys %$tags;
114                                    print $client "HTTP/1.0 200 OK\r\nContent-Type: application/x-javascript\r\n\r\n",
115                                            $param->{callback}, "(", to_json($json), ")\r\n";
116                            } elsif ( $method =~ m{/program} ) {
117    
118                                    my $status = 501; # Not implementd
119    
120                                    foreach my $p ( keys %$param ) {
121                                            next unless $p =~ m/^tag_(\S+)/;
122                                            my $tag = $1;
123                                            my $content = "\x04\x11\x00\x01" . $param->{$p};
124                                            $status = 302;
125    
126                                            warn "PROGRAM $tag $content\n";
127                                            write_tag( $tag, $content );
128                                    }
129    
130                                    print $client "HTTP/1.0 $status $method\r\nLocation: $server_url\r\n\r\n";
131    
132                            } else {
133                                    print $client "HTTP/1.0 404 Unkown method\r\n";
134                            }
135                    } else {
136                            print $client "HTTP/1.0 500 No method\r\n";
137                    }
138                    close $client;
139            }
140    
141            die "server died";
142    }
143    
144    
145    my $last_message = {};
146    sub _message {
147            my $type = shift @_;
148            my $text = join(' ',@_);
149            my $last = $last_message->{$type};
150            if ( $text ne $last ) {
151                    warn $type eq 'diag' ? '# ' : '', $text, "\n";
152                    $last_message->{$type} = $text;
153            }
154    }
155    
156    sub _log { _message('log',@_) };
157    sub diag { _message('diag',@_) };
158    
159  my $device    = "/dev/ttyUSB0";  my $device    = "/dev/ttyUSB0";
160  my $baudrate  = "19200";  my $baudrate  = "19200";
# Line 27  my $parity       = "none"; Line 163  my $parity       = "none";
163  my $stopbits  = "1";  my $stopbits  = "1";
164  my $handshake = "none";  my $handshake = "none";
165    
166    my $program_path = './program/';
167    my $secure_path = './secure/';
168    
169    # http server
170    my $http_server = 1;
171    
172    # 3M defaults: 8,4
173    my $max_rfid_block = 16;
174    my $read_blocks = 8;
175    
176  my $response = {  my $response = {
177          'd500090400110a0500027250'                              => 'version?',          'd500090400110a0500027250'                              => 'version?',
178          'd60007fe00000500c97b'                                  => 'no tag in range',          'd60007fe00000500c97b'                                  => 'no tag in range',
# Line 47  GetOptions( Line 193  GetOptions(
193          'parity=s'    => \$parity,          'parity=s'    => \$parity,
194          'stopbits=i'  => \$stopbits,          'stopbits=i'  => \$stopbits,
195          'handshake=s' => \$handshake,          'handshake=s' => \$handshake,
196            'meteor=s'    => \$meteor_server,
197            'http-server!' => \$http_server,
198  ) or die $!;  ) or die $!;
199    
200  my $verbose = $debug > 0 ? $debug-- : 0;  my $verbose = $debug > 0 ? $debug-- : 0;
# Line 82  it under the same terms ans Perl itself. Line 230  it under the same terms ans Perl itself.
230    
231  =cut  =cut
232    
233  my $tags_data;  my $item_type = {
234  my $visible_tags;          1 => 'Book',
235            6 => 'CD/CD ROM',
236            2 => 'Magazine',
237            13 => 'Book with Audio Tape',
238            9 => 'Book with CD/CD ROM',
239            0 => 'Other',
240    
241            5 => 'Video',
242            4 => 'Audio Tape',
243            3 => 'Bound Journal',
244            8 => 'Book with Diskette',
245            7 => 'Diskette',
246    };
247    
248    warn "## known item type: ",dump( $item_type ) if $debug;
249    
250  my $port=new Device::SerialPort($device) || die "can't open serial port $device: $!\n";  my $port=new Device::SerialPort($device) || die "can't open serial port $device: $!\n";
251  warn "using $device $handshake $baudrate $databits $parity $stopbits" if $debug;  warn "using $device $handshake $baudrate $databits $parity $stopbits" if $debug;
# Line 93  $databits=$port->databits($databits); Line 255  $databits=$port->databits($databits);
255  $parity=$port->parity($parity);  $parity=$port->parity($parity);
256  $stopbits=$port->stopbits($stopbits);  $stopbits=$port->stopbits($stopbits);
257    
258  print "## using $device $baudrate $databits $parity $stopbits debug: $debug verbose: $verbose\n";  warn "## using $device $baudrate $databits $parity $stopbits debug: $debug verbose: $verbose\n";
259    
260  # Just in case: reset our timing and buffers  # Just in case: reset our timing and buffers
261  $port->lookclear();  $port->lookclear();
# Line 110  cmd( 'D5 00  05   04 00 11 Line 272  cmd( 'D5 00  05   04 00 11
272       'D5 00  09   04 00 11   0A 05 00 02   7250', sub {       'D5 00  09   04 00 11   0A 05 00 02   7250', sub {
273          my $hw_ver = join('.', unpack('CCCC', skip_assert(3) ));          my $hw_ver = join('.', unpack('CCCC', skip_assert(3) ));
274          print "hardware version $hw_ver\n";          print "hardware version $hw_ver\n";
275          meteor( -1, "Found reader $hw_ver" );          meteor( 'info', "Found reader hardware $hw_ver" );
276  });  });
277    
278  cmd( 'D6 00  0C   13  04  01 00  02 00  03 00  04 00   AAF2','FIXME: stats?',  cmd( 'D6 00  0C   13  04  01 00  02 00  03 00  04 00   AAF2','FIXME: stats?',
279       'D6 00  0C   13  00  02 01 01 03 02 02 03  00     E778', sub { assert() }  );       'D6 00  0C   13  00  02 01 01 03 02 02 03  00     E778', sub { assert() }  );
280    
281  # start scanning for tags  sub scan_for_tags {
   
 cmd( 'D6 00  05   FE     00  05         FA40', "scan for tags, retry $_",  
          'D6 00  0F   FE  00 00  05 ', sub { # 01 E00401003123AA26  941A         # seen, serial length: 8  
                 my $rest = shift || die "no rest?";  
                 my $nr = ord( substr( $rest, 0, 1 ) );  
   
                 if ( ! $nr ) {  
                         print "no tags in range\n";  
                         update_visible_tags();  
                         meteor( -1, "No tags in range" );  
                 } else {  
282    
283                          my $tags = substr( $rest, 1 );          my @tags;
284    
285                          my $tl = length( $tags );          cmd( 'D6 00  05   FE     00  05         FA40', "scan for tags",
286                          die "wrong length $tl for $nr tags: ",dump( $tags ) if $tl =! $nr * 8;                   'D6 00  0F   FE  00 00  05 ', sub { # 01 E00401003123AA26  941A         # seen, serial length: 8
287                            my $rest = shift || die "no rest?";
288                            my $nr = ord( substr( $rest, 0, 1 ) );
289    
290                          my @tags;                          if ( ! $nr ) {
291                          push @tags, uc(unpack('H16', substr($tags, $_ * 8, 8))) foreach ( 0 .. $nr - 1 );                                  _log "no tags in range\n";
292                          warn "## tags ",as_hex($tags), " [$tl] = ",dump( $tags ) if $debug;                                  update_visible_tags();
293                          print "$nr tags in range: ", join(',', @tags ) , "\n";                                  meteor( 'info-none-in-range' );
294                                    $tags_data = {};
295                            } else {
296    
297                                    my $tags = substr( $rest, 1 );
298                                    my $tl = length( $tags );
299                                    die "wrong length $tl for $nr tags: ",dump( $tags ) if $tl =! $nr * 8;
300    
301                                    push @tags, uc(unpack('H16', substr($tags, $_ * 8, 8))) foreach ( 0 .. $nr - 1 );
302                                    warn "## tags ",as_hex($tags), " [$tl] = ",dump( $tags ) if $debug;
303                                    _log "$nr tags in range: ", join(',', @tags ) , "\n";
304    
305                          update_visible_tags( @tags );                                  meteor( 'info-in-range', join(' ',@tags));
306    
307                          my $html = join('', map { "<li><tt>$_</tt>" } @tags);                                  update_visible_tags( @tags );
308                          meteor( 0, "Tags:<ul>$html</ul>" );                          }
309                  }                  }
310          }          );
 ) foreach ( 1 .. 1000 );  
311    
312            diag "tags: ",dump( @tags );
313            return $tags_data;
314    
315    }
316    
317    # start scanning for tags
318    
319    if ( $http_server ) {
320            http_server;
321    } else {
322            while (1) {
323                    scan_for_tags;
324                    sleep 1;
325            }
326    }
327    
328    die "over and out";
329    
330  sub update_visible_tags {  sub update_visible_tags {
331          my @tags = @_;          my @tags = @_;
# Line 156  sub update_visible_tags { Line 334  sub update_visible_tags {
334          $visible_tags = {};          $visible_tags = {};
335    
336          foreach my $tag ( @tags ) {          foreach my $tag ( @tags ) {
337                    $visible_tags->{$tag}++;
338                  if ( ! defined $last_visible_tags->{$tag} ) {                  if ( ! defined $last_visible_tags->{$tag} ) {
339                          read_tag( $tag );                          if ( defined $tags_data->{$tag} ) {
340                          $visible_tags->{$tag}++;  #                               meteor( 'in-range', $tag );
341                            } else {
342                                    meteor( 'read', $tag );
343                                    read_tag( $tag );
344                            }
345                  } else {                  } else {
346                          warn "## using cached data for $tag" if $debug;                          warn "## using cached data for $tag" if $debug;
347                  }                  }
348                  delete $last_visible_tags->{$tag}; # leave just missing tags                  delete $last_visible_tags->{$tag}; # leave just missing tags
349    
350                    if ( -e "$program_path/$tag" ) {
351                                    meteor( 'write', $tag );
352                                    write_tag( $tag );
353                    }
354                    if ( -e "$secure_path/$tag" ) {
355                                    meteor( 'secure', $tag );
356                                    secure_tag( $tag );
357                    }
358          }          }
359    
360          foreach my $tag ( keys %$last_visible_tags ) {          foreach my $tag ( keys %$last_visible_tags ) {
361                  my $data = delete $tags_data->{$tag};                  my $data = delete $tags_data->{$tag};
362                  print "removed tag $tag with data ",dump( $data ),"\n";                  print "removed tag $tag with data ",dump( $data ),"\n";
363                    meteor( 'removed', $tag );
364          }          }
365    
366          warn "## update_visible_tags(",dump( @tags ),") = ",dump( $visible_tags )," removed: ",dump( $last_visible_tags ), " data: ",dump( $tags_data ) if $debug;          warn "## update_visible_tags(",dump( @tags ),") = ",dump( $visible_tags )," removed: ",dump( $last_visible_tags ), " data: ",dump( $tags_data ) if $debug;
367  }  }
368    
369    my $tag_data_block;
370    
371    sub read_tag_data {
372            my ($start_block,$rest) = @_;
373            die "no rest?" unless $rest;
374    
375            my $last_block = 0;
376    
377            warn "## DATA [$start_block] ", dump( $rest ) if $debug;
378            my $tag = uc(unpack('H16',substr( $rest, 0, 8 )));
379            my $blocks = ord(substr($rest,8,1));
380            $rest = substr($rest,9); # leave just data blocks
381            foreach my $nr ( 0 .. $blocks - 1 ) {
382                    my $block = substr( $rest, $nr * 6, 6 );
383                    warn "## block ",as_hex( $block ) if $debug;
384                    my $ord   = unpack('v',substr( $block, 0, 2 ));
385                    my $expected_ord = $nr + $start_block;
386                    warn "got block $ord, expected block $expected_ord from ",dump( $block ) if $ord != $expected_ord;
387                    my $data  = substr( $block, 2 );
388                    die "data payload should be 4 bytes" if length($data) != 4;
389                    warn sprintf "## tag %9s %02d: %s |%-4s|\n", $tag, $ord, as_hex( $data ), $data;
390                    $tag_data_block->{$tag}->[ $ord ] = $data;
391                    $last_block = $ord;
392            }
393            $tags_data->{ $tag } = join('', @{ $tag_data_block->{$tag} });
394    
395            my $item_type_nr = ord(substr( $tags_data->{$tag}, 3, 1 ));
396            print "DATA $tag ",dump( $tags_data ), " item type: ", ( $item_type->{ $item_type_nr } || "UNKWOWN '$item_type_nr'" ), "\n";
397    
398            return $last_block + 1;
399    }
400    
401    my $saved_in_log;
402    
403    sub decode_tag {
404            my $tag = shift;
405    
406            my $data = $tags_data->{$tag} || die "no data for $tag";
407    
408            my ( $u1, $set_item, $u2, $type, $content, $br_lib, $custom ) = unpack('C4Z16Nl>',$data);
409            my $hash = {
410                    u1 => $u1,
411                    u2 => $u2,
412                    set => ( $set_item & 0xf0 ) >> 4,
413                    total => ( $set_item & 0x0f ),
414    
415                    type => $type,
416                    content => $content,
417    
418                    branch => $br_lib >> 20,
419                    library => $br_lib & 0x000fffff,
420    
421                    custom => $custom,
422            };
423    
424            if ( ! $saved_in_log->{$tag}++ ) {
425                    open(my $log, '>>', 'rfid-log.txt');
426                    print $log strftime( "%Y-%m-%d %H:%M:%S", localtime ), ",$tag,$content\n";
427                    close($log);
428            }
429    
430            return $hash;
431    }
432    
433  sub read_tag {  sub read_tag {
434          my ( $tag ) = @_;          my ( $tag ) = @_;
435    
436          confess "no tag?" unless $tag;          confess "no tag?" unless $tag;
437    
         return if defined $tags_data->{$tag};  
   
438          print "read_tag $tag\n";          print "read_tag $tag\n";
439    
440            my $start_block = 0;
441    
442            while ( $start_block < $max_rfid_block ) {
443    
444                    cmd(
445                             sprintf( "D6 00  0D  02      $tag   %02x   %02x     ffff", $start_block, $read_blocks ),
446                                    "read $tag offset: $start_block blocks: $read_blocks",
447                            "D6 00  1F  02 00", sub { # $tag  03   00 00   04 11 00 01   01 00   31 32 33 34   02 00   35 36 37 38    531F\n";
448                                    $start_block = read_tag_data( $start_block, @_ );
449                                    warn "# read tag upto $start_block\n";
450                            },
451                            "D6 00  0F  FE  00 00  05 01   $tag    941A", sub {
452                                    print "FIXME: tag $tag ready? (expected block read instead)\n";
453                            },
454                    );
455    
456            }
457    
458            my $security;
459    
460          cmd(          cmd(
461                  "D6 00  0D  02      $tag   00   03     1CC4", 'read $tag offset: 0 blocks: 3',                  "D6 00 0B 0A $tag 1234", "check security $tag",
462                  "D6 00  0F  FE  00 00  05 01   $tag    941A", sub {                  "D6 00 0D 0A 00", sub {
463                          print "FIXME: tag $tag ready?\n";                          my $rest = shift;
464                  },                          my $from_tag;
465                  "D6 00  1F  02 00", sub { # $tag  03   00 00   04 11 00 01   01 00   31 32 33 34   02 00   35 36 37 38    531F\n";                          ( $from_tag, $security ) = ( substr($rest,0,8), substr($rest,8,1) );
466                          my $rest = shift || die "no rest?";                          die "security from other tag: ",as_hex( $from_tag ) if $from_tag ne str2bytes( $tag );
467                          warn "## DATA ", dump( $rest ) if $debug;                          $security = as_hex( $security );
468                          my $tag = uc(unpack('H16',substr( $rest, 0, 8 )));                          $tags_security->{$tag} = $security;
469                          my $blocks = ord(substr($rest,8,1));                          warn "# SECURITY $tag = $security\n";
                         $rest = substr($rest,9); # leave just data blocks  
                         my @data;  
                         foreach my $nr ( 0 .. $blocks - 1 ) {  
                                 my $block = substr( $rest, $nr * 6, 6 );  
                                 warn "## block ",as_hex( $block ) if $debug;  
                                 my $ord   = unpack('v',substr( $block, 0, 2 ));  
                                 die "got block $ord, expected block $nr from ",dump( $block ) if $ord != $nr;  
                                 my $data  = substr( $block, 2 );  
                                 die "data payload should be 4 bytes" if length($data) != 4;  
                                 warn sprintf "## tag %08s %02d %s |%-4s|\n", $tag, $ord, as_hex( $data ), $data;  
                                 $data[ $ord ] = $data;  
                         }  
                         $tags_data->{ $tag } = join('', @data);  
                         print "DATA $tag ",dump( $tags_data ), "\n";  
470                  }                  }
471          );          );
472    
473          #        D6 00  1F  02 00   $tag   03   00 00   04 11 00 01   01 00   30 30 30 30   02 00   30 30 30 30    E5F4          print "TAG $tag ", dump(decode_tag( $tag ));
474  if (0) {  }
475          cmd(    "D6 00  0D  02      $tag   03   04     3970", 'read offset: 3 blocks: 4' );  
476    sub write_tag {
477          #        D6 00  25  02 00   $tag   04                         03 00   30 30 00 00   04 00   00 00 00 00            my ($tag,$data) = @_;
478          #                           $tag                              05 00   00 00 00 00   06 00   00 00 00 00    B9BA  
479          warn "?? D6 00  25  02 00   $tag   04                         03 00   39 30 31 32   04 00   ....\n";          my $path = "$program_path/$tag";
480            $data = read_file( $path ) if -e $path;
481    
482            die "no data" unless $data;
483    
484            my $hex_data;
485    
486            if ( $data =~ s{^hex\s+}{} ) {
487                    $hex_data = $data;
488                    $hex_data =~ s{\s+}{}g;
489            } else {
490    
491                    $data .= "\0" x ( 4 - ( length($data) % 4 ) );
492    
493                    my $max_len = $max_rfid_block * 4;
494    
495                    if ( length($data) > $max_len ) {
496                            $data = substr($data,0,$max_len);
497                            warn "strip content to $max_len bytes\n";
498                    }
499    
500                    $hex_data = unpack('H*', $data);
501            }
502    
503            my $len = length($hex_data) / 2;
504            # pad to block size
505            $hex_data .= '00' x ( 4 - $len % 4 );
506            my $blocks = sprintf('%02x', length($hex_data) / 4);
507    
508            print "write_tag $tag = ",dump( $data ), " [$len/$blocks] == $hex_data\n";
509    
510            cmd(
511                    "d6 00  ff  04  $tag  00 $blocks 00  $hex_data  ffff", "write $tag",
512                    "d6 00  0d  04 00  $tag  $blocks  afb1", sub { assert() },
513            ); # foreach ( 1 .. 3 ); # XXX 3m software does this three times!
514    
515            my $to = $path;
516            $to .= '.' . time();
517    
518            rename $path, $to;
519            print ">> $to\n";
520    
521            # force re-read of tag
522            delete $tags_data->{$tag};
523            delete $visible_tags->{$tag};
524  }  }
         warn "?? D6 00  0F  FE  00 00  05 01   $tag  941A ##### ready?\n";  
525    
526          my $item = unpack('H*', substr($tag,-8) ) % 100000;  sub secure_tag {
527          meteor( $item, "Loading $item" );          my ($tag) = @_;
528    
529            my $path = "$secure_path/$tag";
530            my $data = substr(read_file( $path ),0,2);
531    
532            cmd(
533                    "d6 00  0c  09  $tag $data 1234", "secure $tag -> $data",
534                    "d6 00  0c  09 00  $tag  1234", sub { assert() },
535            );
536    
537            my $to = $path;
538            $to .= '.' . time();
539    
540            rename $path, $to;
541            print ">> $to\n";
542  }  }
543    
544  exit;  exit;
# Line 257  sub writechunk Line 573  sub writechunk
573  {  {
574          my $str=shift;          my $str=shift;
575          my $count = $port->write($str);          my $count = $port->write($str);
576            my $len = length($str);
577            die "wrong write length $count != $len in ",as_hex( $str ) if $count != $len;
578          print "#> ", as_hex( $str ), "\t[$count]\n" if $debug;          print "#> ", as_hex( $str ), "\t[$count]\n" if $debug;
579  }  }
580    
# Line 276  sub read_bytes { Line 594  sub read_bytes {
594          my $data = '';          my $data = '';
595          while ( length( $data ) < $len ) {          while ( length( $data ) < $len ) {
596                  my ( $c, $b ) = $port->read(1);                  my ( $c, $b ) = $port->read(1);
597                    die "no bytes on port: $!" unless defined $b;
598                  #warn "## got $c bytes: ", as_hex($b), "\n";                  #warn "## got $c bytes: ", as_hex($b), "\n";
599                  $data .= $b;                  $data .= $b;
600          }          }
# Line 322  sub crcccitt { Line 641  sub crcccitt {
641  sub checksum {  sub checksum {
642          my ( $bytes, $checksum ) = @_;          my ( $bytes, $checksum ) = @_;
643    
         my $xor = crcccitt( substr($bytes,1) ); # skip D6  
         warn "## checksum ",dump( $bytes, $xor, $checksum ) if $debug;  
   
644          my $len = ord(substr($bytes,2,1));          my $len = ord(substr($bytes,2,1));
645          my $len_real = length($bytes) - 1;          my $len_real = length($bytes) - 1;
646    
647          if ( $len_real != $len ) {          if ( $len_real != $len ) {
648                  print "length wrong: $len_real != $len\n";                  print "length wrong: $len_real != $len\n";
649                  $bytes = substr($bytes,0,2) . chr($len_real) . substr($bytes,4);                  $bytes = substr($bytes,0,2) . chr($len_real) . substr($bytes,3);
650          }          }
651    
652            my $xor = crcccitt( substr($bytes,1) ); # skip D6
653            warn "## checksum ",dump( $bytes, $xor, $checksum ) if $debug;
654    
655          if ( defined $checksum && $xor ne $checksum ) {          if ( defined $checksum && $xor ne $checksum ) {
656                  print "checksum doesn't match: ", as_hex($xor), " != ", as_hex($checksum), " data: ", as_hex($bytes), "\n";                  print "checksum doesn't match: ", as_hex($xor), " != ", as_hex($checksum), " data: ", as_hex($bytes), "\n";
657                  return $bytes . $xor;                  return $bytes . $xor;
# Line 343  sub checksum { Line 662  sub checksum {
662  our $dispatch;  our $dispatch;
663    
664  sub readchunk {  sub readchunk {
665          sleep 1;        # FIXME remove  #       sleep 1;        # FIXME remove
666    
667          # read header of packet          # read header of packet
668          my $header = read_bytes( 2, 'header' );          my $header = read_bytes( 2, 'header' );
# Line 372  sub readchunk { Line 691  sub readchunk {
691          warn "?? payload dispatch to ",dump( $payload, $dispatch, $to ) if $debug;          warn "?? payload dispatch to ",dump( $payload, $dispatch, $to ) if $debug;
692    
693          if ( defined $to ) {          if ( defined $to ) {
694                  my $rest = substr( $payload, length($to) );                  my $rest = substr( $payload, length($to) ) if length($to) < length($payload);
695                  warn "## DISPATCH payload to with rest", dump( $payload, $to, $rest ) if $debug;                  warn "## DISPATCH payload to with rest", dump( $payload, $to, $rest ) if $debug;
696                  $dispatch->{ $to }->( $rest );                  $dispatch->{ $to }->( $rest );
697          } else {          } else {
698                  print "NO DISPATCH for ",dump( $full ),"\n";                  print "NO DISPATCH for ",as_hex( $full ),"\n";
699          }          }
700    
701          return $data;          return $data;
Legend:
Removed from v.23  
changed lines
  Added in v.62
  ViewVC Help
Powered by ViewVC 1.1.26