root/arch/powerpc/platforms/fsl_uli1575.c
// SPDX-License-Identifier: GPL-2.0-or-later
/*
 * ULI M1575 setup code - specific to Freescale boards
 *
 * Copyright 2007 Freescale Semiconductor Inc.
 */

#include <linux/stddef.h>
#include <linux/kernel.h>
#include <linux/pci.h>
#include <linux/interrupt.h>
#include <linux/mc146818rtc.h>
#include <linux/of_irq.h>

#include <asm/pci-bridge.h>
#include <asm/ppc-pci.h>

#include <sysdev/fsl_pci.h>

#define ULI_PIRQA       0x08
#define ULI_PIRQB       0x09
#define ULI_PIRQC       0x0a
#define ULI_PIRQD       0x0b
#define ULI_PIRQE       0x0c
#define ULI_PIRQF       0x0d
#define ULI_PIRQG       0x0e

#define ULI_8259_NONE   0x00
#define ULI_8259_IRQ1   0x08
#define ULI_8259_IRQ3   0x02
#define ULI_8259_IRQ4   0x04
#define ULI_8259_IRQ5   0x05
#define ULI_8259_IRQ6   0x07
#define ULI_8259_IRQ7   0x06
#define ULI_8259_IRQ9   0x01
#define ULI_8259_IRQ10  0x03
#define ULI_8259_IRQ11  0x09
#define ULI_8259_IRQ12  0x0b
#define ULI_8259_IRQ14  0x0d
#define ULI_8259_IRQ15  0x0f

static u8 uli_pirq_to_irq[8] = {
        ULI_8259_IRQ9,          /* PIRQA */
        ULI_8259_IRQ10,         /* PIRQB */
        ULI_8259_IRQ11,         /* PIRQC */
        ULI_8259_IRQ12,         /* PIRQD */
        ULI_8259_IRQ5,          /* PIRQE */
        ULI_8259_IRQ6,          /* PIRQF */
        ULI_8259_IRQ7,          /* PIRQG */
        ULI_8259_NONE,          /* PIRQH */
};

static inline bool is_quirk_valid(void)
{
        return (machine_is(mpc86xx_hpcn) ||
                machine_is(mpc8544_ds) ||
                machine_is(p2020_ds) ||
                machine_is(mpc8572_ds));
}

/* Bridge */
static void early_uli5249(struct pci_dev *dev)
{
        unsigned char temp;

        if (!is_quirk_valid())
                return;

        pci_write_config_word(dev, PCI_COMMAND, PCI_COMMAND_IO |
                 PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER);

        /* read/write lock */
        pci_read_config_byte(dev, 0x7c, &temp);
        pci_write_config_byte(dev, 0x7c, 0x80);

        /* set as P2P bridge */
        pci_write_config_byte(dev, PCI_CLASS_PROG, 0x01);
        dev->class |= 0x1;

        /* restore lock */
        pci_write_config_byte(dev, 0x7c, temp);
}


static void quirk_uli1575(struct pci_dev *dev)
{
        int i;

        if (!is_quirk_valid())
                return;

        /*
         * ULI1575 interrupts route setup
         */

        /* ULI1575 IRQ mapping conf register maps PIRQx to IRQn */
        for (i = 0; i < 4; i++) {
                u8 val = uli_pirq_to_irq[i*2] | (uli_pirq_to_irq[i*2+1] << 4);
                pci_write_config_byte(dev, 0x48 + i, val);
        }

        /* USB 1.1 OHCI controller 1: dev 28, func 0 - IRQ12 */
        pci_write_config_byte(dev, 0x86, ULI_PIRQD);

        /* USB 1.1 OHCI controller 2: dev 28, func 1 - IRQ9 */
        pci_write_config_byte(dev, 0x87, ULI_PIRQA);

        /* USB 1.1 OHCI controller 3: dev 28, func 2 - IRQ10 */
        pci_write_config_byte(dev, 0x88, ULI_PIRQB);

        /* Lan controller: dev 27, func 0 - IRQ6 */
        pci_write_config_byte(dev, 0x89, ULI_PIRQF);

        /* AC97 Audio controller: dev 29, func 0 - IRQ6 */
        pci_write_config_byte(dev, 0x8a, ULI_PIRQF);

        /* Modem controller: dev 29, func 1 - IRQ6 */
        pci_write_config_byte(dev, 0x8b, ULI_PIRQF);

        /* HD Audio controller: dev 29, func 2 - IRQ6 */
        pci_write_config_byte(dev, 0x8c, ULI_PIRQF);

        /* SATA controller: dev 31, func 1 - IRQ5 */
        pci_write_config_byte(dev, 0x8d, ULI_PIRQE);

        /* SMB interrupt: dev 30, func 1 - IRQ7 */
        pci_write_config_byte(dev, 0x8e, ULI_PIRQG);

        /* PMU ACPI SCI interrupt: dev 30, func 2 - IRQ7 */
        pci_write_config_byte(dev, 0x8f, ULI_PIRQG);

        /* USB 2.0 controller: dev 28, func 3 */
        pci_write_config_byte(dev, 0x74, ULI_8259_IRQ11);

        /* Primary PATA IDE IRQ: 14
         * Secondary PATA IDE IRQ: 15
         */
        pci_write_config_byte(dev, 0x44, 0x30 | ULI_8259_IRQ14);
        pci_write_config_byte(dev, 0x75, ULI_8259_IRQ15);
}

