#include <swilib2.h>
#include <cfg_items.h>

char successed_config_filename[128];

//__attribute__((section("CONFIG_C")))
int LoadConfigData(const char *fname, CFG_HDR *cfghdr0, int * __config_begin, int * __config_end, char *scf)
{
	int f;
	unsigned int ul;
	char *buf;
	int result = 0;
	void *cfg;
	
	//extern const int __config_end, __config_begin;
	cfg = (void*)cfghdr0;
	volatile unsigned int _segb = (volatile unsigned int)__config_begin;
	volatile unsigned int _sege = (volatile unsigned int)__config_end;
	
	unsigned int len = (_sege - _segb) - 4;
	if (!(buf = malloc(len))) return -1;
	if ((f = _open(fname, A_ReadOnly + A_BIN, 0, &ul)) != -1)
	{
		if (_read(f, buf, len, &ul) == (int)len)
		{
			memcpy(cfg, buf, len);
			_close(f,&ul);
		}
		else
		{
			_close(f, &ul);
			goto L_SAVENEWCFG;
		}
	}
	else
	{
		L_SAVENEWCFG:
			if ((f = _open(fname, A_ReadWrite + A_Create + A_Truncate, P_READ + P_WRITE, &ul)) != -1)
			{
				if (_write(f, cfg, len, &ul) != (int)len) result =- 1;
				_close(f, &ul);
			}
			else
				result =- 1;
	}
	mfree(buf);
	if (result >= 0) strcpy(scf, fname);
	return result;
}

void InitConfig(void)
{
	__CONFIG_EXTERN(0, cfghdr0);
	if (LoadConfigData("0:\\Zbin\\Etc\\TurnOffD.bcfg", __CONFIG(0, cfghdr0), successed_config_filename) == -1)
		LoadConfigData("4:\\Zbin\\Etc\\TurnOffD.bcfg", __CONFIG(0, cfghdr0), successed_config_filename);
}