/*
 * Copyright (c) 2017 FH Dortmund and others
 * All rights reserved. This program and the accompanying materials
 * are made available under the terms of the Eclipse Public License v1.0
 * which accompanies this distribution, and is available at
 * http://www.eclipse.org/legal/epl-v10.html
 *
 * Description:
 *    SSD1306 I2C OLED Display Task
 *
 * Contributors / Revision History:
 *    M.Ozcelikors <mozcelikors@gmail.com>, created 04.10.2017
 *    M.Ozcelikors <mozcelikors@gmail.com>, application is enhanced (status, appstacle displays) 08.10.2017
 *
 * Usage Instructions:
 *    1) One should set-up I2C on Raspberry Pi to run this script properly (taken from Adafruit):
 *           1.1) Install necessary modules:
 *                sudo apt-get install -y python-smbus
 *                sudo apt-get install -y i2c-tools
 *           1.2) In /etc/modules, add following lines:
 *           	  i2c-bcm2708
 *                i2c-dev
 *           1.3) In /etc/modprobe.d/raspi-blacklist.conf, uncomment possible following lines:
 *                blacklist spi-bcm2708
 *                blacklist i2c-bcm2708
 *           1.4) In /boot/config.txt, add following lines:
 *                dtparam=i2c1=on
 *                dtparam=i2c_arm=on
 *           1.5) Then reboot
 *                sudo reboot
 *           1.6) To test I2C and see the addresses,
 *                sudo i2cdetect -y 1
 *    2) For cross-compilation using Eclipse IDE, make sure to follow the instructions located under readme.txt files
 *       in drivers/oled_drivers:
 *    	    Please note that in order to use OLED SSD1306 with I2C,
 *		    one has to download bcm2835.c, bcm2835.h, and has access to current <linux/i2c-dev.h>.
 *		    In case the compiler complains, please also download the newest i2c-dev.h and put it in drivers/oled_drivers folder.
 *		    Download i2c-dev.h from: https://www.kernel.org/pub/linux/
 *		    Download bcm2835.c and bcm2835.h from: https://github.com/hallard/ArduiPi_SSD1306
 */

#include <tasks/oled_task.h>
#include <tasks/external_gpio_task.h>

#include <wiringPi.h>
#include <ctime>
#include <unistd.h>
#include <libraries/timing/timing.h>
#include <api/basic_psys_rover.h>
#include <interfaces.h>
#include <pthread.h>
#include <roverapp.h>

#include <libraries/pthread_monitoring/collect_thread_name.h>

#include <drivers/oled_drivers/ArduiPi_SSD1306.h>
#include <drivers/oled_drivers/Adafruit_GFX.h>
#include <drivers/oled_drivers/Adafruit_SSD1306.h>

/* APPSTACLE Project logo */
#include "../drivers/oled_drivers/appstacle_logo.c"

#include <libraries/status_library/status_library.h>

Adafruit_SSD1306 display;

/* Config Option */
struct s_opts
{
	int oled;
	int verbose;
} ;

/* default options values */
s_opts opts = {
	OLED_ADAFRUIT_I2C_128x64,		// Default oled
	false							// Not verbose
};

void OLED_Setup (void)
{
	/* I2C change parameters to fit to your LCD */
	if ( !display.init(OLED_I2C_RESET,opts.oled) )
		exit(EXIT_FAILURE);

	display.begin();
	display.clearDisplay();   // clears the screen and buffer
}

/* Proper shutdown function, including showing message in the OLED display */
void shutdownOSwithDisplay(void)
{
	/* Prepare "Shutting Down..." */
	display.clearDisplay();

	display.setTextSize(2);
	display.setTextColor(WHITE);

	display.setCursor(20,10);
	display.print("Shutting");

	display.setTextColor(WHITE);

	display.setCursor(20,32);
	display.print("Down...");

	/* Display everything earlier this time*/
	display.display();

	/* Play the shutdown tone..*/
	playShutdownTone();

	/* Here we're shutting Raspberry Pi down.. */
	shutdownOS();

	/* Abort the application for safety reasons */
	abort();
}

