/[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 18 by dpavlin, Fri Oct 3 12:31:58 2008 UTC revision 36 by dpavlin, Mon Jun 1 09:39:44 2009 UTC
# Line 6  use warnings; Line 6  use warnings;
6    
7  use Data::Dump qw/dump/;  use Data::Dump qw/dump/;
8  use Carp qw/confess/;  use Carp qw/confess/;
9    use Getopt::Long;
10    use File::Slurp;
11    
12    use IO::Socket::INET;
13    
14    my $meteor_server = '192.168.1.13:4671';
15    my $meteor_fh;
16    
17    sub meteor {
18            my @a = @_;
19            push @a, scalar localtime() if $a[0] =~ m{^info};
20    
21            if ( ! defined $meteor_fh ) {
22                    if ( $meteor_fh =
23                                    IO::Socket::INET->new(
24                                            PeerAddr => $meteor_server,
25                                            Timeout => 1,
26                                    )
27                    ) {
28                            warn "# meteor connected to $meteor_server";
29                    } else {
30                            warn "can't connect to meteor $meteor_server: $!";
31                            $meteor_fh = 0;
32                    }
33            }
34    
35            if ( $meteor_fh ) {
36                    warn ">> meteor ",dump( @a );
37                    print $meteor_fh "ADDMESSAGE test ",join('|',@a),"\n"
38            }
39    }
40    
41  my $debug = 0;  my $debug = 0;
42    
43    my $device    = "/dev/ttyUSB0";
44    my $baudrate  = "19200";
45    my $databits  = "8";
46    my $parity        = "none";
47    my $stopbits  = "1";
48    my $handshake = "none";
49    
50    my $program_path = './program/';
51    my $secure_path = './secure/';
52    
53  my $response = {  my $response = {
54          'd500090400110a0500027250'                              => 'version?',          'd500090400110a0500027250'                              => 'version?',
55          'd60007fe00000500c97b'                                  => 'no tag in range',          'd60007fe00000500c97b'                                  => 'no tag in range',
# Line 21  my $response = { Line 62  my $response = {
62          'd60017fe00000502e00401003123aa26e00401003123aa283124' => 'tag #1 + tag red-stripe',          'd60017fe00000502e00401003123aa26e00401003123aa283124' => 'tag #1 + tag red-stripe',
63  };  };
64    
65    GetOptions(
66            'd|debug+'    => \$debug,
67            'device=s'    => \$device,
68            'baudrate=i'  => \$baudrate,
69            'databits=i'  => \$databits,
70            'parity=s'    => \$parity,
71            'stopbits=i'  => \$stopbits,
72            'handshake=s' => \$handshake,
73            'meteor=s'    => \$meteor_server,
74    ) or die $!;
75    
76    my $verbose = $debug > 0 ? $debug-- : 0;
77    
78  =head1 NAME  =head1 NAME
79    
80  3m-810 - support for 3M 810 RFID reader  3m-810 - support for 3M 810 RFID reader
81    
82  =head1 SYNOPSIS  =head1 SYNOPSIS
83    
84  3m-810.pl [DEVICE [BAUD [DATA [PARITY [STOP [FLOW]]]]]]  3m-810.pl --device /dev/ttyUSB0
85    
86  =head1 DESCRIPTION  =head1 DESCRIPTION
87    
# Line 52  it under the same terms ans Perl itself. Line 106  it under the same terms ans Perl itself.
106    
107  =cut  =cut
108    
109  # your serial port.  my $tags_data;
110  my ($device,$baudrate,$databits,$parity,$stopbits,$handshake)=@ARGV;  my $visible_tags;
111  $device    ||= "/dev/ttyUSB0";  
112  $baudrate  ||= "19200";  my $item_type = {
113  $databits  ||= "8";          1 => 'Book',
114  $parity    ||= "none";          6 => 'CD/CD ROM',
115  $stopbits  ||= "1";          2 => 'Magazine',
116  $handshake ||= "none";          13 => 'Book with Audio Tape',
117            9 => 'Book with CD/CD ROM',
118            0 => 'Other',
119    
120            5 => 'Video',
121            4 => 'Audio Tape',
122            3 => 'Bound Journal',
123            8 => 'Book with Diskette',
124            7 => 'Diskette',
125    };
126    
127    warn "## known item type: ",dump( $item_type ) if $debug;
128    
129  my $port=new Device::SerialPort($device) || die "new($device): $!\n";  my $port=new Device::SerialPort($device) || die "can't open serial port $device: $!\n";
130    warn "using $device $handshake $baudrate $databits $parity $stopbits" if $debug;
131  $handshake=$port->handshake($handshake);  $handshake=$port->handshake($handshake);
132  $baudrate=$port->baudrate($baudrate);  $baudrate=$port->baudrate($baudrate);
133  $databits=$port->databits($databits);  $databits=$port->databits($databits);
134  $parity=$port->parity($parity);  $parity=$port->parity($parity);
135  $stopbits=$port->stopbits($stopbits);  $stopbits=$port->stopbits($stopbits);
136    
137  print "## using $device $baudrate $databits $parity $stopbits\n";  print "## using $device $baudrate $databits $parity $stopbits debug: $debug verbose: $verbose\n";
138    
139  # Just in case: reset our timing and buffers  # Just in case: reset our timing and buffers
140  $port->lookclear();  $port->lookclear();
# Line 81  $port->read_char_time(5); Line 147  $port->read_char_time(5);
147    
148  # initial hand-shake with device  # initial hand-shake with device
149    
150  cmd( 'D5 00  05   04 00 11                 8C66', 'hw version?',  cmd( 'D5 00  05   04 00 11                 8C66', 'hw version',
151       'D5 00  09   04 00 11   0A 05 00 02   7250', 'hw 10.5.0.2', sub {       'D5 00  09   04 00 11   0A 05 00 02   7250', sub {
152          print "hardware version ", join('.', unpack('CCCC', skip_assert(3) )), "\n";          my $hw_ver = join('.', unpack('CCCC', skip_assert(3) ));
153            print "hardware version $hw_ver\n";
154            meteor( 'info', "Found reader hardware $hw_ver" );
155  });  });
156    
157  cmd( 'D6 00  0C   13  04  01 00  02 00  03 00  04 00   AAF2','stats?',  cmd( 'D6 00  0C   13  04  01 00  02 00  03 00  04 00   AAF2','FIXME: stats?',
158       'D6 00  0C   13  00  02 01 01 03 02 02 03  00     E778','FIXME: unimplemented', sub { assert() }  );       'D6 00  0C   13  00  02 01 01 03 02 02 03  00     E778', sub { assert() }  );
159    
160  # start scanning for tags  # start scanning for tags
161    
162  cmd( 'D6 00  05   FE     00  05         FA40', "XXX scan $_",  cmd( 'D6 00  05   FE     00  05         FA40', "scan for tags, retry $_",
163       'D6 00  07   FE  00 00  05     00  C97B', 'no tag', sub {           'D6 00  0F   FE  00 00  05 ', sub { # 01 E00401003123AA26  941A         # seen, serial length: 8
164  dispatch(                  my $rest = shift || die "no rest?";
165           'D6 00  0F   FE  00 00  05 ',# 01 E00401003123AA26  941A        # seen, serial length: 8                  my $nr = ord( substr( $rest, 0, 1 ) );
166                  sub {  
167                          my $rest = shift || die "no rest?";                  if ( ! $nr ) {
168                          my $nr = ord( substr( $rest, 0, 1 ) );                          print "no tags in range\n";
169                            update_visible_tags();
170                            meteor( 'info-none-in-range' );
171                            $tags_data = {};
172                    } else {
173    
174                          my $tags = substr( $rest, 1 );                          my $tags = substr( $rest, 1 );
175    
176                          my $tl = length( $tags );                          my $tl = length( $tags );
# Line 106  dispatch( Line 179  dispatch(
179                          my @tags;                          my @tags;
180                          push @tags, uc(unpack('H16', substr($tags, $_ * 8, 8))) foreach ( 0 .. $nr - 1 );                          push @tags, uc(unpack('H16', substr($tags, $_ * 8, 8))) foreach ( 0 .. $nr - 1 );
181                          warn "## tags ",as_hex($tags), " [$tl] = ",dump( $tags ) if $debug;                          warn "## tags ",as_hex($tags), " [$tl] = ",dump( $tags ) if $debug;
182                          print "seen $nr tags: ", join(',', @tags ) , "\n";                          print "$nr tags in range: ", join(',', @tags ) , "\n";
183    
184                          # XXX read first tag                          meteor( 'info-in-range', join(' ',@tags));
                         read_tag( @tags );  
185    
186                            update_visible_tags( @tags );
187                  }                  }
188  ) }          }
189    ) while(1);
190    #) foreach ( 1 .. 100 );
191    
192    
193    
194  ) foreach ( 1 .. 100 );  sub update_visible_tags {
195            my @tags = @_;
196    
197  my $read_cached;          my $last_visible_tags = $visible_tags;
198            $visible_tags = {};
199    
200            foreach my $tag ( @tags ) {
201                    if ( ! defined $last_visible_tags->{$tag} ) {
202                            if ( defined $tags_data->{$tag} ) {
203    #                               meteor( 'in-range', $tag );
204                            } else {
205                                    meteor( 'read', $tag );
206                                    read_tag( $tag );
207                            }
208                            $visible_tags->{$tag}++;
209                    } else {
210                            warn "## using cached data for $tag" if $debug;
211                    }
212                    delete $last_visible_tags->{$tag}; # leave just missing tags
213    
214                    if ( -e "$program_path/$tag" ) {
215                                    meteor( 'write', $tag );
216                                    write_tag( $tag );
217                    }
218                    if ( -e "$secure_path/$tag" ) {
219                                    meteor( 'secure', $tag );
220                                    secure_tag( $tag );
221                    }
222            }
223    
224            foreach my $tag ( keys %$last_visible_tags ) {
225                    my $data = delete $tags_data->{$tag};
226                    print "removed tag $tag with data ",dump( $data ),"\n";
227                    meteor( 'removed', $tag );
228            }
229    
230            warn "## update_visible_tags(",dump( @tags ),") = ",dump( $visible_tags )," removed: ",dump( $last_visible_tags ), " data: ",dump( $tags_data ) if $debug;
231    }
232    
233    my $tag_data_block;
234    
235    sub read_tag_data {
236            my ($start_block,$rest) = @_;
237            die "no rest?" unless $rest;
238            warn "## DATA [$start_block] ", dump( $rest ) if $debug;
239            my $tag = uc(unpack('H16',substr( $rest, 0, 8 )));
240            my $blocks = ord(substr($rest,8,1));
241            $rest = substr($rest,9); # leave just data blocks
242            foreach my $nr ( 0 .. $blocks - 1 ) {
243                    my $block = substr( $rest, $nr * 6, 6 );
244                    warn "## block ",as_hex( $block ) if $debug;
245                    my $ord   = unpack('v',substr( $block, 0, 2 ));
246                    my $expected_ord = $nr + $start_block;
247                    die "got block $ord, expected block $expected_ord from ",dump( $block ) if $ord != $expected_ord;
248                    my $data  = substr( $block, 2 );
249                    die "data payload should be 4 bytes" if length($data) != 4;
250                    warn sprintf "## tag %9s %02d %s |%-4s|\n", $tag, $ord, as_hex( $data ), $data;
251                    $tag_data_block->{$tag}->[ $ord ] = $data;
252            }
253            $tags_data->{ $tag } = join('', @{ $tag_data_block->{$tag} });
254    
255            my $item_type_nr = ord(substr( $tags_data->{$tag}, 3, 1 ));
256            print "DATA $tag ",dump( $tags_data ), " item type: ", ( $item_type->{ $item_type_nr } || "UNKWOWN '$item_type_nr' in " . dump( $item_type ) ), "\n";
257    }
258    
259  sub read_tag {  sub read_tag {
260          my ( $tag ) = @_;          my ( $tag ) = @_;
261    
262            confess "no tag?" unless $tag;
263    
264          print "read_tag $tag\n";          print "read_tag $tag\n";
         return if $read_cached->{ $tag }++;  
265    
266          cmd(    "D6 00  0D  02      $tag   00   03     1CC4", 'read $tag offset: 0 blocks: 3',          cmd(
267                          "D6 00  0F  FE  00 00  05 01   $tag    941A", "$tag ready?", sub {                  "D6 00  0D  02      $tag   00   03     1CC4", "read $tag offset: 0 blocks: 3",
268  dispatch(       "D6 00  1F  02 00   $tag   ", sub { # 03   00 00   04 11 00 01   01 00   31 32 33 34   02 00   35 36 37 38    531F\n";                  "D6 00  0F  FE  00 00  05 01   $tag    941A", sub {
269                          my $rest = shift || die "no rest?";                          print "FIXME: tag $tag ready?\n";
270                          warn "## DATA ", dump( $rest ) if $debug;                  },
271                          my $blocks = ord(substr($rest,0,1));                  "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";
272                          my @data;                          read_tag_data( 0, @_ );
273                          foreach my $nr ( 0 .. $blocks - 1 ) {                  },
274                                  my $block = substr( $rest, 1 + $nr * 6, 6 );          );
275                                  warn "## block ",as_hex( $block ) if $debug;  
276                                  my $ord   = unpack('v',substr( $block, 0, 2 ));          cmd(
277                                  die "got block $ord, expected block $nr from ",dump( $block ) if $ord != $nr;                  "D6 00  0D  02      $tag   03   04     3970", "read $tag offset: 3 blocks: 4",
278                                  my $data  = substr( $block, 2 );                  "D6 00  25  02 00", sub { # $tag   04                         03 00   30 30 00 00   04 00   00 00 00 00  
279                                  die "data payload should be 4 bytes" if length($data) != 4;                          read_tag_data( 3, @_ );
280                                  warn sprintf "## tag %08s %02d %s |%-4s|\n", $tag, $ord, as_hex( $data ), $data;                  }
281                                  $data[ $ord ] = $data;          );
282                          }  
283                          $read_cached->{ $tag } = join('', @data);          my $security;
284                          print "DATA $tag ",dump( $read_cached->{ $tag } ), "\n";  
285                  })          cmd(
286          });                  "D6 00 0B 0A $tag 1234", "check security $tag",
287                    "D6 00 0D 0A 00", sub {
288          #        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                          my $rest = shift;
289  if (0) {                          my $from_tag;
290          cmd(    "D6 00  0D  02      $tag   03   04     3970", 'read offset: 3 blocks: 4' );                          ( $from_tag, $security ) = ( substr($rest,0,8), substr($rest,8,1) );
291                            die "security from other tag: ",as_hex( $from_tag ) if $from_tag ne str2bytes( $tag );
292          #        D6 00  25  02 00   $tag   04                         03 00   30 30 00 00   04 00   00 00 00 00                            $security = as_hex( $security );
293          #                           $tag                              05 00   00 00 00 00   06 00   00 00 00 00    B9BA                          warn "# SECURITY $tag = $security\n";
294          warn "?? D6 00  25  02 00   $tag   04                         03 00   39 30 31 32   04 00   ....\n";                  }
295            );
296    
297            my $data = $tags_data->{$tag} || die "no data for $tag";
298            my ( $u1, $set_item, $u2, $type, $content, $br_lib, $custom ) = unpack('C4Z16Nl>',$data);
299            my $set   = ( $set_item & 0xf0 ) >> 4;
300            my $total = ( $set_item & 0x0f );
301            my $branch  = $br_lib >> 20;
302            my $library = $br_lib & 0x000fffff;
303            print "TAG $tag [$u1] set: $set/$total [$u2] type: $type '$content' branch: $branch library: $library custom: $custom security: $security\n";
304    
305    }
306    
307    sub write_tag {
308            my ($tag) = @_;
309    
310            my $path = "$program_path/$tag";
311    
312            my $data = read_file( $path );
313    
314            $data = substr($data,0,16);
315    
316            my $hex_data = unpack('H*', $data) . ' 00' x ( 16 - length($data) );
317    
318            print "write_tag $tag = ",dump( $data ), " == $hex_data\n";
319    
320            cmd(
321                    "d6 00  26  04  $tag  00 06 00  04 11 00 01  $hex_data 00 00 00 00  fd3b", "write $tag",
322                    "d6 00  0d  04 00  $tag  06  afb1", sub { assert() },
323            ) foreach ( 1 .. 3 ); # xxx 3m software does this three times!
324    
325            my $to = $path;
326            $to .= '.' . time();
327    
328            rename $path, $to;
329            print ">> $to\n";
330    
331            delete $tags_data->{$tag};      # force re-read of tag
332  }  }
         warn "?? D6 00  0F  FE  00 00  05 01   $tag  941A ##### ready?\n";  
