On Tue, 15 Jul 2025, Binbin Zhou wrote: > Since the display is a sub-function of the Loongson-2K BMC, when the > BMC reset, the entire BMC PCIe is disconnected, including the display > which is interrupted. > > Quick overview of the entire LS2K BMC reset process: > > There are two types of reset methods: soft reset (BMC-initiated reboot > of IPMI reset command) and BMC watchdog reset (watchdog timeout). > > First, regardless of the method, an interrupt is generated (PCIe interrupt > for soft reset/GPIO interrupt for watchdog reset); > > Second, during the interrupt process, the system enters bmc_reset_work, > clears the bus/IO/mem resources of the LS7A PCI-E bridge, waits for the BMC > reset to begin, then restores the parent device's PCI configuration space, > waits for the BMC reset to complete, and finally restores the BMC PCI > configuration space. > > Display restoration occurs last. > > Co-developed-by: Chong Qiao <qiaoch...@loongson.cn> > Signed-off-by: Chong Qiao <qiaoch...@loongson.cn> > Reviewed-by: Huacai Chen <chenhua...@loongson.cn> > Acked-by: Corey Minyard <co...@minyard.net> > Signed-off-by: Binbin Zhou <zhoubin...@loongson.cn> > --- > drivers/mfd/ls2k-bmc-core.c | 328 ++++++++++++++++++++++++++++++++++++ > 1 file changed, 328 insertions(+)
Looking good now - just a couple of nits. I suggest that this will be applied once the merge-window closes, so no rush. > diff --git a/drivers/mfd/ls2k-bmc-core.c b/drivers/mfd/ls2k-bmc-core.c > index 39cc481d9ba1..bc96e42622d1 100644 > --- a/drivers/mfd/ls2k-bmc-core.c > +++ b/drivers/mfd/ls2k-bmc-core.c > @@ -10,8 +10,12 @@ > */ > > #include <linux/aperture.h> > +#include <linux/bitfield.h> > +#include <linux/delay.h> > #include <linux/errno.h> > #include <linux/init.h> > +#include <linux/iopoll.h> > +#include <linux/kbd_kern.h> > #include <linux/kernel.h> > #include <linux/mfd/core.h> > #include <linux/module.h> > @@ -19,6 +23,8 @@ > #include <linux/pci_ids.h> > #include <linux/platform_data/simplefb.h> > #include <linux/platform_device.h> > +#include <linux/stop_machine.h> > +#include <linux/vt_kern.h> > > /* LS2K BMC resources */ > #define LS2K_DISPLAY_RES_START (SZ_16M + SZ_2M) > @@ -29,6 +35,48 @@ > #define LS2K_IPMI3_RES_START (LS2K_IPMI2_RES_START + > LS2K_IPMI_RES_SIZE) > #define LS2K_IPMI4_RES_START (LS2K_IPMI3_RES_START + > LS2K_IPMI_RES_SIZE) > > +#define LS7A_PCI_CFG_SIZE 0x100 > + > +/* LS7A bridge registers */ > +#define LS7A_PCIE_PORT_CTL0 0x0 > +#define LS7A_PCIE_PORT_STS1 0xC > +#define LS7A_GEN2_CTL 0x80C > +#define LS7A_SYMBOL_TIMER 0x71C > + > +/* Bits of LS7A_PCIE_PORT_CTL0 */ > +#define LS2K_BMC_PCIE_LTSSM_ENABLE BIT(3) > + > +/* Bits of LS7A_PCIE_PORT_STS1 */ > +#define LS2K_BMC_PCIE_LTSSM_STS GENMASK(5, 0) > +#define LS2K_BMC_PCIE_CONNECTED 0x11 > + > +#define LS2K_BMC_PCIE_DELAY_US 1000 > +#define LS2K_BMC_PCIE_TIMEOUT_US 1000000 > + > +/* Bits of LS7A_GEN2_CTL */ > +#define LS7A_GEN2_SPEED_CHANG BIT(17) > +#define LS7A_CONF_PHY_TX BIT(18) > + > +/* Bits of LS7A_SYMBOL_TIMER */ > +#define LS7A_MASK_LEN_MATCH BIT(26) > + > +/* Interval between interruptions */ > +#define LS2K_BMC_INT_INTERVAL (60 * HZ) > + > +/* Maximum time to wait for U-Boot and DDR to be ready with ms. */ > +#define LS2K_BMC_RESET_WAIT_TIME 10000 > + > +/* It's an experience value */ > +#define LS7A_BAR0_CHECK_MAX_TIMES 2000 > + > +#define LS2K_BMC_RESET_GPIO 14 > +#define LOONGSON_GPIO_REG_BASE 0x1FE00500 > +#define LOONGSON_GPIO_REG_SIZE 0x18 > +#define LOONGSON_GPIO_OEN 0x0 > +#define LOONGSON_GPIO_FUNC 0x4 > +#define LOONGSON_GPIO_INTPOL 0x10 > +#define LOONGSON_GPIO_INTEN 0x14 > + > enum { > LS2K_BMC_DISPLAY, > LS2K_BMC_IPMI0, > @@ -95,6 +143,273 @@ static struct mfd_cell ls2k_bmc_cells[] = { > }, > }; > > +/* Index of the BMC PCI configuration space to be restored at BMC reset. */ > +struct ls2k_bmc_pci_data { > + u32 pci_command; > + u32 base_address0; > + u32 interrupt_line; > +}; > + > +/* Index of the parent PCI configuration space to be restored at BMC reset. > */ > +struct ls2k_bmc_bridge_pci_data { > + u32 pci_command; > + u32 base_address[6]; > + u32 rom_addreess; > + u32 interrupt_line; > + u32 msi_hi; > + u32 msi_lo; > + u32 devctl; > + u32 linkcap; > + u32 linkctl_sts; > + u32 symbol_timer; > + u32 gen2_ctrl; > +}; > + > +struct ls2k_bmc_pdata { > + struct device *dev; > + struct work_struct bmc_reset_work; > + struct ls2k_bmc_pci_data bmc_pci_data; > + struct ls2k_bmc_bridge_pci_data bridge_pci_data; > +}; > + > +static bool ls2k_bmc_bar0_addr_is_set(struct pci_dev *pdev) > +{ > + u32 addr; > + > + pci_read_config_dword(pdev, PCI_BASE_ADDRESS_0, &addr); > + > + return addr & PCI_BASE_ADDRESS_MEM_MASK ? true : false; > +} > + > +static bool ls2k_bmc_pcie_is_connected(struct pci_dev *parent, struct > ls2k_bmc_pdata *ddata) > +{ > + void __iomem *base; > + int sts, ret; > + > + base = pci_iomap(parent, 0, LS7A_PCI_CFG_SIZE); > + if (!base) > + return false; > + > + writel(readl(base + LS7A_PCIE_PORT_CTL0) | LS2K_BMC_PCIE_LTSSM_ENABLE, > + base + LS7A_PCIE_PORT_CTL0); Not keen on this - please separate the read from the write. > + ret = readl_poll_timeout_atomic(base + LS7A_PCIE_PORT_STS1, sts, > + (sts & LS2K_BMC_PCIE_LTSSM_STS) == > LS2K_BMC_PCIE_CONNECTED, > + LS2K_BMC_PCIE_DELAY_US, > LS2K_BMC_PCIE_TIMEOUT_US); > + if (ret) { > + pci_iounmap(parent, base); > + dev_err(ddata->dev, "PCIE train failed status=0x%x\n", sts); Nit: This is "PCI-E" elsewhere. > + return false; > + } > + > + pci_iounmap(parent, base); > + return true; > +} > + > +static void ls2k_bmc_restore_bridge_pci_data(struct pci_dev *parent, struct > ls2k_bmc_pdata *ddata) > +{ > + int base, i = 0; > + > + pci_write_config_dword(parent, PCI_COMMAND, > ddata->bridge_pci_data.pci_command); > + > + for (base = PCI_BASE_ADDRESS_0; base <= PCI_BASE_ADDRESS_5; base += 4, > i++) > + pci_write_config_dword(parent, base, > ddata->bridge_pci_data.base_address[i]); > + > + pci_write_config_dword(parent, PCI_ROM_ADDRESS, > ddata->bridge_pci_data.rom_addreess); > + pci_write_config_dword(parent, PCI_INTERRUPT_LINE, > ddata->bridge_pci_data.interrupt_line); > + > + pci_write_config_dword(parent, parent->msi_cap + PCI_MSI_ADDRESS_LO, > + ddata->bridge_pci_data.msi_lo); > + pci_write_config_dword(parent, parent->msi_cap + PCI_MSI_ADDRESS_HI, > + ddata->bridge_pci_data.msi_hi); > + pci_write_config_dword(parent, parent->pcie_cap + PCI_EXP_DEVCTL, > + ddata->bridge_pci_data.devctl); > + pci_write_config_dword(parent, parent->pcie_cap + PCI_EXP_LNKCAP, > + ddata->bridge_pci_data.linkcap); > + pci_write_config_dword(parent, parent->pcie_cap + PCI_EXP_LNKCTL, > + ddata->bridge_pci_data.linkctl_sts); > + > + pci_write_config_dword(parent, LS7A_GEN2_CTL, > ddata->bridge_pci_data.gen2_ctrl); > + pci_write_config_dword(parent, LS7A_SYMBOL_TIMER, > ddata->bridge_pci_data.symbol_timer); > +} > + > +static int ls2k_bmc_recover_pci_data(void *data) > +{ > + struct ls2k_bmc_pdata *ddata = data; > + struct pci_dev *pdev = to_pci_dev(ddata->dev); > + struct pci_dev *parent = pdev->bus->self; > + u32 i; > + > + /* > + * Clear the bus, io and mem resources of the PCI-E bridge to zero, so > that > + * the processor can not access the LS2K PCI-E port, to avoid crashing > due to > + * the lack of return signal from accessing the LS2K PCI-E port. > + */ > + pci_write_config_dword(parent, PCI_BASE_ADDRESS_2, 0); > + pci_write_config_dword(parent, PCI_BASE_ADDRESS_3, 0); > + pci_write_config_dword(parent, PCI_BASE_ADDRESS_4, 0); > + > + /* > + * When the LS2K BMC is reset, the LS7A PCI-E port is also reset, and > its PCI > + * BAR0 register is cleared. Due to the time gap between the GPIO > interrupt > + * generation and the LS2K BMC reset, the LS7A PCI BAR0 register is > read to > + * determine whether the reset has begun. > + */ > + for (i = LS7A_BAR0_CHECK_MAX_TIMES; i > 0 ; i--) { > + if (!ls2k_bmc_bar0_addr_is_set(parent)) > + break; > + mdelay(1); > + }; > + > + if (i == 0) > + return false; > + > + ls2k_bmc_restore_bridge_pci_data(parent, ddata); > + > + /* Check if PCI-E is connected */ > + if (!ls2k_bmc_pcie_is_connected(parent, ddata)) > + return false; > + > + /* Waiting for U-Boot and DDR ready */ > + mdelay(LS2K_BMC_RESET_WAIT_TIME); > + if (!ls2k_bmc_bar0_addr_is_set(parent)) > + return false; > + > + /* Restore LS2K BMC PCI-E config data */ > + pci_write_config_dword(pdev, PCI_COMMAND, > ddata->bmc_pci_data.pci_command); > + pci_write_config_dword(pdev, PCI_BASE_ADDRESS_0, > ddata->bmc_pci_data.base_address0); > + pci_write_config_dword(pdev, PCI_INTERRUPT_LINE, > ddata->bmc_pci_data.interrupt_line); > + > + return 0; > +} > + > +static void ls2k_bmc_events_fn(struct work_struct *work) > +{ > + struct ls2k_bmc_pdata *ddata = container_of(work, struct > ls2k_bmc_pdata, bmc_reset_work); > + > + /* > + * The PCI-E is lost when the BMC resets, at which point access to the > PCI-E > + * from other CPUs is suspended to prevent a crash. > + */ > + stop_machine(ls2k_bmc_recover_pci_data, ddata, NULL); > + > + if (IS_ENABLED(CONFIG_VT)) > + /* Re-push the display due to previous PCI-E loss. */ > + set_console(vt_move_to_console(MAX_NR_CONSOLES - 1, 1)); > +} > + > +static irqreturn_t ls2k_bmc_interrupt(int irq, void *arg) > +{ > + struct ls2k_bmc_pdata *ddata = arg; > + static unsigned long last_jiffies; > + > + if (system_state != SYSTEM_RUNNING) > + return IRQ_HANDLED; > + > + /* Skip interrupt in LS2K_BMC_INT_INTERVAL */ > + if (time_after(jiffies, last_jiffies + LS2K_BMC_INT_INTERVAL)) { > + schedule_work(&ddata->bmc_reset_work); > + last_jiffies = jiffies; > + } > + > + return IRQ_HANDLED; > +} > + > +/* > + * Saves the BMC parent device (LS7A) and its own PCI configuration space > registers > + * that need to be restored after BMC reset. > + */ > +static void ls2k_bmc_save_pci_data(struct pci_dev *pdev, struct > ls2k_bmc_pdata *ddata) > +{ > + struct pci_dev *parent = pdev->bus->self; > + int base, i = 0; > + > + pci_read_config_dword(parent, PCI_COMMAND, > &ddata->bridge_pci_data.pci_command); > + > + for (base = PCI_BASE_ADDRESS_0; base <= PCI_BASE_ADDRESS_5; base += 4, > i++) > + pci_read_config_dword(parent, base, > &ddata->bridge_pci_data.base_address[i]); > + > + pci_read_config_dword(parent, PCI_ROM_ADDRESS, > &ddata->bridge_pci_data.rom_addreess); > + pci_read_config_dword(parent, PCI_INTERRUPT_LINE, > &ddata->bridge_pci_data.interrupt_line); > + > + pci_read_config_dword(parent, parent->msi_cap + PCI_MSI_ADDRESS_LO, > + &ddata->bridge_pci_data.msi_lo); > + pci_read_config_dword(parent, parent->msi_cap + PCI_MSI_ADDRESS_HI, > + &ddata->bridge_pci_data.msi_hi); > + > + pci_read_config_dword(parent, parent->pcie_cap + PCI_EXP_DEVCTL, > + &ddata->bridge_pci_data.devctl); > + pci_read_config_dword(parent, parent->pcie_cap + PCI_EXP_LNKCAP, > + &ddata->bridge_pci_data.linkcap); > + pci_read_config_dword(parent, parent->pcie_cap + PCI_EXP_LNKCTL, > + &ddata->bridge_pci_data.linkctl_sts); > + > + pci_read_config_dword(parent, LS7A_GEN2_CTL, > &ddata->bridge_pci_data.gen2_ctrl); > + ddata->bridge_pci_data.gen2_ctrl |= FIELD_PREP(LS7A_GEN2_SPEED_CHANG, > 0x1) > + | FIELD_PREP(LS7A_CONF_PHY_TX, 0x0); > + > + pci_read_config_dword(parent, LS7A_SYMBOL_TIMER, > &ddata->bridge_pci_data.symbol_timer); > + ddata->bridge_pci_data.symbol_timer |= LS7A_MASK_LEN_MATCH; > + > + pci_read_config_dword(pdev, PCI_COMMAND, > &ddata->bmc_pci_data.pci_command); > + pci_read_config_dword(pdev, PCI_BASE_ADDRESS_0, > &ddata->bmc_pci_data.base_address0); > + pci_read_config_dword(pdev, PCI_INTERRUPT_LINE, > &ddata->bmc_pci_data.interrupt_line); > +} > + > +static int ls2k_bmc_pdata_initial(struct ls2k_bmc_pdata *ddata) > +{ > + struct pci_dev *pdev = to_pci_dev(ddata->dev); > + int gsi = 16 + (LS2K_BMC_RESET_GPIO & 7); > + void __iomem *gpio_base; > + int irq, ret; > + > + ls2k_bmc_save_pci_data(pdev, ddata); > + > + INIT_WORK(&ddata->bmc_reset_work, ls2k_bmc_events_fn); > + > + ret = devm_request_irq(&pdev->dev, pdev->irq, ls2k_bmc_interrupt, > + IRQF_SHARED | IRQF_TRIGGER_FALLING, "ls2kbmc > pcie", ddata); > + if (ret) { > + dev_err(ddata->dev, "Failed to request LS2KBMC PCI-E IRQ > %d.\n", pdev->irq); > + return ret; > + } > + > + /* > + * Since gpio_chip->to_irq is not implemented in the Loongson-3 GPIO > driver, > + * acpi_register_gsi() is used to obtain the GPIO IRQ. The GPIO > interrupt is a > + * watchdog interrupt that is triggered when the BMC resets. > + */ > + irq = acpi_register_gsi(NULL, gsi, ACPI_EDGE_SENSITIVE, > ACPI_ACTIVE_LOW); > + if (irq < 0) > + return irq; > + > + gpio_base = ioremap(LOONGSON_GPIO_REG_BASE, LOONGSON_GPIO_REG_SIZE); > + if (!gpio_base) { > + ret = PTR_ERR(gpio_base); > + goto acpi_failed; > + } > + > + writel(readl(gpio_base + LOONGSON_GPIO_OEN) | BIT(LS2K_BMC_RESET_GPIO), > + gpio_base + LOONGSON_GPIO_OEN); > + writel(readl(gpio_base + LOONGSON_GPIO_FUNC) & > ~BIT(LS2K_BMC_RESET_GPIO), > + gpio_base + LOONGSON_GPIO_FUNC); > + writel(readl(gpio_base + LOONGSON_GPIO_INTPOL) & > ~BIT(LS2K_BMC_RESET_GPIO), > + gpio_base + LOONGSON_GPIO_INTPOL); > + writel(readl(gpio_base + LOONGSON_GPIO_INTEN) | > BIT(LS2K_BMC_RESET_GPIO), > + gpio_base + LOONGSON_GPIO_INTEN); > + > + ret = devm_request_irq(ddata->dev, irq, ls2k_bmc_interrupt, > + IRQF_SHARED | IRQF_TRIGGER_FALLING, "ls2kbmc > gpio", ddata); > + if (ret) > + dev_err(ddata->dev, "Failed to request LS2KBMC GPIO IRQ %d.\n", > irq); > + > + iounmap(gpio_base); > + > +acpi_failed: > + acpi_unregister_gsi(gsi); > + return ret; > +} > + > /* > * Currently the Loongson-2K BMC hardware does not have an I2C interface to > adapt to the > * resolution. We set the resolution by presetting "video=1280x1024-16@2M" > to the BMC memory. > @@ -134,6 +449,7 @@ static int ls2k_bmc_parse_mode(struct pci_dev *pdev, > struct simplefb_platform_da > static int ls2k_bmc_probe(struct pci_dev *dev, const struct pci_device_id > *id) > { > struct simplefb_platform_data pd; > + struct ls2k_bmc_pdata *ddata; > resource_size_t base; > int ret; > > @@ -141,6 +457,18 @@ static int ls2k_bmc_probe(struct pci_dev *dev, const > struct pci_device_id *id) > if (ret) > return ret; > > + ddata = devm_kzalloc(&dev->dev, sizeof(*ddata), GFP_KERNEL); > + if (IS_ERR(ddata)) { > + ret = -ENOMEM; > + goto disable_pci; > + } > + > + ddata->dev = &dev->dev; > + > + ret = ls2k_bmc_pdata_initial(ddata); > + if (ret) > + goto disable_pci; > + > ret = ls2k_bmc_parse_mode(dev, &pd); > if (ret) > goto disable_pci; > -- > 2.47.1 > -- Lee Jones [李琼斯] _______________________________________________ Openipmi-developer mailing list Openipmi-developer@lists.sourceforge.net https://lists.sourceforge.net/lists/listinfo/openipmi-developer