static void quirk_final_uli1575(struct pci_dev *dev)
{
        /* Set i8259 interrupt trigger
         * IRQ 3:  Level
         * IRQ 4:  Level
         * IRQ 5:  Level
         * IRQ 6:  Level
         * IRQ 7:  Level
         * IRQ 9:  Level
         * IRQ 10: Level
         * IRQ 11: Level
         * IRQ 12: Level
         * IRQ 14: Edge
         * IRQ 15: Edge
         */
        if (!is_quirk_valid())
                return;

        outb(0xfa, 0x4d0);
        outb(0x1e, 0x4d1);

        /* setup RTC */
        CMOS_WRITE(RTC_SET, RTC_CONTROL);
        CMOS_WRITE(RTC_24H, RTC_CONTROL);

        /* ensure month, date, and week alarm fields are ignored */
        CMOS_WRITE(0, RTC_VALID);

        outb_p(0x7c, 0x72);
        outb_p(RTC_ALARM_DONT_CARE, 0x73);

        outb_p(0x7d, 0x72);
        outb_p(RTC_ALARM_DONT_CARE, 0x73);
}

/* SATA */
static void quirk_uli5288(struct pci_dev *dev)
{
        unsigned char c;
        unsigned int d;

        if (!is_quirk_valid())
                return;

        /* read/write lock */
        pci_read_config_byte(dev, 0x83, &c);
        pci_write_config_byte(dev, 0x83, c|0x80);

        pci_read_config_dword(dev, PCI_CLASS_REVISION, &d);
        d = (d & 0xff) | (PCI_CLASS_STORAGE_SATA_AHCI << 8);
        pci_write_config_dword(dev, PCI_CLASS_REVISION, d);

        /* restore lock */
        pci_write_config_byte(dev, 0x83, c);

        /* disable emulated PATA mode enabled */
        pci_read_config_byte(dev, 0x84, &c);
        pci_write_config_byte(dev, 0x84, c & ~0x01);
}

/* PATA */
static void quirk_uli5229(struct pci_dev *dev)
{
        unsigned short temp;

        if (!is_quirk_valid())
                return;

        pci_write_config_word(dev, PCI_COMMAND, PCI_COMMAND_INTX_DISABLE |
                PCI_COMMAND_MASTER | PCI_COMMAND_IO);

        /* Enable Native IRQ 14/15 */
        pci_read_config_word(dev, 0x4a, &temp);
        pci_write_config_word(dev, 0x4a, temp | 0x1000);
}

/* We have to do a dummy read on the P2P for the RTC to work, WTF */
static void quirk_final_uli5249(struct pci_dev *dev)
{
        int i;
        u8 *dummy;
        struct pci_bus *bus = dev->bus;
        struct resource *res;
        resource_size_t end = 0;

        for (i = PCI_BRIDGE_RESOURCES; i < PCI_BRIDGE_RESOURCES+3; i++) {
                unsigned long flags = pci_resource_flags(dev, i);
                if ((flags & (IORESOURCE_MEM|IORESOURCE_PREFETCH)) == IORESOURCE_MEM)
                        end = pci_resource_end(dev, i);
        }

        pci_bus_for_each_resource(bus, res, i) {
                if (res && res->flags & IORESOURCE_MEM) {
                        if (res->end == end)
                                dummy = ioremap(res->start, 0x4);
                        else
                                dummy = ioremap(res->end - 3, 0x4);
                        if (dummy) {
                                in_8(dummy);
                                iounmap(dummy);
                        }
                        break;
                }
        }
}

DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_AL, 0x5249, early_uli5249);
DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_AL, 0x1575, quirk_uli1575);
DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_AL, 0x5288, quirk_uli5288);
DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_AL, 0x5229, quirk_uli5229);
DECLARE_PCI_FIXUP_FINAL(PCI_VENDOR_ID_AL, 0x5249, quirk_final_uli5249);
DECLARE_PCI_FIXUP_FINAL(PCI_VENDOR_ID_AL, 0x1575, quirk_final_uli1575);
DECLARE_PCI_FIXUP_RESUME(PCI_VENDOR_ID_AL, 0x5229, quirk_uli5229);

