/*
 * WS28xxStrip.h
 *
 *  Created on: Dec 2, 2020
 *      Author: compi
 */

#ifndef WS28XXSTRIP_H_
#define WS28XXSTRIP_H_

#include <stdint.h>
#include <stm32f1xx_ll_dma.h>
#include <stm32f1xx_ll_gpio.h>
#include <stm32f1xx_ll_spi.h>

#include <FreeRTOS.h>
#include <task.h>
#include <semphr.h>

#include <f1ll/dmahelper.h>

struct pixel_t {
	uint8_t g;
	uint8_t r;
	uint8_t b;
};


template <uint16_t pixels, uint8_t spi_pixels> class WS28xxStrip {
public:
	WS28xxStrip(SPI_TypeDef *spi, DMA_TypeDef *dma, uint32_t channel, pixel_t defcolor);

	pixel_t& operator[](int16_t index);

	void Update();

	static void RefillTaskEntry(void *param) { reinterpret_cast<WS28xxStrip<pixels, spi_pixels>*>(param)->RefillTask(); }

	void HandleSpiDmaIrq();

private:
	void RefillTask();
	void Convert(uint8_t *src, uint8_t *dst, uint16_t src_size);
	template<typename T> T Min(T a, T b) { return a < b ? a : b; }

	SPI_TypeDef *m_spi;
	f1ll::DmaHelper	m_dma;

	TaskHandle_t	m_task_handle = nullptr;

	static constexpr const unsigned int SPI_PIXEL_SIZE = sizeof(pixel_t) * 4;
	static constexpr const unsigned int SPI_BUFFER_SIZE = spi_pixels * SPI_PIXEL_SIZE;

	pixel_t	m_pixels[pixels];
	uint8_t m_spi_buffer[2][SPI_BUFFER_SIZE];


	StaticSemaphore_t m_main_mutex_buffer;
	SemaphoreHandle_t m_main_mutex;
	//volatile uint8_t m_spi_idle = 0;
	volatile uint8_t m_buffer_in_transmit;
	volatile uint16_t m_pixels_converted = 0;
	volatile bool m_endframe = false;
	volatile bool m_endprev = false;
};

//////////////////////////////////////////////////////////////////////////////
//////////////////////////////////////////////////////////////////////////////
template <uint16_t pixels, uint8_t spi_pixels> WS28xxStrip<pixels, spi_pixels>::WS28xxStrip(SPI_TypeDef *spi, DMA_TypeDef *dma, uint32_t channel, pixel_t defcolor)
: m_spi(spi)
, m_dma(dma, channel)
, m_main_mutex(xSemaphoreCreateBinaryStatic(&m_main_mutex_buffer))
{
	for(uint16_t p=0; p < pixels; ++p)
		m_pixels[p] = defcolor;

	xSemaphoreGive(m_main_mutex);
}

//////////////////////////////////////////////////////////////////////////////
template <uint16_t pixels, uint8_t spi_pixels> pixel_t& WS28xxStrip<pixels, spi_pixels>::operator[](int16_t index)
{
	return m_pixels[index];
}

//////////////////////////////////////////////////////////////////////////////
template <uint16_t pixels, uint8_t spi_pixels> void WS28xxStrip<pixels, spi_pixels>::HandleSpiDmaIrq()
{
	LL_GPIO_TogglePin(GPIOA, LL_GPIO_PIN_0);

	BaseType_t woken;

	if(*m_dma.GetIsReg() & m_dma.GetTeMask()) {
		*m_dma.GetIfcReg() = m_dma.GetTeMask();
	}
	else if(*m_dma.GetIsReg() & m_dma.GetHtMask() || *m_dma.GetIsReg() & m_dma.GetTcMask())
	{
		if(*m_dma.GetIsReg() & m_dma.GetHtMask())
		{
			*m_dma.GetIfcReg() = m_dma.GetHtMask();
			m_buffer_in_transmit = 1;
			if(m_endframe)
				LL_DMA_SetMode(m_dma.GetDma(), m_dma.GetChannel(), LL_DMA_MODE_NORMAL);
		}
		else if(*m_dma.GetIsReg() & m_dma.GetTcMask())
		{
			*m_dma.GetIfcReg() = m_dma.GetTcMask();
			m_buffer_in_transmit = 0;
			if(m_endframe && m_endprev) {
				LL_DMA_DisableChannel(m_dma.GetDma(), m_dma.GetChannel());
				LL_DMA_SetMode(m_dma.GetDma(), m_dma.GetChannel(), LL_DMA_MODE_CIRCULAR);
				woken = pdFALSE;
				xSemaphoreGiveFromISR(m_main_mutex, &woken);
				portYIELD_FROM_ISR(woken);
				m_endframe = m_endprev = false;
				return;
			}
		}

		woken = pdFALSE;

		if(m_task_handle) {
			LL_GPIO_TogglePin(GPIOA, LL_GPIO_PIN_0);
			vTaskNotifyGiveFromISR(m_task_handle, &woken);
			portYIELD_FROM_ISR(woken);
		}
	}
}

