/*
 * CAN_Transmit_Receive.c
 *
 *  Created on: 11 juli 2021
 *      Author: Daniel Mårtensson
 */

 /* Layer */
#include "Hardware.h"

/* This is a call back function e.g listener, that will be called once SAE J1939 data is going to be sent */
static void (*Callback_Function_Send)(uint32_t, uint8_t, uint8_t[]) = NULL;
static void (*Callback_Function_Read)(uint32_t*, uint8_t[], bool*) = NULL;
static void (*Callback_Function_Traffic)(uint32_t, uint8_t, uint8_t[], bool) = NULL;
static void (*Callback_Function_Delay_ms)(uint8_t) = NULL;

/* Platform independent library headers for CAN */
#if OPENSAE_J1939_TARGET_PLATFORM == STM32
#include "main.h"
#elif OPENSAE_J1939_TARGET_PLATFORM == ARDUINO
#elif OPENSAE_J1939_TARGET_PLATFORM == PIC
#elif OPENSAE_J1939_TARGET_PLATFORM == AVR
#elif OPENSAE_J1939_TARGET_PLATFORM == QT_USB
#include "CAN_to_USB/can_to_usb.h"
#elif OPENSAE_J1939_TARGET_PLATFORM == INTERNAL_CALLBACK
/* Nothing here because else statement should not be running */
#elif OPENSAE_J1939_TARGET_PLATFORM == SOCKETCAN
#include "SocketCAN.h"
#else
/* Internal fields */
static bool internal_new_message[256] = { false };
static uint8_t internal_data[256 * 8] = { 0 };
static uint8_t internal_DLC[256] = { 0 };
static uint32_t internal_ID[256] = { 0 };
static uint8_t buffer_index_transmit = 0;
static uint8_t buffer_index_receive = 0;

/* Internal functions */
static ENUM_J1939_STATUS_CODES Internal_Transmit(uint32_t ID, uint8_t data[], uint8_t DLC) {
	internal_ID[buffer_index_transmit] = ID;
	internal_DLC[buffer_index_transmit] = DLC;
	uint8_t i;
	for (i = 0; i < 8; i++) {
		if (i < DLC) {
			internal_data[buffer_index_transmit * 8 + i] = data[i];
		}
		else {
			internal_data[buffer_index_transmit * 8 + i] = 0x0;
		}
	}
	internal_new_message[buffer_index_transmit] = true;
	buffer_index_transmit++;									/* When this is 256, then it will be come 0 again */
	return STATUS_SEND_OK;
}

static void Internal_Receive(uint32_t* ID, uint8_t data[], bool* is_new_message) {
	/* Do a quick check if we are going to read message that have no data */
	if (internal_new_message[buffer_index_receive] == false) {
		*is_new_message = false;
		return;
	}

	*ID = internal_ID[buffer_index_receive];
	uint8_t i;
	for (i = 0; i < 8; i++) {
		if (i < internal_DLC[buffer_index_receive]) {
			data[i] = internal_data[buffer_index_receive * 8 + i];
		}
	}
	*is_new_message = internal_new_message[buffer_index_receive];
	/* Reset */
	internal_new_message[buffer_index_receive] = false;
	internal_DLC[buffer_index_receive] = 0;
	buffer_index_receive++;										/* When this is 256, then it will be come 0 again */
}
#endif

ENUM_J1939_STATUS_CODES CAN_Send_Message(uint32_t ID, uint8_t data[]) {
	ENUM_J1939_STATUS_CODES status = STATUS_SEND_BUSY;
#if OPENSAE_J1939_TARGET_PLATFORM == STM32
	CAN_TxHeaderTypeDef TxHeader;
	TxHeader.DLC = 8;											/* Here we are sending 8 bytes */
	TxHeader.RTR = CAN_RTR_DATA;								/* Data frame */
	TxHeader.IDE = CAN_ID_EXT;									/* We want to send an extended ID */
	TxHeader.TransmitGlobalTime = DISABLE;
	TxHeader.ExtId = ID;
	TxHeader.StdId = 0x00; 										/* Not used */
	status = STM32_PLC_CAN_Transmit(data, &TxHeader);
#elif OPENSAE_J1939_TARGET_PLATFORM == ARDUINO
	/* Implement your CAN send 8 bytes message function for the Arduino platform */
#elif OPENSAE_J1939_TARGET_PLATFORM == PIC
	/* Implement your CAN send 8 bytes message function for the PIC platform */
#elif OPENSAE_J1939_TARGET_PLATFORM == AVR
	/* Implement your CAN send 8 bytes message function for the AVR platform */
#elif OPENSAE_J1939_TARGET_PLATFORM == QT_USB
	status = QT_USB_Transmit(ID, data, 8);
#elif OPENSAE_J1939_TARGET_PLATFORM == SOCKETCAN
  status = socketcan_transmit(ID, data, 8);
#elif OPENSAE_J1939_TARGET_PLATFORM == INTERNAL_CALLBACK
	/* Call our callback function */
	Callback_Function_Send(ID, 8, data);
	status = STATUS_SEND_OK;
#else
	/* If no processor are used, use internal feedback for debugging */
	status = Internal_Transmit(ID, data, 8);
#endif

	/* Display traffic */
	if (Callback_Function_Traffic != NULL) {
		Callback_Function_Traffic(ID, 8, data, true); /* ID, 8 bytes of data, data array, TX = true */
	}

	return status;
}

