forked from PAWPAW-Mirror/lib_xua
Reboot command tidyup
This commit is contained in:
@@ -1,43 +1,31 @@
|
||||
#include <xs1.h>
|
||||
#include <print.h>
|
||||
#define GLXID 0x0001
|
||||
#define XS1_GLX_PERIPH_USB_ID 0x1
|
||||
#define XS1_GLX_CFG_RST_MISC_ADRS 0x50
|
||||
#define XS1_UIFM_PHY_CONTROL_REG 0x3c
|
||||
#define XS1_UIFM_PHY_CONTROL_FORCERESET 0x0
|
||||
#define XS1_GLX_CFG_USB_CLK_EN_BASE 0x3
|
||||
#define XS1_GLX_CFG_USB_EN_BASE 0x2
|
||||
#define XS1_GLX_PERIPH_SCTH_ID 0x3
|
||||
#include <platform.h>
|
||||
#include <xs1_su.h>
|
||||
|
||||
|
||||
#define XS1_UIFM_FUNC_CONTROL_REG 0xc
|
||||
#define XS1_UIFM_FUNC_CONTROL_XCVRSELECT 0x0
|
||||
#define XS1_UIFM_FUNC_CONTROL_TERMSELECT 0x1
|
||||
int write_sswitch_reg_blind(unsigned coreid, unsigned reg, unsigned data);
|
||||
void write_sswitch_reg_verify(unsigned coreid, unsigned reg, unsigned data, unsigned failval);
|
||||
int write_glx_periph_word(unsigned destId, unsigned periphAddress, unsigned destRegAddr, unsigned data);
|
||||
int write_glx_periph_reg(unsigned dest_id, unsigned periph_addr, unsigned dest_reg_addr, unsigned bad_packet, unsigned data_size, char buf[]);
|
||||
void read_sswitch_reg_verify(unsigned coreid, unsigned reg, unsigned &data, unsigned failval);
|
||||
#define XS1_SU_PERIPH_USB_ID 0x1
|
||||
|
||||
/* Reboots XMOS device by writing to the PLL config register */
|
||||
void device_reboot_implementation(chanend spare)
|
||||
{
|
||||
#ifdef ARCH_S
|
||||
/* Disconnect from bus */
|
||||
write_glx_periph_word(GLXID, XS1_GLX_PERIPH_USB_ID, XS1_UIFM_FUNC_CONTROL_REG, 4);
|
||||
unsigned data[] = {4};
|
||||
write_periph_32(xs1_su, XS1_SU_PERIPH_USB_ID, XS1_SU_PER_UIFM_FUNC_CONTROL_NUM, 1, data);
|
||||
#endif
|
||||
|
||||
outct(spare, XS1_CT_END); // have to do this before freeing the chanend
|
||||
inct(spare); // Receive end ct from usb_buffer to close down in both directions
|
||||
outct(spare, XS1_CT_END); // have to do this before freeing the chanend
|
||||
inct(spare); // Receive end ct from usb_buffer to close down in both directions
|
||||
|
||||
// Need a spare chanend so we can talk to the pll register
|
||||
asm("freer res[%0]"::"r"(spare));
|
||||
|
||||
{
|
||||
unsigned int pllVal;
|
||||
unsigned int core_id = get_core_id();
|
||||
read_sswitch_reg(core_id, 6, pllVal);
|
||||
write_sswitch_reg_blind(core_id^0x8000, 6, pllVal);
|
||||
write_sswitch_reg_blind(core_id, 6, pllVal);
|
||||
}
|
||||
unsigned int tile_id = get_local_tile_id();
|
||||
read_sswitch_reg(tile_id, 6, pllVal);
|
||||
|
||||
|
||||
/* Not this accounts for 2 tiles of an L2.. */
|
||||
write_sswitch_reg_no_ack(tile_id^0x8000, 6, pllVal);
|
||||
write_sswitch_reg_no_ack(tile_id, 6, pllVal);
|
||||
}
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user