pierre romet / OBD2_freematics

/******************************************************************************
* Freematics Hub Server
* Developed by Stanley Huang <stanley@freematics.com.au>
* Distributed under GPL v3.0 license
* Visit https://freematics.com/hub for more information
*
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
* THE SOFTWARE.
******************************************************************************/

#include <stdio.h>
#include <string.h>
#include <fcntl.h>
#include <stdint.h>
#include <ctype.h>
#include <sys/stat.h>
#include "httpd.h"
#include "teleserver.h"

CHANNEL_DATA* assignChannel(const char* id);
FILE* createDataFile(CHANNEL_DATA* pld);

extern char serverKey[];

//////////////////////////////////////////////////////////////////////////
// callback from the web server whenever it recevies UDP data
//////////////////////////////////////////////////////////////////////////

int verifyChecksum(char* data)
{
	uint8_t sum = 0;
	char *p = strrchr(data, '*');
	if (!p) return 0;
	for (char *s = data; s < p; s++) sum += *s;
	if (hex2uint8(p + 1) == sum) {
		*p = 0; // strip checksum
		return 1;
	}
	else {
		return 0;
	}
}

int addChecksump(char* data)
{
	uint8_t sum = 0;
	char *s;
	for (s = data; *s; s++) sum += *s;
	s += sprintf(s, "*%X", sum);
	return (int)(s - data);
}

int incomingUDPCallback(void* _hp)
{
	HttpParam* hp = (HttpParam*)_hp;
	struct sockaddr_in cliaddr;
	socklen_t socklen = sizeof(cliaddr);
	char buf[4096];
	int recv;
	char* hostaddr;

	if ((recv = recvfrom(hp->udpSocket, buf, sizeof(buf) - 1, 0, (struct sockaddr *)&cliaddr, &socklen)) <= 0)
		return -1;


	/*
	Data format:
	<ID>#<timestamp>:<pid>=<data>[$<checksum>]
	*/

	buf[recv] = 0;
	hostaddr = inet_ntoa(cliaddr.sin_addr);
	fprintf(stderr, "%u bytes from %s | ", recv, hostaddr);

	// validate checksum
	if (!verifyChecksum(buf)) {
		fprintf(stderr, "UDP data checksum mismatch\n%s\n", buf);
		return -1;
	}

	CHANNEL_DATA* pld = 0;
	char *msg = 0;
	char *data;
	char* devid = 0;

	// validate header
	data = strchr(buf, '#');
	if (!data) {
		// invalid header
		fprintf(stderr, "Invalid data received - %s\n", buf);
		return -1;
	}

	// parse feed ID or device ID
	*data = 0;
	if ((int)(data - buf) > 4) {
		devid = buf;
		pld = findChannelByDeviceID(buf);
		if (pld) {
			devid = buf;
		}
	}
	else {
		int id = hex2uint16(buf);
		if (id) pld = findChannelByID(id);
	}
	data++; // now points to the start of data chunks

	uint64_t serverTick = GetTickCount64();
	uint32_t deviceTick = 0;
	uint32_t token = 0;
	uint16_t eventID = 0;
	uint16_t devflags = 0;
	int rssi = 0;

	if (strstr(data, "EV=")) {
		char* vin = 0;
		char* key = 0;
		char *s = strtok(data, ",");
		do {
			if (!strncmp(s, "EV=", 3)) {
				eventID = atoi(s + 3);
			}
			else if (!strncmp(s, "TS=", 3)) {
				deviceTick = atol(s + 3);
			}
			else if (!strncmp(s, "TK=", 3)) {
				token = atol(s + 3);
			}
			else if (!strncmp(s, "MSG=", 4)) {
				msg = s + 4;
			}
			else if (!strncmp(s, "ID=", 3)) {
				devid = s + 3;
			}
			else if (!strncmp(s, "VIN=", 4)) {
				vin = s + 4;
			}
			else if (!strncmp(s, "DF=", 3)) {
				devflags = atoi(s + 3);
			}
			else if (!strncmp(s, "SSI=", 4)) {
				rssi = atoi(s + 4);
			}
			else if (!strncmp(s, "SK=", 3)) {
				key = s + 3;
			}
		} while ((s = strtok(0, ",")));

		//fprintf(stderr, "Channel ID:%u Event ID:%u\n", id, eventID);
		if (eventID == EVENT_LOGIN) {
			if (!devid) devid = vin;
			pld = assignChannel(devid);
			if (!pld) {
				fprintf(getLogFile(), "No more channel");
				return 0;
			}

			if (vin && checkVIN(vin)) {
				strcpy(pld->vin, vin);
			}
			pld->rssi = rssi;
			pld->devflags = devflags;
			// TODO: also check timed out device
			if (*serverKey) {
				// match server key
				if (key && !strcmp(serverKey, key)) {
					memcpy(&pld->udpPeer, &cliaddr, sizeof(cliaddr));
				}
				else {
					return -2;
				}
			}
			else {
				// always accept
				memcpy(&pld->udpPeer, &cliaddr, sizeof(cliaddr));
			}
			if (!(pld->flags & FLAG_RUNNING) || serverTick - pld->serverDataTick > SESSION_GAP) {
				deviceLogin(pld);
				pld->serverDataTick = serverTick;
				pld->sessionStartTick = serverTick;
			}
			else {
				printf("DEVICE RE-LOGIN, ID:%s\n", pld->devid);
			}
			pld->deviceTick = deviceTick;
			// clear cache
			pld->cacheReadPos = 0;
			pld->cacheWritePos = 0;
			// clear instance data cache
			memset(pld->data, 0, sizeof(pld->data));
		}
	}
	if (!pld) {
		fprintf(stderr, "INVALID CHANNEL - %s\n", buf);
		return -1;
	}

	pld->dataReceived += recv;

	// check if authorized peer
#if 0
	if (memcmp(&cliaddr, &pld->udpPeer, sizeof(cliaddr))) {
		// unauthorized
		fprintf(stderr, "Unauthorized peer\n");
		return -1;
	}
#endif

	if (eventID == 0 || eventID == EVENT_PING) {
		processPayload(data, pld, eventID);
	} else if (eventID == EVENT_ACK) {
		// pending command executed
		if (msg) {
			for (int i = 0; i < MAX_PENDING_COMMANDS; i++) {
				COMMAND_BLOCK *cmd = pld->cmd + i;
				if (cmd->token && cmd->token == token) {
					cmd->flags |= CMD_FLAG_RESPONDED;
					cmd->elapsed = (uint16_t)(pld->serverDataTick - cmd->tick);
					// store received message
					int len = strlen(msg);
					if (cmd->message) {
						if (len > cmd->len) {
							free(cmd->message);
							cmd->message = malloc(len + 1);
						}
					}
					else {
						cmd->message = malloc(len + 1);
					}
					cmd->len = len;
					strcpy(cmd->message, msg);
					break;
				}
			}
		}
		// no response needed for ACK
		return 0;
	}

	if (eventID == 0) {
		if (serverTick - pld->serverSyncTick >= SYNC_INTERVAL * 1000) {
			// send sync event
			pld->serverSyncTick = serverTick;
			eventID = EVENT_SYNC;
		}
		else {
			// no response if no sync is required
			return 0;
		}
	}
	// generate response
	int len = sprintf(buf, "%X#EV=%u,RX=%u,TX=%u", pld->id, eventID, pld->recvCount, ++pld->txCount);
	switch (eventID) {
	case EVENT_LOGOUT:
		deviceLogout(pld);
		break;
	case EVENT_PING:
		fprintf(stderr, "Ping received\n");
		pld->serverPingTick = serverTick;
		pld->flags &= ~FLAG_RUNNING;
		pld->flags |= (FLAG_SLEEPING | FLAG_PINGED);
		break;
	case EVENT_RECONNECT:
		fprintf(stderr, "DEVICE RECONNECTED, ID:%s\n", pld->devid);
		break;
	}
	// send UDP response
	len = addChecksump(buf);
	if (sendto(hp->udpSocket, buf, len, 0, (struct sockaddr *)&cliaddr, socklen) == len)
		fprintf(stderr, "Reply sent:%s\n", buf);
	else
		fprintf(stderr, "Reply unsent\n");

	return 0;
}