333    
334    sub secure_tag {
335            my ($tag) = @_;
336    
337            my $path = "$secure_path/$tag";
338            my $data = substr(read_file( $path ),0,2);
339    
340            cmd(
341                    "d6 00  0c  09  $tag $data 1234", "secure $tag -> $data",
342                    "d6 00  0c  09 00  $tag  1234", sub { assert() },
343            );
344    
345            my $to = $path;
346            $to .= '.' . time();
347    
348            rename $path, $to;
349            print ">> $to\n";
350  }  }
351    
352    exit;
353    
354  for ( 1 .. 3 ) {  for ( 1 .. 3 ) {
355    
356  #                                                              ++-->type 00-0a  #                                                              ++-->type 00-0a
# Line 188  sub writechunk Line 381  sub writechunk
381  {  {
382          my $str=shift;          my $str=shift;
383          my $count = $port->write($str);          my $count = $port->write($str);
384          print "#> ", as_hex( $str ), "\t[$count]" if $debug;          print "#> ", as_hex( $str ), "\t[$count]\n" if $debug;
385  }  }
386    
387  sub as_hex {  sub as_hex {
# Line 207  sub read_bytes { Line 400  sub read_bytes {
400          my $data = '';          my $data = '';
401          while ( length( $data ) < $len ) {          while ( length( $data ) < $len ) {
402                  my ( $c, $b ) = $port->read(1);                  my ( $c, $b ) = $port->read(1);
403                    die "no bytes on port: $!" unless defined $b;
404                  #warn "## got $c bytes: ", as_hex($b), "\n";                  #warn "## got $c bytes: ", as_hex($b), "\n";
405                  $data .= $b;                  $data .= $b;
406          }          }
# Line 236  sub assert { Line 430  sub assert {
430          return substr( $assert->{payload}, $to );          return substr( $assert->{payload}, $to );
431  }  }
432    
 our $dispatch;  
 sub dispatch {  
         my ( $pattern, $coderef ) = @_;  
         my $patt = substr( str2bytes($pattern), 3 ); # just payload  
         my $l = length($patt);  
         my $p = substr( $assert->{payload}, 0, $l );  
         warn "## dispatch pattern $pattern [$l] ",dump( $patt, $p ) if $debug;  
   
         if ( $assert->{payload} eq $assert->{expect} ) {  
                 warn "## no dispatch, payload expected" if $debug;  
         } elsif ( $p eq $patt ) {  
                 # if matched call with rest of payload  
                 $coderef->( substr( $assert->{payload}, $l ) );  
         } else {  
                 warn "## dispatch ignored" if $debug;  
         }  
 }  
   
433  use Digest::CRC;  use Digest::CRC;
434    
435  sub crcccitt {  sub crcccitt {
# Line 289  sub checksum { Line 465  sub checksum {
465          return $bytes . $checksum;          return $bytes . $checksum;
466  }  }
467    
468  sub readchunk {  our $dispatch;
         my ( $parser ) = @_;  
469    
470    sub readchunk {
471          sleep 1;        # FIXME remove          sleep 1;        # FIXME remove
472    
473          # read header of packet          # read header of packet
# Line 305  sub readchunk { Line 481  sub readchunk {
481          warn "## payload too short $payload_len != $len\n" if $payload_len != $len;          warn "## payload too short $payload_len != $len\n" if $payload_len != $len;
482    
483          my $checksum = substr( $data, -2, 2 );          my $checksum = substr( $data, -2, 2 );
484          checksum( $header . $length . $payload, $checksum );          checksum( $header . $length . $payload , $checksum );
485    
486          print "<< ",as_hex( $header ), " [$len] ", as_hex( $payload ), " | sum: ",as_hex($checksum),"\n";          print "<< ",as_hex( $header ), " [$len] ", as_hex( $payload ), " | sum: ",as_hex($checksum),"\n" if $verbose;
487    
488          $assert->{len}      = $len;          $assert->{len}      = $len;
489          $assert->{payload}  = $payload;          $assert->{payload}  = $payload;
490    
491          $parser->( $len, $payload ) if $parser && ref($parser) eq 'CODE';          my $full = $header . $length . $data; # full
492            # find longest match for incomming data
493            my ($to) = grep {
494                    my $match = substr($payload,0,length($_));
495                    m/^\Q$match\E/
496            } sort { length($a) <=> length($b) } keys %$dispatch;
497            warn "?? payload dispatch to ",dump( $payload, $dispatch, $to ) if $debug;
498    
499            if ( defined $to ) {
500                    my $rest = substr( $payload, length($to) );
501                    warn "## DISPATCH payload to with rest", dump( $payload, $to, $rest ) if $debug;
502                    $dispatch->{ $to }->( $rest );
503            } else {
504                    print "NO DISPATCH for ",dump( $full ),"\n";
505            }
506    
507          return $data;          return $data;
508  }  }
# Line 330  sub str2bytes { Line 520  sub str2bytes {
520  }  }
521    
522  sub cmd {  sub cmd {
523          my ( $cmd, $cmd_desc, $expect, $expect_desc, $coderef ) = @_;          my $cmd = shift || confess "no cmd?";
524            my $cmd_desc = shift || confess "no description?";
525            my @expect = @_;
526    
527          my $bytes = str2bytes( $cmd );          my $bytes = str2bytes( $cmd );
528    
529          # fix checksum if needed          # fix checksum if needed
530          $bytes = checksum( substr( $bytes, 0, -2 ), substr( $bytes, -2, 2 ) );          $bytes = checksum( substr( $bytes, 0, -2 ), substr( $bytes, -2, 2 ) );
531    
532          warn ">> ", as_hex( $bytes ), "\t## $cmd_desc\n";          warn ">> ", as_hex( $bytes ), "\t## $cmd_desc\n" if $verbose;
533          $assert->{send} = $cmd;          $assert->{send} = $cmd;
534          writechunk( $bytes );          writechunk( $bytes );
535    
536          if ( $expect ) {          while ( @expect ) {
537                  warn "?? $expect", $expect_desc ? "\t## $expect_desc" : '', "\n";                  my $pattern = str2bytes( shift @expect ) || confess "no pattern?";
538                  $assert->{expect} = substr(str2bytes($expect), 3, -2); # just expected payload                  my $coderef = shift @expect || confess "no coderef?";
539                  readchunk( $coderef );                  confess "not coderef" unless ref $coderef eq 'CODE';
540    
541                    next if defined $dispatch->{ $pattern };
542    
543                    $dispatch->{ substr($pattern,3) } = $coderef;
544                    warn "++ dispatch ", as_hex($pattern) ,dump( $dispatch ) if $debug;
545          }          }
546    
547            readchunk;
548  }  }
549    
Legend:
Removed from v.18  
changed lines
  Added in v.36
  ViewVC Help
Powered by ViewVC 1.1.26