You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
CubeSatSim/libs/libmf/builtsource/ax5051reset.c

120 lines
2.6 KiB

#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;
}

Powered by TurnKey Linux.