git.rot13.org Git - vrDialog/blob - dialog.pl

   1 #!/usr/bin/perl
   2 use warnings;
   3 use strict;
   4
   5 use Data::Dump qw(dump);
   6 my $debug = $ENV{DEBUG} || 0;
   7
   8 =for serial_port
   9
  10 use Device::SerialPort qw(:STAT);
  11
  12 my $port = Device::SerialPort->new('/dev/ttyUSB0');
  13 die "can't open serial port" unless $port;
  14 $port->baudrate(9600);
  15 $port->databits(8);
  16 $port->parity('none');
  17 $port->stopbits(1);
  18 $port->handshake('none');
  19
  20 $port->read_char_time(500);
  21 $port->read_const_time(1000);
  22
  23 sub read_serial {
  24         my $len = shift;
  25         return $port->read( $len );
  26 }
  27
  28 sub write_serial {
  29         my $bytes = shift;
  30         return $port->write( $bytes );
  31 }
  32
  33 =cut
  34
  35 # TODO: implement remote serial port
  36 # remserial -x 2 -p 23000 -s "9600 raw" /dev/ttyUSB0
  37
  38 use IO::Socket::INET;
  39
  40 my $sock = IO::Socket::INET->new(
  41         PeerAddr => '192.168.1.148',
  42         PeerPort => '23000',
  43         Proto    => 'tcp'
  44 );
  45
  46 sub read_serial {
  47         my $len = shift;
  48         my $buffer;
  49         $sock->read( $buffer, $len );
  50         warn "## read $len ",as_hex($buffer) if $debug;
  51         return $buffer;
  52 }
  53
  54 sub write_serial {
  55         my $bytes = shift;
  56         return $sock->print( $bytes );
  57 }
  58
  59
  60 sub as_hex {
  61         my @out;
  62         foreach my $str ( @_ ) {
  63                 my $hex = uc unpack( 'H*', $str );
  64                 $hex =~ s/(..)/$1 /g if length( $str ) > 2;
  65                 $hex =~ s/\s+$//;
  66                 push @out, $hex;
  67         }
  68         return join(' | ', @out);
  69 }
  70
  71 sub hex2bytes {
  72         my $bytes;
  73         $bytes .= pack('C', hex('0x' . $_)) foreach split(/\s+/,join(' ',@_));
  74         return $bytes;
  75 }
  76
  77 sub crc {
  78         my $data = shift;
  79         my $crc = 0;
  80         for my $i ( 0 .. length($data) - 2 ) {
  81                 if ( $crc & 0x80 ) {
  82                         $crc = ( $crc << 1 ) ^ 25;
  83                 } else {
  84                         $crc = $crc << 1;
  85                 }
  86                 $crc = $crc & 0xff;
  87                 my $byte = ord(substr($data,$i,1));
  88                 $crc = $crc ^ $byte;
  89 #               warn "## ", as_hex(chr($byte)), " crc = ", $crc, " ", as_hex(chr($crc));
  90         }
  91         # ignore checksum errors for FF, we will calulate them!
  92         if ( chr($crc) ne substr($data,-1,1) && substr($data,-1,1) ne "\xFF" ) {
  93                 warn "CRC error for ",as_hex($data), " calulated ", as_hex(chr($crc));
  94         }
  95
  96         return substr($data,0,-1) . chr($crc);
  97 }
  98
  99 sub v_bytes {
 100         my ($bytes,$desc) = @_;
 101         warn "# $desc\n";
 102 retry:
 103         warn ">> ",as_hex( $bytes );
 104         crc( $bytes );
 105         write_serial( $bytes );
 106
 107         my $data = read_serial(1);
 108         warn "<< len: ",ord($data) if $debug;
 109
 110         goto retry if ord($data) == 0;
 111
 112         $data .= read_serial(ord($data) - 1);
 113         crc($data);
 114         warn "<< ",as_hex($data);
 115
 116         my $o = 2;
 117         while ( $o < length($data) - 2 ) {
 118                 my $n = unpack('n', substr($data,$o,2));
 119                 $n = -( 0xffff - $n ) if $n & 0x8000;
 120                 warn "## $o = ",$n, "\t",$n / 16,"\n";
 121                 $o += 2;
 122         }
 123
 124         while ( $o < length($data) - 1 ) {
 125                 my $n = unpack('c', substr($data,$o,1));
 126                 warn "## $o = ", $n, "\n";
 127                 $o += 1;
 128         }
 129
 130         return $data;
 131 }
 132
 133 sub v {
 134         my ($hex,$desc) = @_;
 135         v_bytes( hex2bytes( $hex ), $desc );
 136 }
 137
 138 if ( ! @ARGV ) {
 139         v '07 02 00 00 00 04 C4', "hardware version";
 140
 141         v '07 0A 00 00 00 04 44', 'software version';
 142
 143         v '07 00 01 00 06 0E EA', 'temperatures';
 144
 145         v '07 00 00 00 26 0A A6', 'last errros';
 146 }
 147
 148 #v '07 00 00 00 26 00 AC', 'last errros (with invalid length)';
 149
 150 foreach my $reg ( @ARGV ) {
 151         warn "# send user $reg\n";
 152         v_bytes(
 153                 crc( hex2bytes( "07 00 00 00 $reg 01 FF" ) )
 154         ,"user: $reg");
 155 }