144 lines
4.4 KiB
C
Raw Normal View History

2020-10-28 19:40:08 +01:00
#include <main.h>
#include <usart.h>
#include <PontCoopScheduler.h>
#include <mbusComm.h>
#include <loopCtrl.h>
#include <signal.h>
2020-10-29 21:02:04 +01:00
#include <logger.h>
2020-11-01 18:48:39 +01:00
#include <frontend.h>
2020-10-28 19:40:08 +01:00
typedef enum {
IDLE,
SEND,
2020-10-29 15:57:59 +01:00
SEND_CONT,
2020-11-02 15:02:39 +01:00
SENDING_DONE,
2020-11-01 18:48:39 +01:00
ENABLE_FRONTEND,
2020-11-02 15:41:07 +01:00
RECEIVING,
2020-11-01 18:48:39 +01:00
DISABLE_FRONTEND
2020-10-28 19:40:08 +01:00
} e_mbusCommState;
typedef struct {
e_mbusCommState state;
uint8_t retryCnt;
uint8_t cmd;
uint8_t addr;
uint8_t sendBuf[5];
2020-11-02 17:06:12 +01:00
uint8_t receiveCnt;
2020-11-02 15:41:07 +01:00
uint8_t receivedOctet;
bool receiving;
2020-10-28 19:40:08 +01:00
} t_mbusCommHandle;
2020-11-02 17:06:12 +01:00
static t_mbusCommHandle mbusCommHandle = { .state = IDLE, .retryCnt = 0, .cmd = 0, .addr = 0, .receiveCnt = 0, .receivedOctet = 0, .receiving = false };
2020-10-28 19:40:08 +01:00
2020-11-02 15:56:54 +01:00
static void handleRequestEngine(void *handle);
2020-11-02 15:41:07 +01:00
static void timeoutHandler(void *handle) {
logMsg("mbc timeout");
t_mbusCommHandle *localMbusCommHandle = (t_mbusCommHandle*) handle;
localMbusCommHandle->state = DISABLE_FRONTEND;
localMbusCommHandle->receiving = false;
handleRequestEngine(handle);
}
2020-10-28 19:40:08 +01:00
static void handleRequestEngine(void *handle) {
2020-10-29 15:57:59 +01:00
t_mbusCommHandle *localMbusCommHandle = (t_mbusCommHandle*) handle;
2020-10-28 19:40:08 +01:00
2020-10-29 15:57:59 +01:00
switch (localMbusCommHandle->state) {
2020-10-28 19:40:08 +01:00
case IDLE:
logMsg("hre state IDLE");
2020-10-28 19:40:08 +01:00
break;
case SEND:
logMsg("hre state SEND");
2020-10-29 15:57:59 +01:00
localMbusCommHandle->sendBuf[0] = 0x10;
localMbusCommHandle->sendBuf[1] = localMbusCommHandle->cmd;
localMbusCommHandle->sendBuf[2] = localMbusCommHandle->addr;
localMbusCommHandle->sendBuf[3] = localMbusCommHandle->cmd + localMbusCommHandle->addr; // checksum
localMbusCommHandle->sendBuf[4] = 0x16;
localMbusCommHandle->state = SEND_CONT;
2020-10-28 19:40:08 +01:00
// no break !!
case SEND_CONT:
logMsg("hre state SEND_CONT");
signal(LED_RED, OFF);
2020-10-28 19:40:08 +01:00
if (! loopActive) {
logMsg("hre enabling loop, try %d", localMbusCommHandle->retryCnt);
2020-10-29 15:57:59 +01:00
localMbusCommHandle->retryCnt++;
2020-10-28 19:40:08 +01:00
loopEnable();
2020-10-29 16:00:17 +01:00
schAdd(handleRequestEngine, handle, 10, 0); // give 10ms to settled the loop
2020-10-28 19:40:08 +01:00
} else {
localMbusCommHandle->retryCnt = 0;
2020-10-29 15:57:59 +01:00
HAL_UART_Transmit_IT(&mbusUart, localMbusCommHandle->sendBuf, 5);
2020-11-02 15:26:13 +01:00
// transition from here to SENDING_DONE is initiate by mbusCommTxCpltCallback
// interrupt callback
localMbusCommHandle->state = SENDING_DONE;
2020-10-29 15:57:59 +01:00
}
break;
2020-11-02 15:02:39 +01:00
case SENDING_DONE:
logMsg("hre state SENDING_DONE");
localMbusCommHandle->state = ENABLE_FRONTEND;
schAdd(handleRequestEngine, handle, 3, 0);
2020-10-28 19:40:08 +01:00
break;
2020-11-01 18:48:39 +01:00
case ENABLE_FRONTEND:
logMsg("hre state ENABLE_FRONTEND");
frontendEnable();
2020-11-02 15:41:07 +01:00
schAdd(timeoutHandler, handle, 500, 0); // 500ms timeout
localMbusCommHandle->state = RECEIVING;
2020-11-02 16:54:15 +01:00
localMbusCommHandle->receiving = false;
2020-11-02 17:06:12 +01:00
localMbusCommHandle->receiveCnt = 0;
2020-11-02 16:54:15 +01:00
// no break
2020-11-02 15:41:07 +01:00
case RECEIVING:
2020-11-02 17:00:14 +01:00
// logMsg("hre state RECEIVING");
2020-11-02 16:54:15 +01:00
if (! localMbusCommHandle->receiving) {
localMbusCommHandle->receiving = true;
HAL_UART_Receive_IT(&mbusUart, &(localMbusCommHandle->receivedOctet), 1);
} else {
localMbusCommHandle->receiving = false;
2020-11-02 17:06:12 +01:00
logMsg("hre received octet: 0x%02x: 0x%02x", localMbusCommHandle->receiveCnt, localMbusCommHandle->receivedOctet);
localMbusCommHandle->cnt += 1;
2020-11-02 16:55:54 +01:00
schAdd(handleRequestEngine, handle, 0, 0);
2020-11-02 16:54:15 +01:00
}
2020-11-01 18:48:39 +01:00
break;
case DISABLE_FRONTEND:
logMsg("hre state DISABLE_FRONTEND");
frontendDisable();
localMbusCommHandle->state = IDLE;
break;
2020-10-28 19:40:08 +01:00
default:
2020-10-29 15:57:59 +01:00
localMbusCommHandle->state = IDLE;
2020-10-28 19:40:08 +01:00
break;
}
}
2020-11-02 15:02:39 +01:00
void mbusCommTxCpltCallback(UART_HandleTypeDef *huart) {
2020-11-02 15:26:13 +01:00
schAdd(handleRequestEngine, (void*) &mbusCommHandle, 0, 0);
2020-11-02 15:02:39 +01:00
}
2020-10-28 19:40:08 +01:00
2020-11-02 15:41:07 +01:00
void mbusCommRxCpltCallback(UART_HandleTypeDef *huart) {
if (mbusCommHandle.receiving) {
schAdd(handleRequestEngine, (void*) &mbusCommHandle, 0, 0);
} else {
logMsg("mcrx: received 0x%02x but not expected", mbusCommHandle.receivedOctet);
}
}
2020-10-28 19:40:08 +01:00
void mbusCommRequest(uint8_t cmd, uint8_t addr) {
if (mbusCommHandle.state == IDLE) {
mbusCommHandle.state = SEND;
mbusCommHandle.retryCnt = 0;
mbusCommHandle.cmd = cmd;
mbusCommHandle.addr = addr;
schAdd(handleRequestEngine, (void*) &mbusCommHandle, 0, 0);
} else {
// busy
}
}