Initial commit
commit
c5cfbf4ecb
@ -0,0 +1,152 @@
|
||||
##############################################
|
||||
|
||||
package main;
|
||||
|
||||
use strict;
|
||||
use warnings;
|
||||
use Time::HiRes qw(gettimeofday);
|
||||
use IPC::Open2;
|
||||
|
||||
sub FHZ_Write($$$);
|
||||
sub FHZ_Read($);
|
||||
sub FHZ_Ready($);
|
||||
|
||||
sub
|
||||
EB_Initialize($)
|
||||
{
|
||||
my ($hash) = @_;
|
||||
|
||||
# Provider
|
||||
$hash->{ReadyFn} = "EB_Ready";
|
||||
$hash->{ReadFn} = "EB_Read";
|
||||
$hash->{WriteFn} = "EB_Write";
|
||||
$hash->{Clients} = ":EB:EBN:";
|
||||
|
||||
my %mc = (
|
||||
"1:EBN" => "^R",
|
||||
);
|
||||
$hash->{MatchList} = \%mc;
|
||||
|
||||
# Normal devices
|
||||
$hash->{DefFn} = "EB_Define";
|
||||
$hash->{UndefFn} = "EB_Undef";
|
||||
$hash->{SetFn} = "EB_Set";
|
||||
$hash->{AttrList}= "loglevel:0,1,2,3,4,5,6";
|
||||
}
|
||||
|
||||
sub
|
||||
EB_Define($$)
|
||||
{
|
||||
my ($hash, $def) = @_;
|
||||
my @a = split("[ \t][ \t]*", $def);
|
||||
|
||||
Log 3, "$hash->{NAME} define ";
|
||||
if(@a < 3 || @a > 3) {
|
||||
my $msg = "wrong syntax: define <name> EB {devicename}";
|
||||
Log 2, $msg;
|
||||
Log 2, @a;
|
||||
return $msg;
|
||||
}
|
||||
my $name = $a[0];
|
||||
my $dev = $a[2];
|
||||
|
||||
$hash->{DeviceName} = $dev;
|
||||
|
||||
my($pid, $chld_out, $chld_in);
|
||||
$pid = open2($chld_out, $chld_in, '/root/ebd -d '.$dev);
|
||||
|
||||
$hash->{RDPIPE} = $chld_out;
|
||||
$hash->{WRPIPE} = $chld_in;
|
||||
$hash->{FD} = fileno($chld_out);
|
||||
$hash->{PID} = $pid;
|
||||
$hash->{STATE} = "Open";
|
||||
$selectlist{"$name.pipe"} = $hash;
|
||||
return undef;
|
||||
}
|
||||
|
||||
#####################################
|
||||
sub
|
||||
EB_Undef($$)
|
||||
{
|
||||
my ($hash, $arg) = @_;
|
||||
|
||||
Log 3, "$hash->{NAME} undef";
|
||||
return if ($hash->{STATE} ne "Open");
|
||||
|
||||
EB_Write($hash,'Q','');
|
||||
|
||||
kill $hash->{PID};
|
||||
close($hash->{RDPIPE});
|
||||
close($hash->{WRPIPE});
|
||||
|
||||
delete $hash->{FD};
|
||||
delete $hash->{RDPIPE};
|
||||
delete $hash->{WRPIPE};
|
||||
delete $hash->{PID};
|
||||
|
||||
$hash->{STATE} = "Closed";
|
||||
return undef;
|
||||
}
|
||||
|
||||
#####################################
|
||||
sub
|
||||
EB_Ready($)
|
||||
{
|
||||
my ($hash,$fn,$msg) = @_;
|
||||
Log 5, "$hash->{NAME} ready";
|
||||
return 1;
|
||||
}
|
||||
|
||||
#####################################
|
||||
sub
|
||||
EB_Write($$$)
|
||||
{
|
||||
my ($hash,$fn,$msg) = @_;
|
||||
my ($buf);
|
||||
|
||||
$buf = $fn . ' ' . $msg;
|
||||
Log 5, "$hash->{NAME} write: " . $buf;
|
||||
$buf .= "\n";
|
||||
syswrite($hash->{WRPIPE}, $buf);
|
||||
|
||||
return undef;
|
||||
}
|
||||
|
||||
#####################################
|
||||
sub
|
||||
EB_Read($)
|
||||
{
|
||||
my ($hash) = @_;
|
||||
my ($buf, $res, $nextbyte);
|
||||
|
||||
|
||||
CHAR: while (sysread($hash->{RDPIPE}, $nextbyte, 1)) {
|
||||
last CHAR if $nextbyte eq "\n";
|
||||
$buf .= $nextbyte;
|
||||
}
|
||||
|
||||
Log 5, "$hash->{NAME} read: " . $buf;
|
||||
$hash->{RAWMSG} = $buf;
|
||||
Dispatch($hash, $buf, undef);
|
||||
return $buf;
|
||||
}
|
||||
|
||||
#####################################
|
||||
sub
|
||||
EB_Set($@)
|
||||
{
|
||||
my ($hash, @a) = @_;
|
||||
|
||||
my $name = shift @a;
|
||||
my $type = shift @a;
|
||||
my $arg = join(" ", @a);
|
||||
|
||||
return "Unknown argument $type, choose one of raw" if($type ne "raw");
|
||||
|
||||
$arg .= "\n";
|
||||
|
||||
syswrite($hash->{WRPIPE}, $arg);
|
||||
return undef;
|
||||
}
|
||||
|
||||
1;
|
||||
@ -0,0 +1,292 @@
|
||||
package main;
|
||||
|
||||
use strict;
|
||||
use warnings;
|
||||
|
||||
sub
|
||||
EBN_Initialize($)
|
||||
{
|
||||
my ($hash) = @_;
|
||||
|
||||
$hash->{Match} = "^R";
|
||||
$hash->{DefFn} = "EBN_Define";
|
||||
$hash->{ParseFn} = "EBN_Parse";
|
||||
$hash->{GetFn} = "EBN_Get";
|
||||
$hash->{SetFn} = "EBN_Set";
|
||||
$hash->{AttrList} = "IODev loglevel:0,1,2,3,4,5,6";
|
||||
|
||||
}
|
||||
|
||||
#############################
|
||||
sub
|
||||
EBN_Define($$)
|
||||
{
|
||||
my ($hash, $def) = @_;
|
||||
my @a = split("[ \t][ \t]*", $def);
|
||||
|
||||
my $u = "wrong syntax: define <name> EBN addr type";
|
||||
|
||||
return "wrong syntax: define <name> EBN addr type" if(int(@a) != 4);
|
||||
|
||||
$modules{EBN}{defptr}{$a[2]} = $hash;
|
||||
$hash->{STATE} = "Defined";
|
||||
$hash->{EBTYPE} = $a[3];
|
||||
$hash->{ADDR} = $a[2];
|
||||
$hash->{channel1} = "Init";
|
||||
AssignIoPort($hash);
|
||||
return undef;
|
||||
}
|
||||
|
||||
sub
|
||||
EBN_Parse($$)
|
||||
{
|
||||
my ($hash, $msg) = @_;
|
||||
|
||||
# Msg format: R addr chan value
|
||||
my @cmp = split(" ", $msg);
|
||||
my $def = $modules{EBN}{defptr}{$cmp[1]};
|
||||
my $changed;
|
||||
my $log;
|
||||
my $v1;
|
||||
my $v2;
|
||||
my $v3;
|
||||
my $v4;
|
||||
|
||||
Log 5, "$hash->{NAME} parse: " . $msg;
|
||||
|
||||
if($def) {
|
||||
my $name = $def->{NAME};
|
||||
if ($cmp[2] == 0) {
|
||||
IOWrite($def, "R", $cmp[1]. " 1 0");
|
||||
return $name;
|
||||
}
|
||||
|
||||
# TYPE 1: Test Node
|
||||
# Channel 1:
|
||||
# Bit 0 : Test LED
|
||||
# Bit 1 : Exp LED
|
||||
# Channel 2:
|
||||
# Vcc
|
||||
|
||||
$changed = 0;
|
||||
$v1 = $cmp[3] & 0x1;
|
||||
$v2 = $cmp[3] & 0x2;
|
||||
$v3 = $cmp[3] & 0x4;
|
||||
$v4 = $cmp[3] & 0x8;
|
||||
|
||||
if ($def->{EBTYPE} == 1) {
|
||||
if ($cmp[2] == 1) {
|
||||
if (($v1 != ($def->{channel1} & 0x1)) || ($def->{channel1} eq "Init")) {
|
||||
$def->{READINGS}{testled}{TIME} = TimeNow();
|
||||
$def->{READINGS}{testled}{VAL} = $v1 ? "on" : "off";
|
||||
$changed = 1;
|
||||
}
|
||||
if (($v2 != ($def->{channel1} & 0x2)) || ($def->{channel1} eq "Init")) {
|
||||
$def->{READINGS}{expled}{TIME} = TimeNow();
|
||||
$def->{READINGS}{expled}{VAL} = $v2 ? "on" : "off";
|
||||
$changed = 1;
|
||||
}
|
||||
if ($def->{channel1} eq "Init") {
|
||||
IOWrite($def, "R", $cmp[1]. " 2 0");
|
||||
}
|
||||
$def->{channel1} = $cmp[3];
|
||||
if ($changed == 1) {
|
||||
$log = "testled: " . ($v1 ? "on" : "off") . " expled: " . ($v2 ? "on" : "off");
|
||||
$def->{STATE} = $log;
|
||||
push @{$def->{CHANGED}}, $log;
|
||||
DoTrigger($def->{NAME}, undef);
|
||||
}
|
||||
}
|
||||
if ($cmp[2] == 2) {
|
||||
$def->{READINGS}{vcc}{TIME} = TimeNow();
|
||||
$def->{READINGS}{vcc}{VAL} = $cmp[3];
|
||||
}
|
||||
}
|
||||
|
||||
# TYPE 2: Alarm Node
|
||||
# Channel 1:
|
||||
# Bit 0 : Tuerkontakt
|
||||
# Bit 1 : Buzzer aus
|
||||
# Channel 2:
|
||||
# Vcc
|
||||
|
||||
if ($def->{EBTYPE} == 2) {
|
||||
if ($cmp[2] == 1) {
|
||||
if (($v1 != ($def->{channel1} & 0x1)) || ($def->{channel1} eq "Init")) {
|
||||
$def->{READINGS}{tuer}{TIME} = TimeNow();
|
||||
$def->{READINGS}{tuer}{VAL} = $v1 ? "closed" : "open";
|
||||
$changed = 1;
|
||||
}
|
||||
if (($v2 != ($def->{channel1} & 0x2)) || ($def->{channel1} eq "Init")) {
|
||||
$def->{READINGS}{buzzer}{TIME} = TimeNow();
|
||||
$def->{READINGS}{buzzer}{VAL} = $v2 ? "disabled" : "enabled";
|
||||
$changed = 1;
|
||||
}
|
||||
if ($def->{channel1} eq "Init") {
|
||||
IOWrite($def, "R", $cmp[1]. " 2 0");
|
||||
}
|
||||
$def->{channel1} = $cmp[3];
|
||||
if ($changed == 1) {
|
||||
$log = "tuer: ". ($v1 ? "closed" : "open") . " buzzer: " . ($v2 ? "disabled" : "enabled");
|
||||
$def->{STATE} = $log;
|
||||
push @{$def->{CHANGED}}, $log;
|
||||
DoTrigger($def->{NAME}, undef);
|
||||
}
|
||||
}
|
||||
if ($cmp[2] == 2) {
|
||||
$def->{READINGS}{vcc}{TIME} = TimeNow();
|
||||
$def->{READINGS}{vcc}{VAL} = $cmp[3];
|
||||
}
|
||||
}
|
||||
|
||||
# TYPE 3: Relais Node
|
||||
# Channel 1:
|
||||
# Bit 0 : LED
|
||||
# Bit 1 : Relais 1
|
||||
# Bit 2 : Relais 2
|
||||
|
||||
if ($def->{EBTYPE} == 3) {
|
||||
if ($cmp[2] == 1) {
|
||||
if (($v1 != ($def->{channel1} & 0x1)) || ($def->{channel1} eq "Init")) {
|
||||
$def->{READINGS}{led}{TIME} = TimeNow();
|
||||
$def->{READINGS}{led}{VAL} = $v1 ? "on": "off";
|
||||
$changed = 1;
|
||||
}
|
||||
if (($v2 != ($def->{channel1} & 0x2)) || ($def->{channel1} eq "Init")) {
|
||||
$def->{READINGS}{relais1}{TIME} = TimeNow();
|
||||
$def->{READINGS}{relais1}{VAL} = $v2 ? "on": "off";
|
||||
$changed = 1;
|
||||
}
|
||||
if (($v3 != ($def->{channel1} & 0x4)) || ($def->{channel1} eq "Init")) {
|
||||
$def->{READINGS}{relais2}{TIME} = TimeNow();
|
||||
$def->{READINGS}{relais2}{VAL} = $v3 ? "on": "off";
|
||||
$changed = 1;
|
||||
}
|
||||
$def->{channel1} = $cmp[3];
|
||||
if ($changed == 1) {
|
||||
$log = "led: " . ($v1 ? "on": "off") . " relais1: " . ($v2 ? "on": "off") . " relais2: " . ($v3? "on": "off");
|
||||
$def->{STATE} = $log;
|
||||
push @{$def->{CHANGED}}, $log;
|
||||
DoTrigger($def->{NAME}, undef);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
return $name;
|
||||
} else {
|
||||
Log 3, "EBN Unknown device $cmp[1], please define it";
|
||||
if ($cmp[2] == 0) {
|
||||
return "UNDEFINED EBN_$cmp[1] EBN $cmp[1] $cmp[3]";
|
||||
} else {
|
||||
return undef;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
sub
|
||||
EBN_Get($@)
|
||||
{
|
||||
my ($hash, @args) = @_;
|
||||
|
||||
return 'EBN_Get needs two arguments' if (@args != 2);
|
||||
|
||||
my $get = $args[1];
|
||||
my $val;
|
||||
|
||||
if ( $get eq "?"){
|
||||
if ($hash->{EBTYPE} == 1) {
|
||||
return "Unknown argument ?, choose one of testled expled";
|
||||
}
|
||||
if ($hash->{EBTYPE} == 2) {
|
||||
return "Unknown argument ?, choose one of tuer buzzer";
|
||||
}
|
||||
if ($hash->{EBTYPE} == 3) {
|
||||
return "Unknown argument ?, choose one of led relais1 relais2";
|
||||
}
|
||||
return "EBN_Get: no such reading: $get";
|
||||
}
|
||||
if (defined($hash->{READINGS}{$get})) {
|
||||
$val = $hash->{READINGS}{$get}{VAL};
|
||||
} else {
|
||||
return "EBN_Get: no such reading: $get";
|
||||
}
|
||||
Log 3, "$args[0] $get => $val";
|
||||
|
||||
return $val;
|
||||
}
|
||||
|
||||
sub
|
||||
EBN_Set($@)
|
||||
{
|
||||
my ($hash, @args) = @_;
|
||||
|
||||
my $set = $args[1];
|
||||
my $num;
|
||||
my $msg;
|
||||
|
||||
if ( $set eq "?"){
|
||||
if ($hash->{EBTYPE} == 1) {
|
||||
return "Unknown argument ?, choose one of testled expled";
|
||||
}
|
||||
if ($hash->{EBTYPE} == 2) {
|
||||
return "Unknown argument ?, choose one of buzzer";
|
||||
}
|
||||
if ($hash->{EBTYPE} == 3) {
|
||||
return "Unknown argument ?, choose one of led relais1 relais2";
|
||||
}
|
||||
return "EBN_Get: no such reading: $set";
|
||||
}
|
||||
return 'EBN_Set needs three arguments' if (@args != 3);
|
||||
my $val = $args[2];
|
||||
|
||||
Log 3, "$args[0] $set => $val";
|
||||
|
||||
if ($hash->{EBTYPE} == 1) {
|
||||
if ($val eq "on") {
|
||||
$num = 1;
|
||||
} else {
|
||||
$num = 0;
|
||||
}
|
||||
if ($set eq "testled") {
|
||||
$msg = ($hash->{channel1} & 0x3FE) | $num;
|
||||
}
|
||||
if ($set eq "expled") {
|
||||
$msg = ($hash->{channel1} & 0x3FD) | ($num << 1);
|
||||
}
|
||||
IOWrite($hash, "W", $hash->{ADDR} . " 1 " . $msg);
|
||||
}
|
||||
if ($hash->{EBTYPE} == 2) {
|
||||
if ($val eq "disabled") {
|
||||
$num = 1;
|
||||
} else {
|
||||
$num = 0;
|
||||
}
|
||||
if ($set eq "buzzer") {
|
||||
$msg = ($hash->{channel1} & 0x3FD) | ($num << 1);
|
||||
}
|
||||
IOWrite($hash, "W", $hash->{ADDR} . " 1 " . $msg);
|
||||
}
|
||||
if (($hash->{EBTYPE} == 3) || ($hash->{EBTYPE} == 4)) {
|
||||
if ($val eq "on") {
|
||||
$num = 1;
|
||||
} else {
|
||||
$num = 0;
|
||||
}
|
||||
if ($set eq "led") {
|
||||
$msg = ($hash->{channel1} & 0x3FE) | $num;
|
||||
}
|
||||
if ($set eq "relais1") {
|
||||
$msg = ($hash->{channel1} & 0x3FD) | ($num << 1);
|
||||
}
|
||||
if ($set eq "relais2") {
|
||||
$msg = ($hash->{channel1} & 0x3FB) | ($num << 2);
|
||||
}
|
||||
IOWrite($hash, "W", $hash->{ADDR} . " 1 " . $msg);
|
||||
}
|
||||
|
||||
|
||||
return undef;
|
||||
}
|
||||
|
||||
1;
|
||||
|
||||
@ -0,0 +1 @@
|
||||
SUBDIRS = src
|
||||
@ -0,0 +1,15 @@
|
||||
AC_INIT([src/rs485.c])
|
||||
AC_PREREQ([2.63])
|
||||
AM_INIT_AUTOMAKE(ebd, 0.0.1)
|
||||
|
||||
AC_CONFIG_HEADERS([config.h])
|
||||
|
||||
AC_PROG_CC
|
||||
AC_PROG_INSTALL
|
||||
|
||||
AC_CONFIG_FILES([
|
||||
Makefile
|
||||
src/Makefile
|
||||
])
|
||||
|
||||
AC_OUTPUT
|
||||
@ -0,0 +1,6 @@
|
||||
bin_PROGRAMS = ebd
|
||||
|
||||
AM_CFLAGS = $(DEPS_CFLAGS)
|
||||
|
||||
ebd_SOURCES = main.c rs485.c
|
||||
ebd_LDADD = $(DEPS_LIBS)
|
||||
@ -0,0 +1,245 @@
|
||||
#include <stdio.h>
|
||||
#include <stdlib.h>
|
||||
#include <stdint.h>
|
||||
#include <fcntl.h>
|
||||
#include <sys/ioctl.h>
|
||||
#include <sys/types.h>
|
||||
#include <sys/stat.h>
|
||||
#include <unistd.h>
|
||||
#include <signal.h>
|
||||
#include <termios.h>
|
||||
#include <strings.h>
|
||||
|
||||
void send_ack(int addr) {
|
||||
unsigned char buf[16];
|
||||
|
||||
buf[0] = 0xAA;
|
||||
buf[1] = 2;
|
||||
buf[2] = addr;
|
||||
buf[3] = addr;
|
||||
buf[4] = 1;
|
||||
buf[5] = 1;
|
||||
buf[6] = 0;
|
||||
buf[7] = 0;
|
||||
buf[8] = 0;
|
||||
buf[9] = 0;
|
||||
buf[10] = 0;
|
||||
buf[11] = 0;
|
||||
buf[12] = 0;
|
||||
buf[13] = 0;
|
||||
buf[14] = 0;
|
||||
|
||||
rs485_crc(buf);
|
||||
rs485_send(buf);
|
||||
}
|
||||
|
||||
void send_read_req(int addr, int channel) {
|
||||
unsigned char buf[16];
|
||||
|
||||
buf[0] = 0xAA;
|
||||
buf[1] = 0;
|
||||
buf[2] = addr;
|
||||
buf[3] = addr;
|
||||
buf[4] = 1;
|
||||
buf[5] = 1;
|
||||
buf[6] = 0x40 + channel;
|
||||
buf[7] = 0;
|
||||
buf[8] = 0;
|
||||
buf[9] = 0;
|
||||
buf[10] = 0;
|
||||
buf[11] = 0;
|
||||
buf[12] = 0;
|
||||
buf[13] = 0;
|
||||
buf[14] = 0;
|
||||
|
||||
rs485_crc(buf);
|
||||
rs485_send(buf);
|
||||
}
|
||||
|
||||
void send_write_req(int addr, int channel, int data) {
|
||||
unsigned char buf[16];
|
||||
|
||||
buf[0] = 0xAA;
|
||||
buf[1] = 0;
|
||||
buf[2] = addr;
|
||||
buf[3] = addr;
|
||||
buf[4] = 1;
|
||||
buf[5] = 1;
|
||||
buf[6] = 0x60 + channel + ((data & 0x300 ) >> 5);
|
||||
buf[7] = data & 0xFF;
|
||||
buf[8] = 0;
|
||||
buf[9] = 0;
|
||||
buf[10] = 0;
|
||||
buf[11] = 0;
|
||||
buf[12] = 0;
|
||||
buf[13] = 0;
|
||||
buf[14] = 0;
|
||||
|
||||
rs485_crc(buf);
|
||||
rs485_send(buf);
|
||||
}
|
||||
|
||||
void send_poll(void) {
|
||||
unsigned char buf[16];
|
||||
|
||||
buf[0] = 0xAA;
|
||||
buf[1] = 0;
|
||||
buf[2] = 0;
|
||||
buf[3] = 0;
|
||||
buf[4] = 1;
|
||||
buf[5] = 1;
|
||||
buf[6] = 0;
|
||||
buf[7] = 0;
|
||||
buf[8] = 0;
|
||||
buf[9] = 0;
|
||||
buf[10] = 0;
|
||||
buf[11] = 0;
|
||||
buf[12] = 0;
|
||||
buf[13] = 0;
|
||||
buf[14] = 0;
|
||||
|
||||
rs485_crc(buf);
|
||||
rs485_send(buf);
|
||||
}
|
||||
|
||||
void mainloop(int fd) {
|
||||
struct timeval timeout;
|
||||
int rd;
|
||||
fd_set rset;
|
||||
fd_set wset;
|
||||
fd_set eset;
|
||||
int quit;
|
||||
int alt;
|
||||
int ret;
|
||||
int req_dev;
|
||||
int req_channel;
|
||||
int req_data;
|
||||
int req_write;
|
||||
int ack_dev;
|
||||
int dev_poll;
|
||||
unsigned char rbuf[16];
|
||||
|
||||
alt = 0;
|
||||
quit = 0;
|
||||
req_dev = 0;
|
||||
req_channel = 0;
|
||||
ack_dev = 0;
|
||||
dev_poll = 2;
|
||||
|
||||
while (!quit) {
|
||||
FD_ZERO(&rset);
|
||||
FD_ZERO(&wset);
|
||||
FD_ZERO(&eset);
|
||||
FD_SET(fd, &rset);
|
||||
FD_SET(0, &rset);
|
||||
|
||||
timeout.tv_sec = 0;
|
||||
timeout.tv_usec = 40000;
|
||||
|
||||
rd = select(fd + 1, &rset, &wset, &eset, &timeout);
|
||||
|
||||
if (rd == 0) {
|
||||
if (alt) {
|
||||
send_poll();
|
||||
alt = 0;
|
||||
continue;
|
||||
}
|
||||
alt = 1;
|
||||
|
||||
if (ack_dev) {
|
||||
send_ack(ack_dev);
|
||||
ack_dev = 0;
|
||||
continue;
|
||||
}
|
||||
|
||||
if (req_dev) {
|
||||
if (req_write)
|
||||
send_write_req(req_dev, req_channel, req_data);
|
||||
else
|
||||
send_read_req(req_dev, req_channel);
|
||||
req_dev = 0;
|
||||
continue;
|
||||
}
|
||||
|
||||
send_read_req(dev_poll, 0);
|
||||
dev_poll++;
|
||||
if (dev_poll > 126)
|
||||
dev_poll = 2;
|
||||
} else {
|
||||
if (FD_ISSET(fd, &rset)) {
|
||||
ret = rs485_recv_loop();
|
||||
if (ret < 0)
|
||||
exit(-1);
|
||||
if (ret == 0)
|
||||
continue;
|
||||
|
||||
rs485_recv(&rbuf);
|
||||
|
||||
if ((rbuf[1] == 1) && (rbuf[2] == 1))
|
||||
ack_dev = rbuf[4];
|
||||
|
||||
if ((rbuf[2] == 1) && (rbuf[6] >= 0x40) && (rbuf[6] < 0x60)) {
|
||||
printf ("R %d %d %d\n", rbuf[4], (rbuf[6] - 0x40) & 0x7, rbuf[7] + (((rbuf[6] - 0x40) & 0x18) << 5));
|
||||
fflush(stdout);
|
||||
}
|
||||
continue;
|
||||
}
|
||||
if (FD_ISSET(0, &rset)) {
|
||||
unsigned char a;
|
||||
unsigned char ibuf[100];
|
||||
int d, c, v;
|
||||
unsigned char *p;
|
||||
|
||||
p = fgets(ibuf, 100, stdin);
|
||||
if (p == NULL)
|
||||
exit(-1);
|
||||
|
||||
sscanf(ibuf, "%c %d %d %d\n", &a, &d, &c, &v);
|
||||
if (a == 'Q') {
|
||||
quit = 1;
|
||||
continue;
|
||||
}
|
||||
if (a == 'R') {
|
||||
req_dev = d;
|
||||
req_channel = c;
|
||||
req_write = 0;
|
||||
continue;
|
||||
}
|
||||
if (a == 'W') {
|
||||
req_dev = d;
|
||||
req_channel = c;
|
||||
req_data = v;
|
||||
req_write = 1;
|
||||
continue;
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
int main(int argc, char **argv) {
|
||||
|
||||
char *dev = "/dev/ttyS2";
|
||||
int c;
|
||||
|
||||
int fd;
|
||||
|
||||
while ((c = getopt(argc, argv, "d:")) != -1)
|
||||
switch (c) {
|
||||
case 'd':
|
||||
dev = optarg;
|
||||
break;
|
||||
}
|
||||
|
||||
fd = rs485_open(dev);
|
||||
if (fd < 0) {
|
||||
printf("RS485 open failed\n");
|
||||
return -1;
|
||||
}
|
||||
|
||||
mainloop(fd);
|
||||
|
||||
rs485_close();
|
||||
|
||||
return 0;
|
||||
}
|
||||
@ -0,0 +1,143 @@
|
||||
#include <linux/serial.h>
|
||||
#include <stdio.h>
|
||||
#include <stdlib.h>
|
||||
#include <stdint.h>
|
||||
#include <fcntl.h>
|
||||
#include <sys/ioctl.h>
|
||||
#include <sys/types.h>
|
||||
#include <sys/stat.h>
|
||||
#include <unistd.h>
|
||||
#include <signal.h>
|
||||
#include <termios.h>
|
||||
#include <strings.h>
|
||||
|
||||
/* Driver-specific ioctls: */
|
||||
#define TIOCGRS485 0x542E
|
||||
#define TIOCSRS485 0x542F
|
||||
|
||||
struct serial_rs485 rs485conf;
|
||||
struct termios options;
|
||||
|
||||
int fd;
|
||||
unsigned char inbuf[16];
|
||||
int bufp;
|
||||
|
||||
static uint16_t crc_ccitt_update(uint16_t crc, uint8_t data)
|
||||
{
|
||||
data ^= (crc & 0xFF);
|
||||
data ^= data << 4;
|
||||
|
||||
return ((((uint16_t)data << 8) | ((crc >> 8) & 0xFF))
|
||||
^ (uint8_t)(data >> 4) ^ ((uint16_t)data << 3));
|
||||
}
|
||||
|
||||
int rs485_crc(unsigned char buf[16])
|
||||
{
|
||||
uint16_t crc;
|
||||
int i;
|
||||
|
||||
if (buf[0] != 0xAA)
|
||||
return -1;
|
||||
if (buf[2] != buf[3])
|
||||
return -1;
|
||||
if (buf[4] != buf[5])
|
||||
return -1;
|
||||
|
||||
crc = 0xFFFF;
|
||||
for (i=0; i<14; i++)
|
||||
crc = crc_ccitt_update(crc, buf[i]);
|
||||
buf[14] = (crc >> 8) & 0xFF;
|
||||
buf[15] = crc & 0xFF;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int rs485_send(unsigned char buf[16])
|
||||
{
|
||||
return write(fd, buf, 16);
|
||||
}
|
||||
|
||||
int rs485_recv(unsigned char buf[16])
|
||||
{
|
||||
int i;
|
||||
if (bufp < 16)
|
||||
return -1;
|
||||
|
||||
for (i=0;i<16;i++)
|
||||
buf[i] = inbuf[i];
|
||||
return 0;
|
||||
}
|
||||
|
||||
int rs485_recv_loop(void)
|
||||
{
|
||||
int i;
|
||||
unsigned char *p;
|
||||
uint16_t crc;
|
||||
|
||||
if (bufp >=16)
|
||||
bufp=0;
|
||||
|
||||
p = &(inbuf[bufp]);
|
||||
|
||||
if (read(fd, p, 1) < 0)
|
||||
return -1;
|
||||
|
||||
bufp++;
|
||||
|
||||
if ((bufp == 1) && (inbuf[0] != 0xAA))
|
||||
bufp = 0;
|
||||
|
||||
if ((bufp == 4) && (inbuf[2] != inbuf[3]))
|
||||
bufp = 0;
|
||||
|
||||
if ((bufp == 6) && (inbuf[4] != inbuf[5]))
|
||||
bufp = 0;
|
||||
|
||||
if (bufp == 16) {
|
||||
crc = 0xFFFF;
|
||||
|
||||
for (i=0; i<14; i++)
|
||||
crc = crc_ccitt_update(crc, inbuf[i]);
|
||||
if ((inbuf[14] == ((crc >> 8) & 0xFF)) && (inbuf[15] == (crc & 0xFF)))
|
||||
return 1;
|
||||
else
|
||||
bufp = 0;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
int rs485_close(void)
|
||||
{
|
||||
close(fd);
|
||||
}
|
||||
|
||||
int rs485_open(char *path)
|
||||
{
|
||||
fd = open (path, O_RDWR);
|
||||
if (fd < 0) {
|
||||
return -1;
|
||||
}
|
||||
|
||||
rs485conf.flags |= SER_RS485_ENABLED;
|
||||
rs485conf.flags |= (SER_RS485_RTS_ON_SEND);
|
||||
rs485conf.flags |= (SER_RS485_RTS_AFTER_SEND);
|
||||
//rs485conf.flags |= SER_RS485_RX_DURING_TX;
|
||||
|
||||
ioctl (fd, TIOCSRS485, &rs485conf);
|
||||
|
||||
bzero(&options, sizeof(options));
|
||||
cfsetspeed(&options, B9600);
|
||||
options.c_cflag &= ~PARENB;
|
||||
options.c_cflag &= ~CSTOPB;
|
||||
options.c_cflag &= ~CSIZE;
|
||||
options.c_cflag |= CS8;
|
||||
options.c_cflag |= (CLOCAL | CREAD);
|
||||
options.c_lflag &= ~(ICANON | ECHO | ECHOE | ISIG);
|
||||
options.c_oflag &= ~OPOST;
|
||||
options.c_cc[VMIN] = 0;
|
||||
options.c_cc[VTIME] = 1;
|
||||
tcflush(fd,TCIOFLUSH);
|
||||
tcsetattr(fd, TCSAFLUSH, &options);
|
||||
|
||||
return fd;
|
||||
}
|
||||
@ -0,0 +1,6 @@
|
||||
int rs485_crc(unsigned char buf[16]);
|
||||
int rs485_send(unsigned char buf[16]);
|
||||
int rs485_recv(unsigned char buf[16]);
|
||||
int rs485_recv_loop(void);
|
||||
int rs485_close(void);
|
||||
int rs485_open(char *path);
|
||||
Loading…
Reference in New Issue