#include "FreeRTOS.h"
#include "task.h"
#include "semphr.h"

#include "chip.h"
#include "board.h"


extern void csi_init(void);

static TaskHandle_t carback_task = NULL;
//static SemaphoreHandle_t carback_mutex;
static int carback_status = 0;

#ifdef VIDEO_DECODER_RN6752
extern int rn6752_init(void);
#endif
#ifdef VIDEO_DECODER_ARK7116
extern int ark7116_init();
#endif

#ifdef VIDEO_DECODER_ARK7116M
extern int ark7116M_init(void);
#endif


void notify_enter_carback(void)
{
	if (carback_task)
		xTaskNotify(carback_task, 1, eSetValueWithOverwrite);
}

void notify_exit_carback(void)
{
	if (carback_task)
		xTaskNotify(carback_task, 0, eSetValueWithOverwrite);
}

int get_carback_status(void)
{
	int status;

	portENTER_CRITICAL();
	status = carback_status;
	portEXIT_CRITICAL();

	return status;
}

static void carback_thread(void *param)
{
	uint32_t ulNotifiedValue;

	//carback_mutex = xSemaphoreCreateMutex();

#if	defined(VIDEO_DECODER_RN6752)
	rn6752_init();
#elif defined(VIDEO_DECODER_ARK7116)
	ark7116_init();
#elif defined(VIDEO_DECODER_ARK7116M)
	ark7116M_init();
#endif
#if defined(VIDEO_DECODER_MIPI)
	csi_init();
#endif


	for (;;) {
		xTaskNotifyWait( 0x00, /* Don't clear any notification bits on entry. */
			0xffffffff, /* Reset the notification value to 0 on exit. */
			&ulNotifiedValue, /* Notified value pass out in ulNotifiedValue. */
			portMAX_DELAY);

		if (ulNotifiedValue && !carback_status) {
			printf("enter carback.\n");
			ItuConfigPara para = {0};

			para.itu601 = ITU_601;//ITU_601
			para.out_format = ITU_Y_UV420;//ITU_Y_UV422;//ITU_Y_UV420;
			//para.yuv_type = ITU_Y_UV;
#if VIN_WIDTH != LCD_WIDTH || VIN_HEIGHT != LCD_HEIGHT
			para.scale_bypass = 0;//0:scale enable 1:scale bypass
#else
			para.scale_bypass = 1;
#endif

			if(para.scale_bypass == 0)
			{
						
				para.in_width = VIN_WIDTH;//VIN_WIDTH;
				para.in_height = VIN_HEIGHT;//VIN_HEIGHT;
#ifdef REVERSE_TRACK
				para.out_width = 704;
				para.out_height = 440;
#else
				para.out_width = LCD_WIDTH;
				para.out_height = LCD_HEIGHT;
#endif
				para.scale_out_width = LCD_WIDTH;//LCD_WIDTH;
				para.scale_out_height = LCD_HEIGHT;//LCD_HEIGHT;
			}
			else if(para.scale_bypass == 1)
			{
				para.in_width = VIN_WIDTH;//VIN_WIDTH;
				para.in_height = VIN_HEIGHT;//VIN_HEIGHT;						

#ifdef REVERSE_TRACK
				para.out_width = 704;
				para.out_height = 440;
#else
				para.out_width = VIN_WIDTH;//LCD_WIDTH;
				para.out_height = VIN_HEIGHT;//LCD_HEIGHT;
#endif
				para.scale_out_width = VIN_WIDTH;//LCD_WIDTH;
				para.scale_out_height = VIN_HEIGHT;//LCD_HEIGHT;
			
			}

			para.Input_DataMode = ITU_ITU656_601;//ITU_MIPI;
			para.hmirror = 0;//0:normal 1:horizontal mirror
			para.vflip = 0;//0:normal 1:vertical filp			

			itu_config(&para);
			itu_start();
			carback_status = 1;
		} else if (!ulNotifiedValue && carback_status) {
			printf("exit carback.\n");
			itu_stop();
			carback_status = 0;
		}
	}
}

static void carback_test_thread(void *param)
{
	for (;;) {
		vTaskDelay(pdMS_TO_TICKS(30000));
		notify_enter_carback();
		vTaskDelay(pdMS_TO_TICKS(10000));
		notify_exit_carback();
	}
}

int carback_init(void)
{
	/* Create a task to play animation */
	if (xTaskCreate(carback_thread, "carback", configMINIMAL_STACK_SIZE, NULL,
		configMAX_PRIORITIES - 3, &carback_task) != pdPASS) {
		printf("create carback task fail.\n");
		carback_task = NULL;
		return -1;
	}

	xTaskCreate(carback_test_thread, "ctest", configMINIMAL_STACK_SIZE, NULL,
		configMAX_PRIORITIES / 2, NULL);

	return 0;
}