//////////////////////////////////////////////////////////////////////////////
template <uint16_t pixels, uint8_t spi_pixels> void WS28xxStrip<pixels, spi_pixels>::RefillTask()
{
	m_task_handle = xTaskGetCurrentTaskHandle();

	while(true)
	{
		if( ulTaskNotifyTake(pdFALSE, pdMS_TO_TICKS(1000)) > 0)
		{
			LL_GPIO_TogglePin(GPIOC, LL_GPIO_PIN_13);
			m_endprev = m_endframe;

			uint8_t convert_now = Min((uint8_t)(pixels - m_pixels_converted), spi_pixels);

			if(convert_now)
			{
				Convert((uint8_t*)&m_pixels[m_pixels_converted],
						m_spi_buffer[m_buffer_in_transmit ^ 1],
						convert_now * sizeof(pixel_t));
				m_pixels_converted += convert_now;
			}

			if(convert_now < spi_pixels) {
				memset(m_spi_buffer[m_buffer_in_transmit ^ 1] + convert_now * SPI_PIXEL_SIZE,
						0, SPI_BUFFER_SIZE - convert_now * SPI_PIXEL_SIZE);
				m_endframe = true;
			}
			LL_GPIO_TogglePin(GPIOC, LL_GPIO_PIN_13);
		}
	}
}

//////////////////////////////////////////////////////////////////////////////
template <uint16_t pixels, uint8_t spi_pixels> void WS28xxStrip<pixels, spi_pixels>::Update()
{
	xSemaphoreTake(m_main_mutex, portMAX_DELAY);

	m_pixels_converted = 0;

	Convert((uint8_t*)m_pixels, m_spi_buffer[0], spi_pixels * sizeof(pixel_t));
	m_pixels_converted += spi_pixels;
	Convert((uint8_t*)&m_pixels[m_pixels_converted], m_spi_buffer[1], spi_pixels * sizeof(pixel_t));
	m_pixels_converted += spi_pixels;

	m_buffer_in_transmit = 0;

	LL_DMA_ConfigAddresses(m_dma.GetDma(), m_dma.GetChannel(), (uint32_t)m_spi_buffer, LL_SPI_DMA_GetRegAddr(m_spi), LL_DMA_DIRECTION_MEMORY_TO_PERIPH);
	LL_DMA_SetDataLength(m_dma.GetDma(), m_dma.GetChannel(), sizeof(m_spi_buffer));
	LL_DMA_EnableChannel(m_dma.GetDma(), m_dma.GetChannel());
	LL_DMA_EnableIT_HT(m_dma.GetDma(), m_dma.GetChannel());
	LL_DMA_EnableIT_TC(m_dma.GetDma(), m_dma.GetChannel());
	LL_DMA_EnableIT_TE(m_dma.GetDma(), m_dma.GetChannel());
}

//////////////////////////////////////////////////////////////////////////////
template <uint16_t pixels, uint8_t spi_pixels> void WS28xxStrip<pixels, spi_pixels>::Convert(uint8_t *src, uint8_t *dst, uint16_t src_size)
{
	static uint16_t const bits[16] = { // due to LE-ness the bit order is 1 0 3 2
			0b1000100010001000, 0b1000111010001000, 0b1110100010001000, 0b1110111010001000,
			0b1000100010001110, 0b1000111010001110, 0b1110100010001110, 0b1110111010001110,
			0b1000100011101000, 0b1000111011101000, 0b1110100011101000, 0b1110111011101000,
			0b1000100011101110, 0b1000111011101110, 0b1110100011101110, 0b1110111011101110
	};

	uint16_t *dstptr = (uint16_t*)dst;
	while(src_size--) {
		uint8_t tmp =*src++;
		*dstptr++ = bits[tmp >> 4];
		*dstptr++ = bits[tmp & 0x0f];
	}
}

#endif /* WS28XXSTRIP_H_ */