move MU80x to drivers

1 files changed, 0 insertions, 587 deletions

diff --git a/software/libs/MU80X.cpp b/software/libs/MU80X.cpp
deleted file mode 100644
index 143ffc2..0000000
--- a/software/libs/MU80X.cpp
+++ /dev/null
@@ -1,587 +0,0 @@
-/*
- * MU80X.cpp
- *
- *  Created on: 15.07.2021
- *      Author: steffen
- *  SPDX-FileCopyrightText: 2022 MDC Service <info@mdc-service.de>
- *  SPDX-License-Identifier: GPL-3.0-or-later
- */
-
-/**
-* driver for Chafon MU80X (MU801, MU804, MU808, MU816) Rain UHF RFID reader/writer
-*/
-
-#include "MU80X.h"
-
-//#define DEBUG
-#ifdef ESP32
-
-/**
- * MU80X constructor
- *
- * @param fh device handle
- */
-
-MU80X::MU80X(int fh) {
-	ProtStatus = 0;
-	ConnectionStatus=0;
-	TagsInBuffer=0;
-	TagsSeen=0;
-	_devid = 0xFF;
-
-	_devh = fh;
-
-	int res = iGetReaderInformation(_devid);
-	if (res >= 0) {
-//		printf("RDR Info:%d\n",res);
-//		DumpBuffer(RecvBuf,res);
-//		fflush (stdout);
-		_devid = RecvBuf[1];
-	}
-}
-#else
-
-/**
- * MU80X constructor
- *
- * @param dev device as character
- * @param baud baud rate for serial communication
- */
-
-
-MU80X::MU80X(const char *dev, const uint16_t baud) {
-	struct termios t1, t2;
-
-	ProtStatus = 0;
-	_devid = 0xFF;
-
-	int bd = B115200;
-	if (baud == 57600)
-		bd = B57600;
-
-	_devh = open(dev, O_RDWR | O_NONBLOCK);
-	if (_devh < 0) {
-		fprintf(stderr, "Unable to open serial device %s", dev);
-	} else {
-
-		tcgetattr(_devh, &t1);
-		tcgetattr(_devh, &t2);
-		cfmakeraw(&t1);
-
-		t1.c_cflag = (CLOCAL | CS8 | CREAD);
-		cfsetspeed(&t1, bd);
-		t1.c_cc[VMIN] = 0;
-		t1.c_cc[VTIME] = 0;
-		tcsetattr(_devh, TCSADRAIN, &t1);
-
-		int res = iGetReaderInformation(_devid);
-		if (res >= 0) {
-			fflush (stdout);
-			_devid = RecvBuf[1];
-		}
-	}
-
-}
-#endif
-
-/**
- * MU80X destructor
- *
- */
-
-MU80X::~MU80X(void) {
-#ifdef ESP32
-
-#else
-	if (_devh > 0)
-		close(_devh);
-#endif
-}
-// internal
-
-/**
- * MU80X DumpBuffer
- *
- * @param buf buffer to dump
- * @param len length of buffer
- */
-void MU80X::DumpBuffer(unsigned char *buf, int len) {
-	int i, c;
-	char *lb = (char*) buf;
-	for (i = 0; i < len; i++) {
-		if (i % 32 == 0)
-			printf("\n");
-		c = (char) *lb++;
-		printf("%02X ", (unsigned char) c);
-		if (c > 32)
-			printf(" %c ", c);
-		else
-			printf("   ");
-
-	}
-	printf("\n");
-}
-
-/**
- * MU80X PrintTag
- *
- * @param tag tag structure
- */
-void MU80X::PrintTag(Tag_t tag) {
-	int i;
-	for (i = 0; i < 12; i++) {
-		printf("%02X ", tag.b[i]);
-	}
-	printf("Ant:%d RSSI:%d Count:%d ", tag.ant, tag.rssi, tag.count);
-	printf("\n");
-}
-
-/**
- * MU80X _DecodeBuffer
- *
- * @param todecode maximal length to decode
- * @param start start position to decode
- * @param buf char buffer
- * @param tagbuf pointer to Tag_t structure
- * @returns position after decoding
- */
-int MU80X::_DecodeBuffer(int todecode, int start, unsigned char *buf,
-		Tag_t *tagbuf) {
-	int i;
-	uint8_t len, ant, rssi, count;
-	for (i = start; i < start + todecode; i++) {
-//		DumpBuffer(buf,s);
-		ant = *buf;
-		buf++;
-		len = *buf;
-		buf++;
-		tagbuf[i].ant = ant;
-#ifdef DEBUG
-		printf("Ant: %d Len: %d",ant,len);
-#endif
-		if (len == 8) {
-			tagbuf[i].b[0] = 0;
-			tagbuf[i].b[1] = 0;
-			tagbuf[i].b[2] = 0;
-			tagbuf[i].b[3] = 0;
-			memcpy(&tagbuf[i].b[4], buf, len);
-		} else if (len == 12) {
-			memcpy(&tagbuf[i].b[0], buf, len);
-		} else {
-			fprintf(stderr, "Unknown Taglength:%d :\n", len);
-		}
-		buf += len;
-		rssi = *buf;
-		buf++;
-		count = *buf;
-		buf++;
-		tagbuf[i].rssi = rssi;
-		tagbuf[i].count = count;
-#ifdef DEBUG
-		printf("Ant: %d Len: %d\n",ant,len);
-//		PrintTag(tagbuf[i]);
-#endif
-
-	}
-	return i - start;
-}
-
-#define PRESET_VALUE 0xFFFF
-#define POLYNOMIAL 0x8408
-
-/**
- * MU80X _ui16CalculateCrc
- *
- * @param data data pointer
- * @param len length of data 
- * @returns CRC calculated from data
- */
-
-uint16_t MU80X::_ui16CalculateCrc(unsigned char *data, unsigned char len) {
-
-	unsigned char ucI, ucJ;
-	uint16_t uiCrcValue = PRESET_VALUE;
-	for (ucI = 0; ucI < len; ucI++) {
-		uiCrcValue = uiCrcValue ^ *(data + ucI);
-		for (ucJ = 0; ucJ < 8; ucJ++) {
-			if (uiCrcValue & 0x0001) {
-				uiCrcValue = (uiCrcValue >> 1) ^ POLYNOMIAL;
-			} else {
-				uiCrcValue = (uiCrcValue >> 1);
-			}
-		}
-	}
-	return uiCrcValue;
-}
-
-/**
- * MU80X serial_read
- *
- * @param fh device handle.
- * @param buf buffer to read in. 
- * @returns number of bytes read
- */
-int MU80X::serial_read(int fh, unsigned char *buf) {
-#ifdef ESP32
-	return (uart_read_bytes(fh, buf, 1, 1));
-#else
-	return (read(fh,buf,1));
-#endif
-}
-
-/**
- * MU80X serial_write
- *
- * @param fh device handle.
- * @param buf buffer to write to. 
- * @param len number of bytes to write. 
- * @returns number of bytes written.
- */
-int MU80X::serial_write(int fh, unsigned char *buf, int len) {
-#ifdef ESP32
-	return (uart_write_bytes(fh, buf, len));
-#else
-	return(write(fh,buf,len));
-#endif
-}
-
-/**
- * MU80X iReadProt
- *
- * @param ms
- * @returns number of bytes written.
- */
-// low level read and write
-int MU80X::iReadProt(int ms) {
-	int cnt = ms;
-	int cc = 0;
-	uint8_t len = 0;
-	int i;
-	while (cnt > 0) {
-		if ((cc == 0) & (serial_read(_devh, &RecvBuf[0]) == 1)) {
-			len = (uint8_t) RecvBuf[0];
-#ifdef DEBUG
-			printf("\nNeed to receive:%d\n", len+1);
-#endif
-			fflush (stdout);
-			cc = 1;
-			cnt = ms;
-			i = 1;
-			while (i <= len) {
-				if (serial_read(_devh, &RecvBuf[i]) == 1) {
-					i++;
-					cnt = ms;
-				} else {
-//					printf(" X ");fflush(stdout);
-					cnt--;
-					if (cnt == 0)
-						return ERR_NOANSWER;
-#ifdef ESP32
-					vTaskDelay(1);
-#else
-					usleep(1000);
-#endif
-				}
-			}
-#ifdef DEBUG
-			printf("Received:%d\n", len+1);
-			fflush(stdout);
-#endif
-			return len + 1;
-		}
-
-		cnt--;
-#ifdef ESP32
-		vTaskDelay(1);
-#else
-		usleep(1000);
-#endif
-	}
-	return -1;
-}
-
-/**
- * MU80X iSendProt
- *
- * @param len number of bytes to write. 
- * @param adr address to send. 
- * @param cmd command to send.
- * @param data data to send
- * @returns number of bytes written, or error code.
- */
-int MU80X::iSendProt(uint8_t len, uint8_t adr, uint8_t cmd,
-		unsigned char *data) {
-	int res = 0;
-	uint16_t CRC = 0;
-	SendBuf[0] = len + 4;
-	SendBuf[1] = adr;
-	SendBuf[2] = cmd;
-	memcpy(&SendBuf[3], data, len);
-	CRC = _ui16CalculateCrc(SendBuf, len + 3);
-	SendBuf[3 + len] = CRC & 0xFF;
-	SendBuf[4 + len] = CRC >> 8;
-#ifdef DEBUG
-	printf("Send:");
-	DumpBuffer(SendBuf, len + 5);
-#endif
-	res = serial_write(_devh, (unsigned char *)SendBuf, (int)len + 5);
-#ifdef DEBUG
-	printf("Written:%d\n", res);
-#endif
-	if (res == len + 5) {
-		res = iReadProt(1000);
-		if (res > 0) {
-			uint8_t LEN = RecvBuf[0];
-			uint16_t RCRC = RecvBuf[LEN - 1] + (RecvBuf[LEN] << 8);
-			uint16_t CCRC = _ui16CalculateCrc(RecvBuf, LEN - 1);
-#ifdef DEBUG
-			printf("CRC: %04X  %04X\n", RCRC, CCRC);
-#endif
-			if (RCRC == CCRC) {
-				ProtStatus = RecvBuf[2];
-				return res;
-			} else
-				return ERR_CRC;
-		} else
-			return ERR_NOANSWER;
-
-	} else
-		return ERR_WRITE;
-	return res;
-}
-
-/**
- * MU80X iSendProt (overloaded version)
- *
- * @param len number of bytes to write. 
- * @param adr address to send. 
- * @param cmd command to send.
- * @param data data to send
- * @param wait number of ms to wait
- * @returns number of bytes written, or error code.
- */
-int MU80X::iSendProt(uint8_t len, uint8_t adr, uint8_t cmd, unsigned char *data,
-		int wait) {
-	int res = 0;
-	uint16_t CRC = 0;
-	SendBuf[0] = len + 4;
-	SendBuf[1] = adr;
-	SendBuf[2] = cmd;
-	memcpy(&SendBuf[3], data, len);
-	CRC = _ui16CalculateCrc(SendBuf, len + 3);
-	SendBuf[3 + len] = CRC & 0xFF;
-	SendBuf[4 + len] = CRC >> 8;
-#ifdef DEBUG
-	printf("Send:");
-	DumpBuffer(SendBuf, len + 5);
-#endif
-	res = serial_write(_devh, (unsigned char*)SendBuf, (int)len + 5);
-#ifdef DEBUG
-	printf("SendProt wrtn:%d  ", res);
-#endif
-	if (res == len + 5) {
-		res = iReadProt(wait);
-#ifdef DEBUG
-		printf(" rcvd:%d\n",res);fflush(stderr);
-#endif
-		if (res > 0) {
-			uint8_t LEN = RecvBuf[0];
-			uint16_t RCRC = RecvBuf[LEN - 1] + (RecvBuf[LEN] << 8);
-			uint16_t CCRC = _ui16CalculateCrc(RecvBuf, LEN - 1);
-			if (RCRC == CCRC) {
-				ProtStatus = RecvBuf[2];
-				return res;
-			} else
-				return ERR_CRC;
-		} else
-			return ERR_NOANSWER;
-
-	} else
-		return ERR_WRITE;
-	return res;
-}
-
-// protocol implementation
-
-/**
- * MU80X iBufferInventory 
- *
- * @param Q Q value. 
- * @param antenna number of antanna to use. 
- * @param time tbd.
- * @returns number of bytes written, or error code.
- */
-
-int MU80X::iBufferInventory(uint8_t Q, uint8_t antenna, uint8_t time) {
-	int res = 0;
-	unsigned char param[16];
-	param[0] = Q;		// QV
-	param[1] = 0xFF;  	// SS = TID:01 EPC:FF
-	param[2] = 0x00;	// TG no clue
-	param[3] = 0x80 + antenna;
-	param[4] = time;
-	res = iSendProt(5, _devid, 0x18, param, 20000);
-	if (res > 0) {
-#ifdef DEBUG
-		printf("INV:%d Stat:%d\n",res,ProtStatus);fflush(stdout);
-#endif
-//		DumpBuffer(RecvBuf, res);
-		printf("-------------------------\n");
-		fflush (stdout);
-		if (RecvBuf[0] == 9) {
-			TagsInBuffer = RecvBuf[5] + (RecvBuf[4] << 8);
-			TagsSeen = RecvBuf[7] + (RecvBuf[6] << 8);
-		}
-	}
-	return res;
-
-}
-
-/**
- * MU80X iClearBuffer 
- *
- * @returns number of bytes cleared, or error code.
- */
-int MU80X::iClearBuffer() {
-	int res;
-	res = iSendProt(0, _devid, 0x73, NULL);
-	return res;
-}
-
-/**
- * MU80X iBufferInventory 
- *
- * @param tagbuf buttfer for tags. 
- * @returns number of tags found
- */
-int MU80X::iGetBuffer(Tag_t *tagbuf) {
-	int res = 0;
-	int havedata = 1;
-	int tagcount = 0;
-	int todecode = 0;
-	int decoded = 0;
-	int readmore = 0;
-	res = iSendProt(0, _devid, 0x72, NULL);
-	if (res < 0)
-		return res;
-	while (havedata) {
-		todecode = RecvBuf[4];
-		readmore = (RecvBuf[3] == 3); // == 3 !
-		decoded = _DecodeBuffer(todecode, tagcount, &RecvBuf[5], tagbuf);
-#ifdef DEBUG
-		DumpBuffer(RecvBuf,res);
-		printf("To decode:%d decoded:%d \n", todecode, decoded);
-		fflush(stdout);
-#endif
-		if (decoded == todecode) {
-			tagcount += decoded;
-			if (readmore) {
-				res = iReadProt(100);
-				if (res < 0)
-					return tagcount;
-				todecode = RecvBuf[4];
-				readmore = (RecvBuf[3] == 3); // == 3 !
-			} else
-				havedata = 0;
-		} else {
-			// sometingwong
-			return ERR_DECODE;
-		}
-	}
-	return tagcount;
-}
-
-/**
- * MU80X iGetReaderInformation from address
- *
- * @param adr device address
- * @returns Reader information.
- */
-int MU80X::iGetReaderInformation(uint8_t addr) {
-	int res;
-	res = iSendProt(0, addr, 0x21, NULL);
-	return res;
-}
-
-/**
- * MU80X iGetReaderInformation from _devid
- *
- * @returns Reader information.
- */
-int MU80X::iGetReaderInformation() {
-	int res;
-	res = iSendProt(0, _devid, 0x21, NULL);
-	return res;
-}
-
-/**
- * MU80X iGetReaderSerial from _devid
- *
- * @returns Reader information.
- */
-int MU80X::iGetReaderSerial() {
-	int res;
-	res = iSendProt(0, _devid, 0x4C, NULL);
-	return res;
-}
-
-/**
- * MU80X iSetBaud 
- *
- * @param bd baud rate:  0=9600,1=19200,2=38400,5=57600,115200
- * @returns 0 on success, error code otherwise.
- */
-int MU80X::iSetBaud(uint8_t bd) { // 0=9600,1=19200,2=38400,5=57600,115200
-	int res;
-	unsigned char param[2];
-	param[0] = bd;
-	param[1] = 0;
-	res = iSendProt(1, _devid, 0x28, param);
-	return res;
-}
-
-/**
- * MU80X iSetPower 
- *
- * @param dbm sending power in dbm
- * @returns 0 on success, error code otherwise.
- */
-int MU80X::iSetPower(uint8_t dBm) {
-	int res;
-	unsigned char param[2];
-	param[0] = dBm;
-	param[1] = 0;
-	res = iSendProt(1, _devid, 0x2F, param);
-	return res;
-}
-
-/**
- * MU80X iSetRFRegion 
- *
- * @returns 0 on success, error code otherwise.
- */
-int MU80X::iSetRFRegion() {
-	int res;
-	unsigned char param[2];
-	param[0] = 0x4E; // 0x01 001110 maximum band = 1 + 865,1 + (14x200KHz=2,8 MHz) = 867,9
-	param[1] = 0x00; // 0x00 000000 minimum band = 0 = 865,1 MHz + (0 x 200KHz)
-	param[2] = 0;
-	res = iSendProt(2, _devid, 0x22, param);
-	return res;
-}
-
-/**
- * MU80X iSetScantime 
- *
- * @param time integer in 100ms units
- * @returns 0 on success, error code otherwise.
- */
-int MU80X::iSetScantime(uint8_t time) { // x * 100ms
-	int res;
-	unsigned char param[2];
-	param[0] = time;
-	param[1] = 0;
-	res = iSendProt(1, _devid, 0x25, param);
-	return res;
-}
-