void *OLED_Task (void * arg)
{
	timing oled_task_tmr;
	oled_task_tmr.setTaskID("OLED");
	oled_task_tmr.setDeadline(0.5);
	oled_task_tmr.setPeriod(0.5);

	CollectThreadName("OLED_Task");

	int counter_500ms = 0;

	OLED_Setup();

	while (1)
	{
		oled_task_tmr.recordStartTime();
		oled_task_tmr.calculatePreviousSlackTime();

		//Task content starts here -----------------------------------------------

		if ( shutdown_hook_shared == 0)
		{
			/* Our internal control-timer actions */
			switch (counter_500ms)
			{
				/* If counter hits counter_500ms * 0.5 sec */
				/* Display APPSTACLE logo in between */
				case 0:
				case 5:
				case 10:
				case 15:
				case 20:
					/* Prepare APPSTACLE logo*/
					display.clearDisplay();

					/* Black logo */
					//display.fillRect (0, 0, 128, 64, WHITE);
					//display.drawBitmap (0, 0, appstacle_logo, 128, 64, BLACK);

					/* White logo */
					display.drawBitmap (0, 0, appstacle_logo, 128, 64, WHITE);

					break;

				case 1: /* If counter hits counter_500ms * 0.5 sec */
					/* Prepare WLAN availability */
					display.clearDisplay();

					//display.drawRect(0, 0, display.width(), display.height(), WHITE);
					//display.drawRect(2, 2, display.width()-4, display.height()-4, WHITE);

					display.setTextSize(2);
					display.setTextColor(WHITE);

					display.setCursor(45,10);
					display.print("WLAN:");

					display.setTextSize(3);
					display.setTextColor(WHITE);

					if (retrieveWLANStatus() == 1)
					{
						display.setCursor(50,32);
						display.print("ON");
					}
					else
					{
						display.setCursor(43,32);
						display.print("OFF");
					}

					break;

				case 6: /* If counter hits counter_500ms * 0.5 sec */
					/* Prepare Ethernet availability*/
					display.clearDisplay();

					//display.drawRect(0, 0, display.width(), display.height(), WHITE);
					//display.drawRect(2, 2, display.width()-4, display.height()-4, WHITE);

					display.setTextSize(2);
					display.setTextColor(WHITE);

					display.setCursor(48,10);
					display.print("ETH:");

					display.setTextSize(3);
					display.setTextColor(WHITE);

					if (retrieveETHStatus() == 1)
					{
						display.setCursor(50,32);
						display.print("ON");
					}
					else
					{
						display.setCursor(43,32);
						display.print("OFF");
					}

					break;

				case 11: /* If counter hits counter_500ms * 0.5 sec */
					/* Prepare Internet availability */
					display.clearDisplay();

					//display.drawRect(0, 0, display.width(), display.height(), WHITE);
					//display.drawRect(2, 2, display.width()-4, display.height()-4, WHITE);

					display.setTextSize(2);
					display.setTextColor(WHITE);

					display.setCursor(12,10);
					display.print("INTERNET:");

					display.setTextSize(3);
					display.setTextColor(WHITE);

					if (retrieveINTERNETStatus() == 1)
					{
						display.setCursor(50,32);
						display.print("ON");
					}
					else
					{
						display.setCursor(43,32);
						display.print("OFF");
					}

					break;

				case 16: /* If counter hits counter_500ms * 0.5 sec */
					/* Prepare Bluetooth availability */
					display.clearDisplay();

					//display.drawRect(0, 0, display.width(), display.height(), WHITE);
					//display.drawRect(2, 2, display.width()-4, display.height()-4, WHITE);

					display.setTextSize(2);
					display.setTextColor(WHITE);

					display.setCursor(8,10);
					display.print("BLUETOOTH:");

					display.setTextSize(3);
					display.setTextColor(WHITE);

					if (retrieveBLUETOOTHStatus() == 1)
					{
						display.setCursor(50,32);
						display.print("ON");
					}
					else
					{
						display.setCursor(43,32);
						display.print("OFF");
					}

					break;

				case 21: /* If counter hits counter_500ms * 0.5 sec */
					/* Prepare Hono Instance (Cloud) availability */
					display.clearDisplay();

					//display.drawRect(0, 0, display.width(), display.height(), WHITE);
					//display.drawRect(2, 2, display.width()-4, display.height()-4, WHITE);

					display.setTextSize(2);
					display.setTextColor(WHITE);

					display.setCursor(45,10);
					display.print("HONO:");

					display.setTextSize(3);
					display.setTextColor(WHITE);

					if (retrieveHONOStatus() == 1)
					{
						display.setCursor(50,32);
						display.print("ON");
					}
					else
					{
						display.setCursor(43,32);
						display.print("OFF");
					}

					break;

				default: /* None of the above */
					// Wait
					break;

			} /* switch-end */
		}
		else
		{
			// Proper shutdown function, including showing message in the OLED display
			shutdownOSwithDisplay();
		}

		/* Display the stuff NOW */
		display.display();

		/* Increment the counter */
		counter_500ms += 1;

		/* Since only first 25*0.5 seconds we do something, we can clear the variable */
		if (counter_500ms > 25)
			counter_500ms = 0;

		//Task content ends here -------------------------------------------------

		oled_task_tmr.recordEndTime();
		oled_task_tmr.calculateExecutionTime();
		oled_task_tmr.calculateDeadlineMissPercentage();
		oled_task_tmr.incrementTotalCycles();
		pthread_mutex_lock(&oled_task_ti_l);
			oled_task_ti.deadline = oled_task_tmr.getDeadline();
			oled_task_ti.deadline_miss_percentage = oled_task_tmr.getDeadlineMissPercentage();
			oled_task_ti.execution_time = oled_task_tmr.getExecutionTime();
			oled_task_ti.period = oled_task_tmr.getPeriod();
			oled_task_ti.prev_slack_time = oled_task_tmr.getPrevSlackTime();
			oled_task_ti.task_id = oled_task_tmr.getTaskID();
			oled_task_ti.start_time = oled_task_tmr.getStartTime();
			oled_task_ti.end_time = oled_task_tmr.getEndTime();
		pthread_mutex_unlock(&oled_task_ti_l);
		oled_task_tmr.sleepToMatchPeriod();
	}

	/* the function must return something - NULL will do */
	return NULL;
}