refactoring meterbus

This commit is contained in:
Wolfgang Hottgenroth 2020-11-24 19:36:47 +01:00
parent bdba2a79cd
commit 14bf178664
Signed by: wn
GPG Key ID: 6C1E5E531E0D5D7F
5 changed files with 112 additions and 38 deletions

View File

@ -16,7 +16,6 @@ void ringbufferInit(ringbuffer_t *handle, uint32_t bufferSize);
void ringbufferFree(ringbuffer_t *handle);
int ringbufferPut(ringbuffer_t *handle, uint8_t *data, uint32_t dataLen);
int ringbufferPutOne(ringbuffer_t *handle, uint8_t data);
bool ringbufferEmpty(ringbuffer_t *handle);
int ringbufferGetOne(ringbuffer_t *handle); // if positive, cast to uint8_t and be happy, if negative error

View File

@ -79,17 +79,24 @@ typedef struct {
uint8_t stop;
} t_longframe;
typedef struct {
uint16_t size;
uint16_t readIdx;
uint16_t writeIdx;
uint8_t *buffer;
} linearBuffer_t;
typedef struct {
uint32_t requestId;
e_mbusCommState state;
uint8_t retryCnt;
uint8_t cmd;
uint8_t addr;
uint8_t sendBuf[5];
linearBuffer_t sendBuffer;
linearBuffer_t receiveBuffer;
uint8_t receiveCnt;
bool waitForOctet;
bool receiving;
ringbuffer_t receiveBuffer;
e_mbusCommResult result;
t_longframe frame;
t_mbusDevice *device;
@ -249,18 +256,17 @@ static void parseAndPrintFrame() {
void mbusCommISR() {
// coloredMsg(LOG_RED, false, "mbc isr");
show(DEBUG_1, TOGGLE);
uint32_t isrflags = READ_REG(mbusUart.Instance->SR);
// uint32_t cr1its = READ_REG(mbusUart.Instance->CR1);
// uint32_t cr3its = READ_REG(mbusUart.Instance->CR3);
if (((isrflags & USART_SR_RXNE) != RESET) || ((isrflags & USART_SR_ORE) != RESET)) {
uint8_t data = (uint8_t)(mbusUart.Instance->DR & (uint8_t)0x00FF);
coloredMsg(LOG_RED, false, "mbc isr 0x%02x", data);
ringbufferPutOne(&(mbusCommHandle.receiveBuffer), data);
if (mbusCommHandle.receiveBuffer.writeIdx < mbusCommHandle.receiveBuffer.size) {
mbusCommHandle.receiveBuffer.buffer[mbusCommHandle.receiveBuffer.writeIdx] = data;
mbusCommHandle.receiveBuffer.writeIdx += 1;
}
return;
} else {
coloredMsg(LOG_RED, false, "mbc isr error 0x%02x", isrflags);
@ -274,17 +280,14 @@ void mbusCommExec() {
uint8_t receivedOctet = 0;
if (mbusCommHandle.waitForOctet) {
// when data available, take from buffer and put into receivedOctet
// otherwise return
int ro = ringbufferGetOne(&(mbusCommHandle.receiveBuffer));
if (-1 == ro) {
// coloredMsg(LOG_RED, false, "RO: nothing");
if (mbusCommHandle.receiveBuffer.readIdx >= mbusCommHandle.receiveBuffer.writeIdx) {
return;
}
receivedOctet = mbusCommHandle.receiveBuffer.buffer[mbusCommHandle.receiveBuffer.readIdx];
mbusCommHandle.receiveBuffer.readIdx += 1;
mbusCommHandle.waitForOctet = false;
receivedOctet = (uint8_t) ro;
coloredMsg(LOG_RED, false, "RO: 0x%02x", receivedOctet);
}
@ -295,11 +298,13 @@ void mbusCommExec() {
case MBCS_SEND:
coloredMsg(LOG_YELLOW, false, "mbc hre [%d] state SEND", mbusCommHandle.requestId);
mbusCommHandle.sendBuf[0] = 0x10;
mbusCommHandle.sendBuf[1] = mbusCommHandle.cmd;
mbusCommHandle.sendBuf[2] = mbusCommHandle.addr;
mbusCommHandle.sendBuf[3] = mbusCommHandle.cmd + mbusCommHandle.addr; // checksum
mbusCommHandle.sendBuf[4] = 0x16;
mbusCommHandle.sendBuffer.buffer[0] = 0x10;
mbusCommHandle.sendBuffer.buffer[1] = mbusCommHandle.cmd;
mbusCommHandle.sendBuffer.buffer[2] = mbusCommHandle.addr;
mbusCommHandle.sendBuffer.buffer[3] = mbusCommHandle.cmd + mbusCommHandle.addr; // checksum
mbusCommHandle.sendBuffer.buffer[4] = 0x16;
mbusCommHandle.sendBuffer.readIdx = 0;
mbusCommHandle.sendBuffer.writeIdx = 5;
mbusCommHandle.state = MBCS_SEND_CONTINUED;
// no break !!
@ -314,7 +319,7 @@ void mbusCommExec() {
} else {
mbusCommHandle.retryCnt = 0;
// FIXME sending possibly needs to be done in a different way
HAL_UART_Transmit(&mbusUart, mbusCommHandle.sendBuf, 5, HAL_MAX_DELAY);
HAL_UART_Transmit(&mbusUart, mbusCommHandle.sendBuffer.buffer, 5, HAL_MAX_DELAY);
// transition from here to SENDING_DONE is initiate by mbusCommTxCpltCallback
// interrupt callback
mbusCommHandle.state = MBCS_SENDING_DONE;
@ -332,6 +337,8 @@ void mbusCommExec() {
frontendEnable();
calculatedChksum = 0;
userdataIdx = 0;
mbusCommHandle.receiveBuffer.readIdx = 0;
mbusCommHandle.receiveBuffer.writeIdx = 0;
mbusCommHandle.waitForOctet = true;
mbusCommHandle.state = MBCS_START1;
break;
@ -707,7 +714,16 @@ void mbusCommInit() {
__HAL_UART_ENABLE_IT(&mbusUart, UART_IT_ERR);
__HAL_UART_ENABLE_IT(&mbusUart, UART_IT_RXNE);
ringbufferInit(&(mbusCommHandle.receiveBuffer), 256);
mbusCommHandle.receiveBuffer.size = 256;
mbusCommHandle.receiveBuffer.buffer = (uint8_t*) malloc(mbusCommHandle.receiveBuffer.size);
mbusCommHandle.receiveBuffer.readIdx = 0;
mbusCommHandle.receiveBuffer.writeIdx = 0;
mbusCommHandle.sendBuffer.size = 8;
mbusCommHandle.sendBuffer.buffer = (uint8_t*) malloc(mbusCommHandle.sendBuffer.size);
mbusCommHandle.sendBuffer.readIdx = 0;
mbusCommHandle.sendBuffer.writeIdx = 0;
// FIXME
schAdd(mbusCommScheduler, NULL, 0, 1000);

View File

@ -19,18 +19,6 @@ void ringbufferFree(ringbuffer_t *handle) {
handle->bufferWriteIdx = 0;
}
int ringbufferPutOne(ringbuffer_t *handle, uint8_t data) {
int retCode = -1;
if (handle->bufferReadIdx != handle->bufferWriteIdx) {
*(handle->buffer + handle->bufferWriteIdx) = data;
handle->bufferWriteIdx += 1;
if (handle->bufferWriteIdx == handle->bufferSize) {
handle->bufferWriteIdx = 0;
}
retCode = 0;
}
return retCode;
}
int ringbufferPut(ringbuffer_t *handle, uint8_t *data, uint32_t dataLen) {
uint32_t freeSpace = 0;

View File

@ -1,6 +1,6 @@
CFLAGS=-I../cube/User/Inc -DTEST
test: ringbuffer.o logger.o test.o
test: ringbuffer.o test.o
gcc -o $@ -lcunit $^
ringbuffer.o: ../cube/User/Src/ringbuffer.c

View File

@ -2,7 +2,7 @@
#include <stdio.h>
#include <stdbool.h>
#include <ringbuffer.h>
#include <logger.h>
//#include <logger.h>
// #define DEBUG
@ -10,6 +10,7 @@
ringbuffer_t rb;
void printRingbuffer(ringbuffer_t *rb) {
printf("Ringbuffer:\n");
printf(" Size: %u\n", rb->bufferSize);
@ -817,8 +818,75 @@ void testRingbuffer99() {
}
void testRingbuffer100() {
#ifdef DEBUG
printf("Initialize ringbuffer\n");
#endif
ringbufferInit(&rb, 16);
#ifdef DEBUG
printRingbuffer(&rb);
#endif
CU_ASSERT(rb.buffer != NULL);
CU_ASSERT(rb.bufferSize == 16);
CU_ASSERT(rb.bufferWriteIdx == 0);
CU_ASSERT(rb.bufferReadIdx == 0);
CU_ASSERT(rb.buffer[0] == 0);
CU_ASSERT(rb.buffer[1] == 0);
CU_ASSERT(rb.buffer[2] == 0);
CU_ASSERT(rb.buffer[3] == 0);
CU_ASSERT(rb.buffer[4] == 0);
CU_ASSERT(rb.buffer[5] == 0);
CU_ASSERT(rb.buffer[6] == 0);
CU_ASSERT(rb.buffer[7] == 0);
CU_ASSERT(rb.buffer[8] == 0);
CU_ASSERT(rb.buffer[9] == 0);
CU_ASSERT(rb.buffer[10] == 0);
CU_ASSERT(rb.buffer[11] == 0);
CU_ASSERT(rb.buffer[12] == 0);
CU_ASSERT(rb.buffer[13] == 0);
CU_ASSERT(rb.buffer[14] == 0);
CU_ASSERT(rb.buffer[15] == 0);
}
void testRingbuffer101() {
#ifdef DEBUG
printf("\nPut 1 chars in buffer\n");
#endif
int r = ringbufferPutOne(&rb, 'a');
#ifdef DEBUG
printf("r = %d\n", r);
printRingbuffer(&rb);
#endif
CU_ASSERT(r == 0);
CU_ASSERT(rb.buffer != NULL);
CU_ASSERT(rb.bufferSize == 16);
CU_ASSERT(rb.bufferWriteIdx == 1);
CU_ASSERT(rb.bufferReadIdx == 0);
CU_ASSERT(rb.buffer[0] == 'a');
CU_ASSERT(rb.buffer[1] == 0);
CU_ASSERT(rb.buffer[2] == 0);
CU_ASSERT(rb.buffer[3] == 0);
CU_ASSERT(rb.buffer[4] == 0);
CU_ASSERT(rb.buffer[5] == 0);
CU_ASSERT(rb.buffer[6] == 0);
CU_ASSERT(rb.buffer[7] == 0);
CU_ASSERT(rb.buffer[8] == 0);
CU_ASSERT(rb.buffer[9] == 0);
CU_ASSERT(rb.buffer[10] == 0);
CU_ASSERT(rb.buffer[11] == 0);
CU_ASSERT(rb.buffer[12] == 0);
CU_ASSERT(rb.buffer[13] == 0);
CU_ASSERT(rb.buffer[14] == 0);
CU_ASSERT(rb.buffer[15] == 0);
}
/*
int init_suite_logger(void) {
logInit();
return 0;
@ -949,7 +1017,7 @@ void testLogger2() {
CU_ASSERT(strcmp(goldValueFullNotOk, buffer) != 0);
CU_ASSERT(strcmp(goldValueFullOk, buffer) == 0);
}
*/
int main() {
@ -980,11 +1048,14 @@ int main() {
(NULL == CU_add_test(ringbufferSuite, "test 14 of ringbuffer", testRingbuffer15)) ||
(NULL == CU_add_test(ringbufferSuite, "test 14 of ringbuffer", testRingbuffer16)) ||
(NULL == CU_add_test(ringbufferSuite, "test 99 of ringbuffer, free", testRingbuffer99)) ||
(NULL == CU_add_test(ringbufferSuite, "test 100 of ringbuffer, free", testRingbuffer100)) ||
(NULL == CU_add_test(ringbufferSuite, "test 101 of ringbuffer, free", testRingbuffer101)) ||
0 ) {
CU_cleanup_registry();
return CU_get_error();
}
/*
CU_pSuite loggerSuite = CU_add_suite("Suite_Logger", init_suite_logger, clean_suite_logger);
if (NULL == loggerSuite) {
CU_cleanup_registry();
@ -999,7 +1070,7 @@ int main() {
CU_cleanup_registry();
return CU_get_error();
}
*/
CU_basic_set_mode(CU_BRM_VERBOSE);
CU_basic_run_tests();