static void hpcd_quirk_uli1575(struct pci_dev *dev)
{
        u32 temp32;

        if (!machine_is(mpc86xx_hpcd))
                return;

        /* Disable INTx */
        pci_read_config_dword(dev, 0x48, &temp32);
        pci_write_config_dword(dev, 0x48, (temp32 | 1<<26));

        /* Enable sideband interrupt */
        pci_read_config_dword(dev, 0x90, &temp32);
        pci_write_config_dword(dev, 0x90, (temp32 | 1<<22));
}

static void hpcd_quirk_uli5288(struct pci_dev *dev)
{
        unsigned char c;

        if (!machine_is(mpc86xx_hpcd))
                return;

        pci_read_config_byte(dev, 0x83, &c);
        c |= 0x80;
        pci_write_config_byte(dev, 0x83, c);

        pci_write_config_byte(dev, PCI_CLASS_PROG, 0x01);
        pci_write_config_byte(dev, PCI_CLASS_DEVICE, 0x06);

        pci_read_config_byte(dev, 0x83, &c);
        c &= 0x7f;
        pci_write_config_byte(dev, 0x83, c);
}

/*
 * Since 8259PIC was disabled on the board, the IDE device can not
 * use the legacy IRQ, we need to let the IDE device work under
 * native mode and use the interrupt line like other PCI devices.
 * IRQ14 is a sideband interrupt from IDE device to CPU and we use this
 * as the interrupt for IDE device.
 */
static void hpcd_quirk_uli5229(struct pci_dev *dev)
{
        unsigned char c;

        if (!machine_is(mpc86xx_hpcd))
                return;

        pci_read_config_byte(dev, 0x4b, &c);
        c |= 0x10;
        pci_write_config_byte(dev, 0x4b, c);
}

/*
 * SATA interrupt pin bug fix
 * There's a chip bug for 5288, The interrupt pin should be 2,
 * not the read only value 1, So it use INTB#, not INTA# which
 * actually used by the IDE device 5229.
 * As of this bug, during the PCI initialization, 5288 read the
 * irq of IDE device from the device tree, this function fix this
 * bug by re-assigning a correct irq to 5288.
 *
 */
static void hpcd_final_uli5288(struct pci_dev *dev)
{
        struct pci_controller *hose = pci_bus_to_host(dev->bus);
        struct device_node *hosenode = hose ? hose->dn : NULL;
        struct of_phandle_args oirq;
        u32 laddr[3];

        if (!machine_is(mpc86xx_hpcd))
                return;

        if (!hosenode)
                return;

        oirq.np = hosenode;
        oirq.args[0] = 2;
        oirq.args_count = 1;
        laddr[0] = (hose->first_busno << 16) | (PCI_DEVFN(31, 0) << 8);
        laddr[1] = laddr[2] = 0;
        of_irq_parse_raw(laddr, &oirq);
        dev->irq = irq_create_of_mapping(&oirq);
}

DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_AL, 0x1575, hpcd_quirk_uli1575);
DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_AL, 0x5288, hpcd_quirk_uli5288);
DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_AL, 0x5229, hpcd_quirk_uli5229);
DECLARE_PCI_FIXUP_FINAL(PCI_VENDOR_ID_AL, 0x5288, hpcd_final_uli5288);

static int uli_exclude_device(struct pci_controller *hose, u_char bus, u_char devfn)
{
        if (hose->dn == fsl_pci_primary && bus == (hose->first_busno + 2)) {
                /* exclude Modem controller */
                if ((PCI_SLOT(devfn) == 29) && (PCI_FUNC(devfn) == 1))
                        return PCIBIOS_DEVICE_NOT_FOUND;

                /* exclude HD Audio controller */
                if ((PCI_SLOT(devfn) == 29) && (PCI_FUNC(devfn) == 2))
                        return PCIBIOS_DEVICE_NOT_FOUND;
        }

        return PCIBIOS_SUCCESSFUL;
}

void __init uli_init(void)
{
        struct device_node *node;
        struct device_node *pci_with_uli;

        /* See if we have a ULI under the primary */

        node = of_find_node_by_name(NULL, "uli1575");
        while ((pci_with_uli = of_get_parent(node))) {
                of_node_put(node);
                node = pci_with_uli;

                if (pci_with_uli == fsl_pci_primary) {
                        ppc_md.pci_exclude_device = uli_exclude_device;
                        break;
                }
        }
}