mirror of
https://github.com/logicog/RTLPlayground.git
synced 2026-08-30 14:52:51 +08:00
bloqaudio
1a743b3889
Measured against the generic leds_setup() output on the board: eight of the 21 stock values are identical to what leds_setup() computes from the machine's led_mux table, and eight more revert to the generic values with no change in LED behaviour in any tested link state (copper 2.5G, SFP 2.5G, SFP 10G). Keep the five with a measurable effect: 6528 selects blue over green at 10G, 6540/6548 carry the SFP and copper LED set behaviour, 65dc enables the LED outputs, and PIN_MUX_0 routes the blue pin. Verified from a clean boot on a SWTG018AS-V2.1.0 board: copper solid green with activity blink at 2.5G on two ports, SFP green at 2.5G, SFP blue at 10G, LEDs off on link down.
121 lines
3.3 KiB
C
121 lines
3.3 KiB
C
/*
|
|
* Per-machine one-shot boot hooks, hosted in BANK2 so board-specific
|
|
* tables and code do not consume the common bank.
|
|
*/
|
|
#include <stdint.h>
|
|
#include "machine.h"
|
|
#include "rtl837x_pins.h"
|
|
#include "rtl837x_leds.h"
|
|
#include "rtl837x_sfr.h"
|
|
#include "rtl837x_regs.h"
|
|
#include "rtl837x_common.h"
|
|
|
|
#pragma codeseg BANK2
|
|
#pragma constseg BANK2
|
|
|
|
#if defined MACHINE_KP_9000_6XH_X2
|
|
void machine_custom_init(void) __banked
|
|
{
|
|
reg_bit_set(RTL837X_REG_LED_GLB_IO_EN, 6);
|
|
}
|
|
|
|
#elif defined MACHINE_PCB_SWTG018AS_V2_1_0
|
|
// Stock-firmware values for what the LED-set encoding cannot express: the
|
|
// bi-color SFP LED (blue pin at 10G) and the PIN_MUX_0 routing of that pin
|
|
// to the LED controller. Runs after leds_setup(), which covers the rest.
|
|
static __code const struct { uint16_t reg; uint32_t val; } custom_init_regs[] = {
|
|
{ RTL837X_REG_LED3_0_SET1, 0x00100000UL },
|
|
{ RTL837X_REG_LED1_0_SET1, 0x01400155UL },
|
|
{ RTL837X_REG_LED1_0_SET0, 0x01740141UL },
|
|
{ RTL837X_REG_LED_GLB_IO_EN, 0x7f24977fUL },
|
|
{ RTL837X_PIN_MUX_0, 0x20db6880UL },
|
|
};
|
|
|
|
void machine_custom_init(void) __banked
|
|
{
|
|
uint8_t i;
|
|
// REG_SET is a multi-statement macro without a do-while wrapper: braces required
|
|
for (i = 0; i < sizeof(custom_init_regs) / sizeof(custom_init_regs[0]); i++) {
|
|
REG_SET(custom_init_regs[i].reg, custom_init_regs[i].val);
|
|
}
|
|
}
|
|
|
|
#elif defined(MACHINE_PCB_K0402WS_V3) || defined(MACHINE_HI_K0402WS)
|
|
void machine_custom_init(void) __banked
|
|
{
|
|
reg_bit_set(RTL837X_REG_LED_GLB_IO_EN, 6);
|
|
}
|
|
|
|
#elif defined MACHINE_FNS1200P
|
|
void machine_custom_init(void) __banked
|
|
{
|
|
reg_bit_set(RTL837X_REG_LED_GLB_IO_EN, 6);
|
|
}
|
|
|
|
#elif defined MACHINE_PCB_SWTG024AS_A_2_0_1
|
|
void machine_custom_init(void) __banked
|
|
{
|
|
reg_bit_set(RTL837X_REG_LED_GLB_IO_EN, 6);
|
|
reg_bit_set(RTL837X_REG_LED_MODE, 17);
|
|
reg_bit_clear(RTL837X_REG_LED_MODE, 9);
|
|
reg_bit_clear(RTL837X_REG_LED_MODE, 7);
|
|
}
|
|
|
|
#elif defined MACHINE_SWTG024AS_A_2_0_1_5C_1SFP
|
|
void machine_custom_init(void) __banked
|
|
{
|
|
uint16_t pval;
|
|
|
|
reg_bit_set(RTL837X_REG_LED_GLB_IO_EN, 6);
|
|
reg_bit_set(RTL837X_REG_LED_MODE, 17);
|
|
reg_bit_clear(RTL837X_REG_LED_MODE, 9);
|
|
reg_bit_clear(RTL837X_REG_LED_MODE, 7);
|
|
|
|
// OEM firmware sets these companion SDS0 polarity bits for the RTL8221B.
|
|
sds_read(0, 0, 0);
|
|
pval = SFR_DATA_U16;
|
|
sds_write_v(0, 0, 0, pval | 0x100);
|
|
|
|
sds_read(0, 6, 2);
|
|
pval = SFR_DATA_U16;
|
|
sds_write_v(0, 6, 2, pval | 0x4000);
|
|
}
|
|
|
|
#elif defined MACHINE_SWTG024AS_V2_0
|
|
void machine_custom_init(void) __banked
|
|
{
|
|
uint16_t pval;
|
|
|
|
reg_bit_set(RTL837X_REG_LED_GLB_IO_EN, 6);
|
|
reg_bit_set(RTL837X_REG_LED_MODE, 17);
|
|
reg_bit_clear(RTL837X_REG_LED_MODE, 9);
|
|
reg_bit_clear(RTL837X_REG_LED_MODE, 7);
|
|
|
|
// OEM firmware sets these companion SDS0 polarity bits for the RTL8221B.
|
|
sds_read(0, 0, 0);
|
|
pval = SFR_DATA_U16;
|
|
sds_write_v(0, 0, 0, pval | 0x100);
|
|
|
|
sds_read(0, 6, 2);
|
|
pval = SFR_DATA_U16;
|
|
sds_write_v(0, 6, 2, pval | 0x4000);
|
|
}
|
|
|
|
#elif defined MACHINE_ZX310S_4T2XT
|
|
void machine_custom_init(void) __banked
|
|
{
|
|
// For this device, the reset value of RTL837X_PIN_MUX_0 is 0x30000000,
|
|
// which would disables all LEDS, enable them manually:
|
|
REG_SET(RTL837X_PIN_MUX_0, 0x30db68bf);
|
|
}
|
|
|
|
#elif defined MACHINE_FG_4GT_2SX_V2_0
|
|
void machine_custom_init(void) __banked
|
|
{
|
|
REG_SET(RTL837X_REG_LED_GLB_IO_EN, 0x7624155b);
|
|
}
|
|
|
|
#else
|
|
void machine_custom_init(void) __banked { }
|
|
#endif
|