/* Send a PGN request
 * PGN: 0x00EA00 (59904)
 */
ENUM_J1939_STATUS_CODES CAN_Send_Request(uint32_t ID, uint8_t PGN[]) {
	ENUM_J1939_STATUS_CODES status = STATUS_SEND_BUSY;
#if OPENSAE_J1939_TARGET_PLATFORM == STM32
	CAN_TxHeaderTypeDef TxHeader;
	TxHeader.DLC = 3;											/* Here we are only sending 3 bytes */
	TxHeader.RTR = CAN_RTR_DATA;								/* Data frame */
	TxHeader.IDE = CAN_ID_EXT;									/* We want to send an extended ID */
	TxHeader.TransmitGlobalTime = DISABLE;
	TxHeader.ExtId = ID;
	TxHeader.StdId = 0x00; 										/* Not used */
	status = STM32_PLC_CAN_Transmit(PGN, &TxHeader);
#elif OPENSAE_J1939_TARGET_PLATFORM == ARDUINO
	/* Implement your CAN send 3 bytes message function for the Arduino platform */
#elif OPENSAE_J1939_TARGET_PLATFORM == PIC
	/* Implement your CAN send 3 bytes message function for the PIC platform */
#elif OPENSAE_J1939_TARGET_PLATFORM == AVR
	/* Implement your CAN send 3 bytes message function for the AVR platform */
#elif OPENSAE_J1939_TARGET_PLATFORM == QT_USB
	status = QT_USB_Transmit(ID, PGN, 3);                       /* PGN is always 3 bytes */
#elif OPENSAE_J1939_TARGET_PLATFORM == SOCKETCAN
  status = socketcan_transmit(ID, PGN, 3);
#elif OPENSAE_J1939_TARGET_PLATFORM == INTERNAL_CALLBACK
	/* Call our callback function */
	Callback_Function_Send(ID, 3, PGN);
	status = STATUS_SEND_OK;
#else
	/* If no processor are used, use internal feedback for debugging */
	status = Internal_Transmit(ID, PGN, 3);
#endif

	/* Display traffic */
	if (Callback_Function_Traffic != NULL) {
		Callback_Function_Traffic(ID, 3, PGN, true); /* ID, 3 bytes of data, PGN array, TX = true */
	}

	return status;
}

/* Read the current CAN-bus message. Returning false if the message has been read before, else true */
bool CAN_Read_Message(uint32_t* ID, uint8_t data[]) {
	bool is_new_message = false;
#if OPENSAE_J1939_TARGET_PLATFORM == STM32
	STM32_PLC_CAN_Get_ID_Data(ID, data, &is_new_message);
#elif OPENSAE_J1939_TARGET_PLATFORM == ARDUINO
	/* Implement your CAN function to get ID, data[] and the flag is_new_message here for the Arduino platform */
#elif OPENSAE_J1939_TARGET_PLATFORM == PIC
	/* Implement your CAN function to get ID, data[] and the flag is_new_message here for the PIC platform */
#elif OPENSAE_J1939_TARGET_PLATFORM == AVR
	/* Implement your CAN function to get ID, data[] and the flag is_new_message here for the AVR platform */
#elif OPENSAE_J1939_TARGET_PLATFORM == QT_USB
	QT_USB_Get_ID_Data(ID, data, &is_new_message);
#elif OPENSAE_J1939_TARGET_PLATFORM == SOCKETCAN
  socketcan_receive(ID, data, &is_new_message);
#elif OPENSAE_J1939_TARGET_PLATFORM == INTERNAL_CALLBACK
	Callback_Function_Read(ID, data, &is_new_message);
#else
	/* If no processor are used, use internal feedback for debugging */
	Internal_Receive(ID, data, &is_new_message);
#endif

	/* Display traffic */
	if (Callback_Function_Traffic != NULL && is_new_message) {
		Callback_Function_Traffic(*ID, 8, data, false); /* ID, 8 bytes of data, data array, TX = false */
	}

	return is_new_message;
}

void CAN_Set_Callback_Functions(void (*Callback_Function_Send_)(uint32_t, uint8_t, uint8_t[]),
	void (*Callback_Function_Read_)(uint32_t*, uint8_t[], bool*),
	void (*Callback_Function_Traffic_)(uint32_t, uint8_t, uint8_t[], bool),
	void (*Callback_Function_Delay_ms_)(uint8_t)
) {
	Callback_Function_Send = Callback_Function_Send_;
	Callback_Function_Read = Callback_Function_Read_;
	Callback_Function_Traffic = Callback_Function_Traffic_;
	Callback_Function_Delay_ms = Callback_Function_Delay_ms_;
}

void CAN_Delay(uint8_t milliseconds) {
#if OPENSAE_J1939_TARGET_PLATFORM == STM32

#elif OPENSAE_J1939_TARGET_PLATFORM == ARDUINO

#elif OPENSAE_J1939_TARGET_PLATFORM == PIC

#elif OPENSAE_J1939_TARGET_PLATFORM == AVR

#elif OPENSAE_J1939_TARGET_PLATFORM == QT_USB

#elif OPENSAE_J1939_TARGET_PLATFORM == INTERNAL_CALLBACK
	Callback_Function_Delay_ms(milliseconds);

#elif OPENSAE_J1939_TARGET_PLATFORM == SOCKETCAN
  #include <unistd.h>
  usleep(milliseconds*1000);
#else
	/* Nothing */
#endif
}