/*
 *  main.c
 *
 *  Created by Setsu on April 3, 2011.
 *  Copyright 2011 RoundSquare Inc. All rights reserved.
 *
 * Permission is hereby granted, free of charge, to any person or organization
 * obtaining a copy of the software and accompanying documentation covered by
 * this license (the "Software") to use, reproduce, display, distribute,
 * execute, and transmit the Software, and to prepare derivative works of the
 * Software, and to permit third-parties to whom the Software is furnished to
 * do so, all subject to the following:
 * 
 * The copyright notices in the Software and this entire statement, including
 * the above license grant, this restriction and the following disclaimer,
 * must be included in all copies of the Software, in whole or in part, and
 * all derivative works of the Software, unless such copies or derivative
 * works are solely in the form of machine-executable object code generated by
 * a source language processor.
 * 
 * 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, TITLE AND NON-INFRINGEMENT. IN NO EVENT
 * SHALL THE COPYRIGHT HOLDERS OR ANYONE DISTRIBUTING THE SOFTWARE BE LIABLE
 * FOR ANY DAMAGES OR OTHER LIABILITY, WHETHER IN CONTRACT, TORT OR OTHERWISE,
 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
 * DEALINGS IN THE SOFTWARE.
 */

/*
 *----------------------------------------
 *	include
 *----------------------------------------
 */
#include <fcntl.h>
#include <unistd.h>
#include <stdio.h>
#include <stdlib.h>
#include <signal.h>

/*
 *----------------------------------------
 *	define
 *----------------------------------------
 */
#define	GPIO_NUM_BOARD_ID2	(171)
#define	GPIO_NUM_BOARD_ID1	(101)
#define	GPIO_NUM_BOARD_ID0	(182)

/*
 *----------------------------------------
 *	global
 *----------------------------------------
 */
static volatile sig_atomic_t exit_flag = 0;

/*
 *----------------------------------------
 *	ReadGPIO
 *----------------------------------------
 */
int ReadGPIO(int gpioNum)
{
	const char* fmt = "/sys/class/gpio/gpio%d/value";
	char str[64];
	char buf;
	int num_read;
	int rtn = -1;
	int fd;

	sprintf(str, fmt, gpioNum);
	fd = open(str, O_RDONLY);
	if(fd)
	{
		num_read = read(fd, &buf, sizeof(char));
		rtn = (num_read != 1) ? num_read:(buf-'0');
		close(fd);
	}
	return rtn;
}

/*
 *----------------------------------------
 *	ReadBoardRevision
 *----------------------------------------
 */
int ReadBoardRevision(void)
{
	int boardRev = 0;
	const int gpio_num_tbl[] = {	GPIO_NUM_BOARD_ID2
								,	GPIO_NUM_BOARD_ID1
								,	GPIO_NUM_BOARD_ID0	};
	size_t i;

	for(i=0; i<sizeof(gpio_num_tbl)/sizeof(gpio_num_tbl[0]); ++i)
	{
		boardRev *= 2;
		boardRev += ReadGPIO(gpio_num_tbl[i]);
	}
	return boardRev;
}

/*
 *----------------------------------------
 *	PrintBoardRevision
 *----------------------------------------
 */
int PrintBoardRevision(void)
{
	int rtn = 0;
	const char* board_rev_tbl[] = {	"(obsolete)"
								,	"EA1"
								,	"(reserved)"
								,	"A1"
								,	"(reserved)"	};
	size_t board_rev_tbl_size = sizeof(board_rev_tbl)/sizeof(board_rev_tbl[0]);

	int boardRev = ReadBoardRevision();
	if(board_rev_tbl_size <= boardRev)
	{
		boardRev = board_rev_tbl_size - 1;
		rtn = -1;
	}
	printf(" - Pandaboard Revision: %s\n", board_rev_tbl[boardRev]);
	return rtn;
}

/*
 *----------------------------------------
 *	PrintRegulatorItem
 *----------------------------------------
 */
int PrintRegulatorItem(int index, const char* name)
{
	const char* fmt = "/sys/class/regulator/regulator.%d/%s";
	char str[64];
	char buf[16];
	int num_read;
	int fd;

	if(7 < index)	return -1;

	sprintf(str, fmt, index, name);
	fd = open(str, O_RDONLY);
	if(fd)
	{
		num_read = read(fd, buf, sizeof(buf));
		buf[num_read] = 0;
		printf("     %s: %s", name, buf);
		close(fd);
	}
	return 0;
}

/*
 *----------------------------------------
 *	PrintRegulator
 *----------------------------------------
 */
int PrintRegulator(void)
{
	int i;

	printf(" - Pandaboard Regulator\n");
	for(i=0; i<8; ++i)
	{
		printf("    #%d:\n", i);
		PrintRegulatorItem(i, "name");
		PrintRegulatorItem(i, "microvolts");
	}
	return 0;
}

/*
 *----------------------------------------
 *	CopyLED1to2
 *----------------------------------------
 */
int CopyLED1to2(void)
{
	const char* str_src = "/sys/class/leds/pandaboard::status1/brightness";
	const char* str_dst = "/sys/class/leds/pandaboard::status2/brightness";
	char buf[16];
	int num_read, num_write;
	int fd_src, fd_dst;

	fd_src = open(str_src, O_RDONLY);
	fd_dst = open(str_dst, O_WRONLY);

	if(fd_src && fd_dst)
	{
		num_read = read(fd_src, buf, sizeof(buf));
		buf[num_read] = 0;
		num_write = write(fd_dst, buf, num_read);
	}
	if(fd_dst)	close(fd_dst);
	if(fd_src)	close(fd_src);
	return 0;
}

/*
 *----------------------------------------
 *	CleanupLED2
 *----------------------------------------
 */
int CleanupLED2(void)
{
	const char* str_dst = "/sys/class/leds/pandaboard::status2/brightness";
	const char* buf = "0";
	int fd_dst;
	int num_write;

	fd_dst = open(str_dst, O_WRONLY);
	if(fd_dst)
	{
		num_write = write(fd_dst, buf, 1);
		close(fd_dst);
	}
	return 0;
}

/*
 *----------------------------------------
 *	CopyLED
 *----------------------------------------
 */
int CopyLED(void)
{
	printf(" - Copy Status LED1 to LED2 (press ctrl-c to exit)\n");
	system("sudo chmod 666 /sys/class/leds/pandaboard::status2/brightness");
	while(!exit_flag)
	{
		CopyLED1to2();
		usleep(30*1000);
	}
	CleanupLED2();
	system("sudo chmod 644 /sys/class/leds/pandaboard::status2/brightness");
	printf("\n");
	return 0;
}

/*
 *----------------------------------------
 *	SigHandler
 *----------------------------------------
 */
void SigHandler(int sigNum)
{
	exit_flag = 1;
}

/*
 *----------------------------------------
 *	main
 *----------------------------------------
 */
int main(int argc, char* argv[])
{
	signal(SIGINT, SigHandler);

	PrintBoardRevision();
	PrintRegulator();
	CopyLED();

	return 0;
}