gc_n64_usb-v3/config.c

/*	gc_n64_usb : Gamecube or N64 controller to USB adapter firmware
	Copyright (C) 2007-2016  Raphael Assenat <raph@raphnet.net>

	This program is free software: you can redistribute it and/or modify
	it under the terms of the GNU General Public License as published by
	the Free Software Foundation, either version 3 of the License, or
	(at your option) any later version.

	This program is distributed in the hope that it will be useful,
	but WITHOUT ANY WARRANTY; without even the implied warranty of
	MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
	GNU General Public License for more details.

	You should have received a copy of the GNU General Public License
	along with this program.  If not, see <http://www.gnu.org/licenses/>.
*/
#include <string.h>
#include "eeprom.h"
#include "requests.h"

struct eeprom_data_struct g_eeprom_data;

/* Called by the eeprom driver if the content
 * was invalid and it needs to write defaults
 * values.  */
void eeprom_app_write_defaults(void)
{
	int i;
	const char default_serial[SERIAL_NUM_LEN] = { '0','0','0','0','0','1' };

	memcpy(g_eeprom_data.cfg.serial, default_serial, SERIAL_NUM_LEN);
	g_eeprom_data.cfg.mode = CFG_MODE_STANDARD;

	for (i=0; i<NUM_CHANNELS; i++) {
		g_eeprom_data.cfg.poll_interval[i] = 5; // 5ms default
	}
}

static void config_set_serial(char serial[SERIAL_NUM_LEN])
{
	memcpy(g_eeprom_data.cfg.serial, serial, SERIAL_NUM_LEN);
	eeprom_commit();
}

struct paramAndFlag {
	uint8_t param; // CFG_PARAM_* (requests.h)
	uint32_t flag; // FLAG_* (config.h)
};

static struct paramAndFlag paramsAndFlags[] = {
	{ CFG_PARAM_INVERT_TRIG, FLAG_GC_INVERT_TRIGS },
	{ CFG_PARAM_FULL_SLIDERS, FLAG_GC_FULL_SLIDERS },
	{ CFG_PARAM_TRIGGERS_AS_BUTTONS, FLAG_GC_SLIDERS_AS_BUTTONS },
	{ CFG_PARAM_DISABLE_ANALOG_TRIGGERS, FLAG_DISABLE_ANALOG_TRIGGERS },

	{  },
};

uint8_t config_getSupportedParams(uint8_t *dst)
{
	uint8_t n = 0, i;

	dst[n++] = CFG_PARAM_MODE;
	dst[n++] = CFG_PARAM_SERIAL;
	for (i=0; i<NUM_CHANNELS; i++) {
		dst[n++] = CFG_PARAM_POLL_INTERVAL0 + i;
	}
	for (i=0; paramsAndFlags[i].flag; i++) {
		dst[n++] = paramsAndFlags[i].param;
	}

	return n;
}

unsigned char config_getParam(unsigned char param, unsigned char *value, unsigned char max_len)
{
	int i;

	switch (param)
	{
		case CFG_PARAM_MODE:
			*value = g_eeprom_data.cfg.mode;
			return 1;
		case CFG_PARAM_SERIAL:
			memcpy(value, g_eeprom_data.cfg.serial, SERIAL_NUM_LEN);
			return SERIAL_NUM_LEN;
		case CFG_PARAM_POLL_INTERVAL0:
			*value = g_eeprom_data.cfg.poll_interval[0];
			return 1;
#if NUM_CHANNELS > 1
		case CFG_PARAM_POLL_INTERVAL1:
			*value = g_eeprom_data.cfg.poll_interval[1];
			return 1;
#endif
#if NUM_CHANNELS > 2
		case CFG_PARAM_POLL_INTERVAL2:
			*value = g_eeprom_data.cfg.poll_interval[2];
			return 1;
#endif
#if NUM_CHANNELS > 3
		case CFG_PARAM_POLL_INTERVAL3:
			*value = g_eeprom_data.cfg.poll_interval[3];
			return 1;
#endif

		default:
			for (i=0; paramsAndFlags[i].flag; i++) {
				if (param == paramsAndFlags[i].param) {
					*value = (g_eeprom_data.cfg.flags & paramsAndFlags[i].flag) ? 1 : 0;
					return 1;
				}
			}
	}

	return 0;
}

unsigned char config_setParam(unsigned char param, const unsigned char *value)
{
	int i;

	if (!value)
		return 0;

	switch (param)
	{
		case CFG_PARAM_MODE:
			g_eeprom_data.cfg.mode = value[0];
			break;
		case CFG_PARAM_SERIAL:
			config_set_serial((char*)value);
			break;
		case CFG_PARAM_POLL_INTERVAL0:
			g_eeprom_data.cfg.poll_interval[0] = value[0];
			break;
#if NUM_CHANNELS > 1
		case CFG_PARAM_POLL_INTERVAL1:
			g_eeprom_data.cfg.poll_interval[1] = value[0];
			break;
#endif
#if NUM_CHANNELS > 2
		case CFG_PARAM_POLL_INTERVAL2:
			g_eeprom_data.cfg.poll_interval[2] = value[0];
			break;
#endif
#if NUM_CHANNELS > 3
		case CFG_PARAM_POLL_INTERVAL3:
			g_eeprom_data.cfg.poll_interval[3] = value[0];
			break;
#endif

		default:
			for (i=0; paramsAndFlags[i].flag; i++) {
				if (param == paramsAndFlags[i].param) {
					if (value[0]) {
						g_eeprom_data.cfg.flags |= paramsAndFlags[i].flag;
					} else {
						g_eeprom_data.cfg.flags &= ~paramsAndFlags[i].flag;
					}
					break;
				}
			}

			// if we made it through the list without finding
			// a matching parameter, do nothing.
			if (!paramsAndFlags[i].flag) {
				return 0;
			}
	}

	eeprom_commit();

	return 1;
}