//============================================================================
// Name:
//   mkidemo.cpp
//
// Summary:
//   Extremly simple demo program that shows some values
//   on the mercedes combi instrument. needs libcanio to work.
//
//   Default interface is can0, to change it start the program like this:
//     mkidemo -f=can1
//
// Created on:
//   Okt 1, 2010
//
// Author:
//   Christian Steiger
//============================================================================


// includes
#include "../src/mki.h"

// Function prototypes
const char* const fetchinterface (const int argc, const char* const argv[]);

// Main function
int main(int argc, char *argv[])
{
	int mph =0;
	int temperatur=40;
	int rpm =0;
	// get the interface data from the command line
	const char* const interface = fetchinterface(argc, argv);

	// create mki object
	mki m;

	// connect to interface, stop if we cant connect
	if (m.connect(interface) < 0)
		return -1;

	//m.getInterface()->disableLoopBack();

	// set informations we want to display
	//m.setLamps(MKI_WARN | MKI_FUEL_LOW | MKI_WARN_BLINK | MKI_ABS);

	//m.setDisplay(MKI_LIMIT | MKI_PERMANENT | MKI_MPH_BLINK );
	m.setDisplay(MKI_LIMIT | MKI_PERMANENT );
	// m.setAlert( MKI_TIRE_PRESSURE );

	// send the data in an endless loop
	// every 50ms or so should be enough,
	// use pthreads if you want it out of the way
	while (1) {
		mph++;
		temperatur++;
		rpm = rpm + 100;

		m.setMph(mph);
		m.setDisplayMph(mph);
		m.setRpm(rpm);
		m.setCWTemp(temperatur);

		m.sendData();
		usleep(100000);
		
		if(temperatur >= 130)
			temperatur = 40;
			
		if(mph > 160  )
			mph=0;
		
		if(rpm>6000)
			m.setLamps( MKI_WARN_BLINK );
			
		if(rpm > 7000)
		{
			rpm = 0;
			m.setLampsOff();
		}
		
	}

	// everything ok
	return 0;
}

// quick and dirty hack with code from PeakCanLogger
// to allow the interface to be set via commandline.
const char* const fetchinterface (const int argc, const char* const argv[])
{
	int i, len;
	char* interface = new char(5);
	strcpy( interface, "can0" );

	// go through the argument, ignore the first one
	for( i = 1; i < argc; i++ )
	{
		// check the arguments first and third char, is it a config parameter?
		if ( argv[i][0] == '-' )
		{
			// check which config parameter it is
			switch( argv[i][1] )
			{
				// set can-device
			case 'd':
			case 'f':
				// delete the actual char string
				delete interface;

				// get the lenght of the new string
				len = strlen(&argv[i][3]);

				// create a new one
				interface = new char( len );

				// set string with zeros
				memset( interface, 0, len );

				// and copy it
				strcpy( interface, &argv[i][3] );

				default:
					break;
			}
		}
	}

	return interface;
}