uint32_t issueCommand(HttpParam* hp, CHANNEL_DATA *pld, const char* cmd, uint32_t token)
{
	if (token == 0) token = ++pld->cmdCount;
	char buf[128];
	sprintf(buf, "%X#EV=%u,TK=%u,CMD=%s", pld->id, EVENT_COMMAND, token, cmd);
	int len = addChecksump(buf);
	socklen_t socklen = sizeof(struct sockaddr);
	pld->serverDataTick = GetTickCount64();
	if (sendto(hp->udpSocket, buf, len, 0, (struct sockaddr *)&pld->udpPeer, socklen) == len) {
		fprintf(stderr, "Command sent: %s (%u)\n", cmd, token);
		// find out checked pending command
		COMMAND_BLOCK *cmd = 0;
		for (int i = 0; i < MAX_PENDING_COMMANDS; i++) {
			cmd = pld->cmd + i;
			if (cmd->token == 0 || (cmd->flags & CMD_FLAG_CHECKED)) {
				break;
			}
			cmd = 0;
		}
		if (!cmd) {
			// find out oldest pending command regardless of its status
			unsigned int maxElapsed = 0;
			for (int i = 0; i < MAX_PENDING_COMMANDS; i++) {
				unsigned int elapsed = (unsigned int)(pld->serverDataTick - pld->cmd[i].tick);
				if (elapsed >= maxElapsed) {
					cmd = pld->cmd + i;
					maxElapsed = elapsed;
				}
			}
		}
		if (cmd) {
			// place sent command in pending command list
			cmd->token = token;
			cmd->tick = pld->serverDataTick;
			cmd->flags = 0;
		}
		return token;
	}
	else {
		fprintf(stderr, "Command unsent\n");
		return 0;
	}
}