2020-10-28 19:40:08 +01:00
|
|
|
#include <main.h>
|
|
|
|
#include <usart.h>
|
|
|
|
#include <PontCoopScheduler.h>
|
|
|
|
#include <mbusComm.h>
|
|
|
|
#include <loopCtrl.h>
|
|
|
|
#include <led.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-01 18:48:39 +01:00
|
|
|
SENDING,
|
|
|
|
ENABLE_FRONTEND,
|
|
|
|
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];
|
|
|
|
} t_mbusCommHandle;
|
|
|
|
|
|
|
|
static t_mbusCommHandle mbusCommHandle = { .state = IDLE, .retryCnt = 0, .cmd = 0, .addr = 0 };
|
|
|
|
|
|
|
|
|
|
|
|
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:
|
2020-10-29 23:16:03 +01:00
|
|
|
logMsg("hre state IDLE");
|
2020-10-28 19:40:08 +01:00
|
|
|
break;
|
|
|
|
|
|
|
|
case SEND:
|
2020-10-29 23:16:03 +01:00
|
|
|
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:
|
2020-10-29 23:16:03 +01:00
|
|
|
logMsg("hre state SEND_CONT");
|
2020-10-29 15:44:13 +01:00
|
|
|
led(RED, OFF);
|
2020-10-28 19:40:08 +01:00
|
|
|
if (! loopActive) {
|
2020-10-29 23:16:03 +01:00
|
|
|
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 {
|
|
|
|
// write(fd, sendBuf, 5);
|
2020-10-29 23:16:03 +01:00
|
|
|
localMbusCommHandle->retryCnt = 0;
|
2020-10-29 15:57:59 +01:00
|
|
|
HAL_UART_Transmit_IT(&mbusUart, localMbusCommHandle->sendBuf, 5);
|
|
|
|
localMbusCommHandle->state = SENDING;
|
2020-11-01 18:48:39 +01:00
|
|
|
schAdd(handleRequestEngine, handle, 15, 0); // ask me again in 15ms in the next state ...
|
2020-10-29 15:57:59 +01:00
|
|
|
}
|
|
|
|
break;
|
|
|
|
|
|
|
|
case SENDING:
|
2020-10-29 23:16:03 +01:00
|
|
|
logMsg("hre state SENDING");
|
2020-10-29 16:00:17 +01:00
|
|
|
if (HAL_UART_GetState(&mbusUart) == HAL_UART_STATE_READY) { // ... whether I'm done
|
2020-11-01 18:48:39 +01:00
|
|
|
localMbusCommHandle->state = ENABLE_FRONTEND;
|
|
|
|
schAdd(handleRequestEngine, handle, 3, 0);
|
2020-10-29 15:57:59 +01:00
|
|
|
} else {
|
2020-11-01 18:48:39 +01:00
|
|
|
schAdd(handleRequestEngine, handle, 1, 0); // not yet done, ask me again in 1ms
|
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();
|
|
|
|
localMbusCommHandle->state = DISABLE_FRONTEND;
|
2020-11-01 18:57:25 +01:00
|
|
|
schAdd(handleRequestEngine, handle, 500, 0);
|
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;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
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
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|