#include "libmftypes.h"
#include "libmfradio.h"

#define RADIO 5051

#include "radiodefs.h"

__reentrantb uint8_t radio_reset(void) __reentrant
{
	uint8_t i;
	// Initialize Interface
	DIRR = 0x15;
	PORTR = 0xEB;
#if DEEPSLEEP
	RADIOMUX = 0x07;
#else
	RADIOMUX = 0x47;
#endif
	RADIOACC = RACC;
	GPIOENABLE = 1;
#if defined SDCC
	RADIOFDATAADDR = FDATA;
	RADIOFSTATADDR = FSTAT;
#else
	RADIOFDATAADDR0 = (FDATA) & 0xFF;
	RADIOFDATAADDR1 = (FDATA) >> 8;
	RADIOFSTATADDR0 = (FSTAT) & 0xFF;
	RADIOFSTATADDR1 = (FSTAT) >> 8;
#endif
#if DEEPSLEEP
	// Ensure Device is not in Deep Sleep
	radio_wakeup_deepsleep_core();
#endif
	// Reset Device
	RADIO_PWRMODE = 0x80;
	RADIO_PWRMODE = PWRMODE_PWRDOWN;
	// Wait some time for regulator startup
#if defined(VREGDELAY) && VREGDELAY > 0
	delay(VREGDELAY);
#endif
	// Check Scratch
	i = RADIO_SILICONREVISION;
	i = RADIO_SILICONREVISION;
#ifdef SILICONREV2
	if (i != SILICONREV1 && i != SILICONREV2)
		return RADIO_ERR_REVISION;
#else
	if (i != SILICONREV1)
		return RADIO_ERR_REVISION;
#endif
	RADIO_SCRATCH = 0x55;
	if (RADIO_SCRATCH != 0x55)
		return RADIO_ERR_COMM;
	RADIO_SCRATCH = 0xAA;
	if (RADIO_SCRATCH != 0xAA)
		return RADIO_ERR_COMM;
	// Initialize Radio Interface Registers
	AX5051_IFMODE = 0x00;
	AX5051_PLLVCOI = 0x01;
	AX5051_RXMISC = 0x35;
	if (radio_probeirq())
		return RADIO_ERR_IRQ;
	return RADIO_OK;
}


__reentrantb uint8_t ax5051_probeirq(void) __reentrant
{
	uint8_t p = 0x60;
	uint8_t pc1 = AX5051_PINCFG1 & 0x0F;
	uint8_t iesave = IE;
	IE_4 = 0;
	PORTR = 0xEB;
	AX5051_PINCFG1 = 0xD0 | pc1;
	AX5051_PINCFG2 = 0xF2; /* IRQ Line 1 */
	p &= PINR;
	AX5051_PINCFG2 = 0xF0; /* IRQ Line 0 */
	p &= (uint8_t)~PINR;
	AX5051_PINCFG2 = 0xD0;
	switch (p) {
	case 0x20: /* IRQ on PR5 */
		RADIOMUX &= (uint8_t)~0x08;
		break;

	case 0x40: /* IRQ on PR6 */
		RADIOMUX |= 0x08;
		break;

	default:
		/* Error */
		AX5051_PINCFG1 = 0xA0 | pc1; /* Disable IRQ line */
		IE = iesave;
		return 1;
	}
	PORTR &= (uint8_t)~p; /* disable pullup */
	/*
	 * Check voltage on test mode pins and drive them
	 * to the correct level. This is somewhat dangerous - we
	 * may momentarily short circuit the output driver (4mA)
	 * no short circuit will happen if the board complies
	 * to AX5051/AX5151/AX8052F151 programming manual
	 */
	EA = 0;
	/* check T2 */
	AX5051_PINCFG1 = 0xC0 | pc1;
	AX5051_PINCFG2 |= AX5051_PINCFG3 & 0x01;
	/* check T1 */
	AX5051_PINCFG1 = 0x80 | pc1;
	AX5051_PINCFG2 |= AX5051_PINCFG3 & 0x04;
	/* check TST3 */
	AX5051_PINCFG1 = pc1;
	AX5051_PINCFG2 |= AX5051_PINCFG3 & 0x08;
	IE |= p;
	/* check whether TST3 is connected to PR5 - if so disable pullup */
	PORTR &= PINR | (uint8_t)~0x20;
	IE = iesave;
	return 0;
}