--- /dev/null
+// Copyright (c) 2017, Tobias Mueller tm(at)tm3d.de
+// All rights reserved.
+//
+// Redistribution and use in source and binary forms, with or without
+// modification, are permitted provided that the following conditions are
+// met:
+//
+// * Redistributions of source code must retain the above copyright
+// notice, this list of conditions and the following disclaimer.
+// * Redistributions in binary form must reproduce the above copyright
+// notice, this list of conditions and the following disclaimer in the
+// documentation and/or other materials provided with the
+// distribution.
+// * All advertising materials mentioning features or use of this
+// software must display the following acknowledgement: This product
+// includes software developed by tm3d.de and its contributors.
+// * Neither the name of tm3d.de nor the names of its contributors may
+// be used to endorse or promote products derived from this software
+// without specific prior written permission.
+//
+// THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
+// "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
+// LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
+// A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
+// OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
+// SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+// LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
+// DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
+// THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
+// (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+// OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+
+#include <unistd.h>
+#include <sys/types.h>
+#include <sys/select.h>
+#include <sys/stat.h>
+#include <fcntl.h>
+#include <sys/ioctl.h>
+#include <time.h>
+#include <termios.h>
+#include <errno.h>
+#include <sys/time.h>
+#include "owARDUINOInterface.h"
+
+#define MODE_DATA 0xE1
+#define MODE_COMMAND 0xE3
+
+// Baud rate bits
+#define PARMSET_9600 0x00
+#define PARMSET_19200 0x02
+#define PARMSET_57600 0x04
+#define PARMSET_115200 0x06
+
+
+
+#define COM_IDENTIFER 1
+#define COM_RESET 2
+#define COM_SEARCH_INIT 3
+#define COM_SEARCH_NEXT 4
+#define COM_BLOCK 5
+#define COM_SBYTE 6
+#define COM_RBYTE 7
+#define COM_SBIT 8
+#define COM_RBIT 9
+
+//---------------------------------------------------------------------------
+// Description:
+// flush the rx and tx buffers
+//
+// 'portnum' - number 0 to MAX_PORTNUM-1. This number was provided to
+// OpenCOM to indicate the port number.
+//
+void owARDUINOInterface::FlushCOM() {
+ tcflush(fd, TCIOFLUSH);
+}
+
+
+int owARDUINOInterface::OpenCOM(uint8_t comnr) {
+ struct termios t; // see man termios - declared as above
+ int rc;
+ //int fd;
+ char port_zstr[100];
+ if (com_init) return fd;
+
+ sprintf(port_zstr,"/dev/ttyUSB%i",comnr);
+
+ fd = open(port_zstr, O_RDWR|O_NONBLOCK| O_NOCTTY );
+ if (fd<0)
+ {
+ log->set(OWLOG_ERROR,"ERROR open Com %s return %i",port_zstr,fd);
+ return fd;
+ }
+ rc = tcgetattr (fd, &t);
+ if (rc < 0)
+ {
+ int tmp;
+ tmp = errno;
+ close(fd);
+ errno = tmp;
+ log->set(OWLOG_ERROR,"OWERROR_SYSTEM_RESOURCE_INIT_FAILED %s",port_zstr);
+ return rc; // changed (2.00), used to return rc;
+ }
+
+ cfsetospeed(&t, B9600);
+ cfsetispeed (&t, B9600);
+
+ // Get terminal parameters. (2.00) removed raw
+ tcgetattr(fd,&t);
+ // Save original settings.
+ origterm = t;
+
+ t.c_cflag &= ~PARENB; // Make 8n1
+ t.c_cflag &= ~CSTOPB;
+ t.c_cflag &= ~CSIZE;
+ t.c_cflag |= CS8;
+
+ t.c_cflag &= ~CRTSCTS; // no flow control
+ t.c_cc[VMIN] = 1; // read doesn't block
+ t.c_cc[VTIME] = 5; // 0.5 seconds read timeout
+ t.c_cflag |= CREAD | CLOCAL; // turn on READ & ignore ctrl lines
+ t.c_cflag &= ~CRTSCTS; // no flow control
+ t.c_iflag &= ~(IXON | IXOFF | IXANY);// turn off s/w flow ctrl
+/* Make raw */
+ cfmakeraw(&t);
+ tcflush(fd,TCIOFLUSH);
+
+ rc = tcsetattr(fd, TCSAFLUSH, &t);
+
+ if (rc < 0)
+ {
+ int tmp;
+ tmp = errno;
+ close(fd);
+ errno = tmp;
+ log->set(OWLOG_ERROR,"OWERROR_SYSTEM_RESOURCE_INIT_FAILED %s",port_zstr);
+ return rc; // changed (2.00), used to return rc;
+ }
+ com_init=1;
+ return fd; // changed (2.00), used to return fd;
+}
+
+
+//---------------------------------------------------------------------------
+// Closes the connection to the port.
+//
+// 'portnum' - number 0 to MAX_PORTNUM-1. This number was provided to
+// OpenCOM to indicate the port number.
+//
+void owARDUINOInterface::CloseCOM()
+{
+ // restore tty settings
+ tcsetattr(fd, TCSAFLUSH, &origterm);
+ FlushCOM();
+ close(fd);
+ com_init=0;
+
+}
+
+
+//--------------------------------------------------------------------------
+// Write an array of bytes to the COM port, verify that it was
+// sent out. Assume that baud rate has been set.
+//
+// 'portnum' - number 0 to MAX_PORTNUM-1. This number provided will
+// be used to indicate the port number desired when calling
+// all other functions in this library.
+// Returns 1 for success and 0 for failure
+//
+int owARDUINOInterface::WriteCOM( int outlen, uint8_t *outbuf)
+{
+ long count = outlen;
+ int i=0;
+ for (int k=0;k<outlen;k++) {
+ i+= write(fd, outbuf+k, 1);
+// sleep(1);
+ }
+
+ tcdrain(fd);
+ return (i == count);
+}
+
+
+//--------------------------------------------------------------------------
+// Read an array of bytes to the COM port, verify that it was
+// sent out. Assume that baud rate has been set.
+//
+// 'portnum' - number 0 to MAX_PORTNUM-1. This number was provided to
+// OpenCOM to indicate the port number.
+// 'outlen' - number of bytes to write to COM port
+// 'outbuf' - pointer ot an array of bytes to write
+//
+// Returns: TRUE(1) - success
+// FALSE(0) - failure
+//
+int owARDUINOInterface::ReadCOM( int inlen, uint8_t *inbuf)
+{
+ fd_set filedescr;
+ struct timeval tval;
+ int cnt;
+
+ // loop to wait until each byte is available and read it
+ for (cnt = 0; cnt < inlen; cnt++)
+ {
+ // set a descriptor to wait for a character available
+ FD_ZERO(&filedescr);
+ FD_SET(fd,&filedescr);
+ // set timeout to 10ms
+ tval.tv_sec = 10;
+ tval.tv_usec = 10000;
+
+ // if byte available read or return bytes read
+ if (select(fd+1,&filedescr,NULL,NULL,&tval) != 0)
+ {
+ if (read(fd,&inbuf[cnt],1) != 1) {
+ log->set(OWLOG_ERROR,"Read Error on Serial");
+
+ return cnt;
+ }
+ }
+ else {
+ log->set(OWLOG_ERROR,"Read Error on Serial (select)");
+ return cnt;
+ }
+ }
+
+
+ // success, so return desired length
+ return inlen;
+}
+
+
+
+
+//--------------------------------------------------------------------------
+// Description:
+// Send a break on the com port for at least 2 ms
+//
+// 'portnum' - number 0 to MAX_PORTNUM-1. This number was provided to
+// OpenCOM to indicate the port number.
+//
+void owARDUINOInterface::BreakCOM()
+{
+ int duration = 0; // see man termios break may be
+ tcsendbreak(fd, duration); // too long
+}
+
+
+//--------------------------------------------------------------------------
+// Set the baud rate on the com port.
+//
+// 'portnum' - number 0 to MAX_PORTNUM-1. This number was provided to
+// OpenCOM to indicate the port number.
+// 'new_baud' - new baud rate defined as
+// PARMSET_9600 0x00
+// PARMSET_19200 0x02
+// PARMSET_57600 0x04
+// PARMSET_115200 0x06
+//
+void owARDUINOInterface::SetBaudCOM( uint8_t new_baud)
+{
+ struct termios t;
+ int rc;
+ speed_t baud;
+
+ // read the attribute structure
+ rc = tcgetattr(fd, &t);
+ if (rc < 0)
+ {
+ close(fd);
+ log->set(OWLOG_ERROR,"Error on Serial (set Boudrate)");
+
+ return;
+ }
+
+ // convert parameter to linux baud rate
+ switch(new_baud)
+ {
+ case PARMSET_9600:
+ baud = B9600;
+ break;
+ case PARMSET_19200:
+ baud = B19200;
+ break;
+ case PARMSET_57600:
+ baud = B57600;
+ break;
+ case PARMSET_115200:
+ baud = B115200;
+ break;
+ default:
+ baud = B9600;
+ break;
+ }
+
+ // set baud in structure
+ cfsetospeed(&t, baud);
+ cfsetispeed(&t, baud);
+
+ // change baud on port
+ rc = tcsetattr(fd, TCSAFLUSH, &t);
+ if (rc < 0) {
+ log->set(OWLOG_ERROR,"Error on Serial (set Boudrate)");
+
+ close(fd);
+ }
+}
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+int owARDUINOInterface::InitAdapter(uint8_t nr) {
+ // attempt to open the communications port
+ if ((fd = OpenCOM(nr)) < 0)
+ {
+ log->set(OWLOG_ERROR,"OWERROR_OPENCOM_FAILED");
+ return -1;
+ }
+ sleep(2);
+ uint8_t readbuffer[20],sendpacket[20];
+ uint8_t sendlen=0;
+ sendpacket[sendlen++]=0x01;
+ sendpacket[sendlen++]=0x00;
+ sendpacket[sendlen++]=0x03;
+ if (WriteCOM(sendlen,sendpacket)) {
+ if ((sendlen=ReadCOM(3,readbuffer)) == 3) {
+
+ // printf("%02X %02X %02X\n",readbuffer[0],readbuffer[1],readbuffer[2] );
+
+
+
+ } else {
+ //printf("%i\n",sendlen);
+ log->set(OWLOG_ERROR,"OWERROR_READCOM_FAILED");
+ }
+ } else log->set(OWLOG_ERROR,"OWERROR_WRITECOM_FAILED");
+
+ com_init=1;
+
+
+ return 1;
+}
+
+
+int owARDUINOInterface::owFirst() {
+ uint8_t readbuffer[20],sendpacket[20];
+ uint8_t sendlen=0;
+ sendpacket[sendlen++]=0x03;
+ sendpacket[sendlen++]=0x00;
+ sendpacket[sendlen++]=0x08;
+ if (WriteCOM(sendlen,sendpacket)) {
+ if ((sendlen=ReadCOM(8,readbuffer)) == 8) {
+ if (readbuffer[0]!=0) {
+ for (int i=0;i<8;i++) ROM_NO[i]=readbuffer[i];
+ return 1;
+ }
+ }
+ }
+ return 0;
+
+}
+int owARDUINOInterface::owNext() {
+ uint8_t readbuffer[20],sendpacket[20];
+ uint8_t sendlen=0;
+ sendpacket[sendlen++]=0x04;
+ sendpacket[sendlen++]=0x00;
+ sendpacket[sendlen++]=0x08;
+ if (WriteCOM(sendlen,sendpacket)) {
+ if ((sendlen=ReadCOM(8,readbuffer)) == 8) {
+ if (readbuffer[0]!=0) {
+ for (int i=0;i<8;i++) ROM_NO[i]=readbuffer[i];
+ return 1;
+ }
+ }
+ }
+ return 0;
+
+}
+
+
+void owARDUINOInterface::ReleaseAdapter() {
+ CloseCOM();
+}
+
+
+int owARDUINOInterface::Reset() {
+ uint8_t readbuffer[5],sendpacket[5];
+ uint8_t sendlen=0;
+ /* size_t l;
+
+ if ((l=read(fd,readbuffer,5))>0) {
+ printf("in buf %i bytes %02X %02X %02X %02X %02X\n",l,readbuffer[0],readbuffer[1],readbuffer[2],readbuffer[3],readbuffer[4]);
+ }*/
+ sendlen=0;
+ sendpacket[sendlen++]=0x02;
+ sendpacket[sendlen++]=0x00;
+ sendpacket[sendlen++]=0x01;
+ if (WriteCOM(sendlen,sendpacket)) {
+ if ((sendlen=ReadCOM(1,readbuffer)) == 1) {
+ // printf("Reset %i\n",readbuffer[0]);
+ if (readbuffer[0]) return 1;
+
+ }
+ }
+
+ return 0;
+}
+
+
+uint8_t owARDUINOInterface::sendrecivByte(uint8_t byte) {
+
+ uint8_t readbuffer[5],sendpacket[5];
+ uint8_t sendlen=0;
+/* size_t l;
+ if ((l=read(fd,readbuffer,5))>0) {
+ printf("in buf %i bytes %02X %02X %02X %02X %02X\n",l,readbuffer[0],readbuffer[1],readbuffer[2],readbuffer[3],readbuffer[4]);
+ }*/
+ if (byte!=0xFF) {
+ sendlen=0;
+ sendpacket[sendlen++]=COM_SBYTE;
+ sendpacket[sendlen++]=0x01;
+ sendpacket[sendlen++]=0x01;
+ sendpacket[sendlen++]=byte;
+ if (WriteCOM(sendlen,sendpacket)) {
+ if ((sendlen=ReadCOM(1,readbuffer)) == 1) {
+ // printf("Send %02X %02X \n",byte,readbuffer[0]);
+
+ return byte;
+ }
+ }
+ } else {
+ sendlen=0;
+ sendpacket[sendlen++]=COM_RBYTE;
+ sendpacket[sendlen++]=0x00;
+ sendpacket[sendlen++]=0x01;
+ if (WriteCOM(sendlen,sendpacket)) {
+ if ((sendlen=ReadCOM(1,readbuffer)) == 1) {
+ // printf("Recive %02X\n",readbuffer[0]);
+ return readbuffer[0];
+ }
+ }
+
+ }
+
+ return 0;
+}
+uint8_t owARDUINOInterface::sendrecivBit(uint8_t bit) {
+ return 0;
+}
+
+int owARDUINOInterface::Communicate(std::vector<uint8_t> *data, int scount, int rcount) {
+ int i=0;
+ data->resize(scount);
+ uint8_t readbuffer[128],sendpacket[128+3];
+ uint8_t sendlen=0;
+ sendpacket[sendlen++]=COM_BLOCK;
+ sendpacket[sendlen++]=scount;
+ sendpacket[sendlen++]=rcount;
+ for(uint8_t v:*data) {
+ sendpacket[sendlen++]=v;
+ (*data)[i]=v;i++;
+ }
+ if (WriteCOM(sendlen,sendpacket)) {
+ if ((sendlen=ReadCOM(rcount,readbuffer)) == rcount) {
+ for(i=0;i<rcount;i++) {
+ //printf("%02X ",readbuffer[i]);
+ data->push_back(readbuffer[i]);
+ }
+ //printf("\n");
+ }
+ }
+
+
+ return 0;
+}
+
tm3d / owTools.git / blobdiff