cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

scan.c (10441B)


      1/*
      2 * Sonics Silicon Backplane
      3 * Bus scanning
      4 *
      5 * Copyright (C) 2005-2007 Michael Buesch <m@bues.ch>
      6 * Copyright (C) 2005 Martin Langer <martin-langer@gmx.de>
      7 * Copyright (C) 2005 Stefano Brivio <st3@riseup.net>
      8 * Copyright (C) 2005 Danny van Dyk <kugelfang@gentoo.org>
      9 * Copyright (C) 2005 Andreas Jaggi <andreas.jaggi@waterwave.ch>
     10 * Copyright (C) 2006 Broadcom Corporation.
     11 *
     12 * Licensed under the GNU/GPL. See COPYING for details.
     13 */
     14
     15#include "ssb_private.h"
     16
     17#include <linux/ssb/ssb.h>
     18#include <linux/ssb/ssb_regs.h>
     19#include <linux/pci.h>
     20#include <linux/io.h>
     21
     22#include <pcmcia/cistpl.h>
     23#include <pcmcia/ds.h>
     24
     25
     26const char *ssb_core_name(u16 coreid)
     27{
     28	switch (coreid) {
     29	case SSB_DEV_CHIPCOMMON:
     30		return "ChipCommon";
     31	case SSB_DEV_ILINE20:
     32		return "ILine 20";
     33	case SSB_DEV_SDRAM:
     34		return "SDRAM";
     35	case SSB_DEV_PCI:
     36		return "PCI";
     37	case SSB_DEV_MIPS:
     38		return "MIPS";
     39	case SSB_DEV_ETHERNET:
     40		return "Fast Ethernet";
     41	case SSB_DEV_V90:
     42		return "V90";
     43	case SSB_DEV_USB11_HOSTDEV:
     44		return "USB 1.1 Hostdev";
     45	case SSB_DEV_ADSL:
     46		return "ADSL";
     47	case SSB_DEV_ILINE100:
     48		return "ILine 100";
     49	case SSB_DEV_IPSEC:
     50		return "IPSEC";
     51	case SSB_DEV_PCMCIA:
     52		return "PCMCIA";
     53	case SSB_DEV_INTERNAL_MEM:
     54		return "Internal Memory";
     55	case SSB_DEV_MEMC_SDRAM:
     56		return "MEMC SDRAM";
     57	case SSB_DEV_EXTIF:
     58		return "EXTIF";
     59	case SSB_DEV_80211:
     60		return "IEEE 802.11";
     61	case SSB_DEV_MIPS_3302:
     62		return "MIPS 3302";
     63	case SSB_DEV_USB11_HOST:
     64		return "USB 1.1 Host";
     65	case SSB_DEV_USB11_DEV:
     66		return "USB 1.1 Device";
     67	case SSB_DEV_USB20_HOST:
     68		return "USB 2.0 Host";
     69	case SSB_DEV_USB20_DEV:
     70		return "USB 2.0 Device";
     71	case SSB_DEV_SDIO_HOST:
     72		return "SDIO Host";
     73	case SSB_DEV_ROBOSWITCH:
     74		return "Roboswitch";
     75	case SSB_DEV_PARA_ATA:
     76		return "PATA";
     77	case SSB_DEV_SATA_XORDMA:
     78		return "SATA XOR-DMA";
     79	case SSB_DEV_ETHERNET_GBIT:
     80		return "GBit Ethernet";
     81	case SSB_DEV_PCIE:
     82		return "PCI-E";
     83	case SSB_DEV_MIMO_PHY:
     84		return "MIMO PHY";
     85	case SSB_DEV_SRAM_CTRLR:
     86		return "SRAM Controller";
     87	case SSB_DEV_MINI_MACPHY:
     88		return "Mini MACPHY";
     89	case SSB_DEV_ARM_1176:
     90		return "ARM 1176";
     91	case SSB_DEV_ARM_7TDMI:
     92		return "ARM 7TDMI";
     93	case SSB_DEV_ARM_CM3:
     94		return "ARM Cortex M3";
     95	}
     96	return "UNKNOWN";
     97}
     98
     99static u16 pcidev_to_chipid(struct pci_dev *pci_dev)
    100{
    101	u16 chipid_fallback = 0;
    102
    103	switch (pci_dev->device) {
    104	case 0x4301:
    105		chipid_fallback = 0x4301;
    106		break;
    107	case 0x4305 ... 0x4307:
    108		chipid_fallback = 0x4307;
    109		break;
    110	case 0x4403:
    111		chipid_fallback = 0x4402;
    112		break;
    113	case 0x4610 ... 0x4615:
    114		chipid_fallback = 0x4610;
    115		break;
    116	case 0x4710 ... 0x4715:
    117		chipid_fallback = 0x4710;
    118		break;
    119	case 0x4320 ... 0x4325:
    120		chipid_fallback = 0x4309;
    121		break;
    122	case PCI_DEVICE_ID_BCM4401:
    123	case PCI_DEVICE_ID_BCM4401B0:
    124	case PCI_DEVICE_ID_BCM4401B1:
    125		chipid_fallback = 0x4401;
    126		break;
    127	default:
    128		dev_err(&pci_dev->dev, "PCI-ID not in fallback list\n");
    129	}
    130
    131	return chipid_fallback;
    132}
    133
    134static u8 chipid_to_nrcores(u16 chipid)
    135{
    136	switch (chipid) {
    137	case 0x5365:
    138		return 7;
    139	case 0x4306:
    140		return 6;
    141	case 0x4310:
    142		return 8;
    143	case 0x4307:
    144	case 0x4301:
    145		return 5;
    146	case 0x4401:
    147	case 0x4402:
    148		return 3;
    149	case 0x4710:
    150	case 0x4610:
    151	case 0x4704:
    152		return 9;
    153	default:
    154		pr_err("CHIPID not in nrcores fallback list\n");
    155	}
    156
    157	return 1;
    158}
    159
    160static u32 scan_read32(struct ssb_bus *bus, u8 current_coreidx,
    161		       u16 offset)
    162{
    163	u32 lo, hi;
    164
    165	switch (bus->bustype) {
    166	case SSB_BUSTYPE_SSB:
    167		offset += current_coreidx * SSB_CORE_SIZE;
    168		break;
    169	case SSB_BUSTYPE_PCI:
    170		break;
    171	case SSB_BUSTYPE_PCMCIA:
    172		if (offset >= 0x800) {
    173			ssb_pcmcia_switch_segment(bus, 1);
    174			offset -= 0x800;
    175		} else
    176			ssb_pcmcia_switch_segment(bus, 0);
    177		lo = readw(bus->mmio + offset);
    178		hi = readw(bus->mmio + offset + 2);
    179		return lo | (hi << 16);
    180	case SSB_BUSTYPE_SDIO:
    181		offset += current_coreidx * SSB_CORE_SIZE;
    182		return ssb_sdio_scan_read32(bus, offset);
    183	}
    184	return readl(bus->mmio + offset);
    185}
    186
    187static int scan_switchcore(struct ssb_bus *bus, u8 coreidx)
    188{
    189	switch (bus->bustype) {
    190	case SSB_BUSTYPE_SSB:
    191		break;
    192	case SSB_BUSTYPE_PCI:
    193		return ssb_pci_switch_coreidx(bus, coreidx);
    194	case SSB_BUSTYPE_PCMCIA:
    195		return ssb_pcmcia_switch_coreidx(bus, coreidx);
    196	case SSB_BUSTYPE_SDIO:
    197		return ssb_sdio_scan_switch_coreidx(bus, coreidx);
    198	}
    199	return 0;
    200}
    201
    202void ssb_iounmap(struct ssb_bus *bus)
    203{
    204	switch (bus->bustype) {
    205	case SSB_BUSTYPE_SSB:
    206	case SSB_BUSTYPE_PCMCIA:
    207		iounmap(bus->mmio);
    208		break;
    209	case SSB_BUSTYPE_PCI:
    210#ifdef CONFIG_SSB_PCIHOST
    211		pci_iounmap(bus->host_pci, bus->mmio);
    212#else
    213		WARN_ON(1); /* Can't reach this code. */
    214#endif
    215		break;
    216	case SSB_BUSTYPE_SDIO:
    217		break;
    218	}
    219	bus->mmio = NULL;
    220	bus->mapped_device = NULL;
    221}
    222
    223static void __iomem *ssb_ioremap(struct ssb_bus *bus,
    224				 unsigned long baseaddr)
    225{
    226	void __iomem *mmio = NULL;
    227
    228	switch (bus->bustype) {
    229	case SSB_BUSTYPE_SSB:
    230		/* Only map the first core for now. */
    231		fallthrough;
    232	case SSB_BUSTYPE_PCMCIA:
    233		mmio = ioremap(baseaddr, SSB_CORE_SIZE);
    234		break;
    235	case SSB_BUSTYPE_PCI:
    236#ifdef CONFIG_SSB_PCIHOST
    237		mmio = pci_iomap(bus->host_pci, 0, ~0UL);
    238#else
    239		WARN_ON(1); /* Can't reach this code. */
    240#endif
    241		break;
    242	case SSB_BUSTYPE_SDIO:
    243		/* Nothing to ioremap in the SDIO case, just fake it */
    244		mmio = (void __iomem *)baseaddr;
    245		break;
    246	}
    247
    248	return mmio;
    249}
    250
    251static int we_support_multiple_80211_cores(struct ssb_bus *bus)
    252{
    253	/* More than one 802.11 core is only supported by special chips.
    254	 * There are chips with two 802.11 cores, but with dangling
    255	 * pins on the second core. Be careful and reject them here.
    256	 */
    257
    258#ifdef CONFIG_SSB_PCIHOST
    259	if (bus->bustype == SSB_BUSTYPE_PCI) {
    260		if (bus->host_pci->vendor == PCI_VENDOR_ID_BROADCOM &&
    261		    ((bus->host_pci->device == 0x4313) ||
    262		     (bus->host_pci->device == 0x431A) ||
    263		     (bus->host_pci->device == 0x4321) ||
    264		     (bus->host_pci->device == 0x4324)))
    265			return 1;
    266	}
    267#endif /* CONFIG_SSB_PCIHOST */
    268	return 0;
    269}
    270
    271int ssb_bus_scan(struct ssb_bus *bus,
    272		 unsigned long baseaddr)
    273{
    274	int err = -ENOMEM;
    275	void __iomem *mmio;
    276	u32 idhi, cc, rev, tmp;
    277	int dev_i, i;
    278	struct ssb_device *dev;
    279	int nr_80211_cores = 0;
    280
    281	mmio = ssb_ioremap(bus, baseaddr);
    282	if (!mmio)
    283		goto out;
    284	bus->mmio = mmio;
    285
    286	err = scan_switchcore(bus, 0); /* Switch to first core */
    287	if (err)
    288		goto err_unmap;
    289
    290	idhi = scan_read32(bus, 0, SSB_IDHIGH);
    291	cc = (idhi & SSB_IDHIGH_CC) >> SSB_IDHIGH_CC_SHIFT;
    292	rev = (idhi & SSB_IDHIGH_RCLO);
    293	rev |= (idhi & SSB_IDHIGH_RCHI) >> SSB_IDHIGH_RCHI_SHIFT;
    294
    295	bus->nr_devices = 0;
    296	if (cc == SSB_DEV_CHIPCOMMON) {
    297		tmp = scan_read32(bus, 0, SSB_CHIPCO_CHIPID);
    298
    299		bus->chip_id = (tmp & SSB_CHIPCO_IDMASK);
    300		bus->chip_rev = (tmp & SSB_CHIPCO_REVMASK) >>
    301				SSB_CHIPCO_REVSHIFT;
    302		bus->chip_package = (tmp & SSB_CHIPCO_PACKMASK) >>
    303				    SSB_CHIPCO_PACKSHIFT;
    304		if (rev >= 4) {
    305			bus->nr_devices = (tmp & SSB_CHIPCO_NRCORESMASK) >>
    306					  SSB_CHIPCO_NRCORESSHIFT;
    307		}
    308		tmp = scan_read32(bus, 0, SSB_CHIPCO_CAP);
    309		bus->chipco.capabilities = tmp;
    310	} else {
    311		if (bus->bustype == SSB_BUSTYPE_PCI) {
    312			bus->chip_id = pcidev_to_chipid(bus->host_pci);
    313			bus->chip_rev = bus->host_pci->revision;
    314			bus->chip_package = 0;
    315		} else {
    316			bus->chip_id = 0x4710;
    317			bus->chip_rev = 0;
    318			bus->chip_package = 0;
    319		}
    320	}
    321	pr_info("Found chip with id 0x%04X, rev 0x%02X and package 0x%02X\n",
    322		bus->chip_id, bus->chip_rev, bus->chip_package);
    323	if (!bus->nr_devices)
    324		bus->nr_devices = chipid_to_nrcores(bus->chip_id);
    325	if (bus->nr_devices > ARRAY_SIZE(bus->devices)) {
    326		pr_err("More than %d ssb cores found (%d)\n",
    327		       SSB_MAX_NR_CORES, bus->nr_devices);
    328		err = -EINVAL;
    329		goto err_unmap;
    330	}
    331	if (bus->bustype == SSB_BUSTYPE_SSB) {
    332		/* Now that we know the number of cores,
    333		 * remap the whole IO space for all cores.
    334		 */
    335		err = -ENOMEM;
    336		iounmap(mmio);
    337		mmio = ioremap(baseaddr, SSB_CORE_SIZE * bus->nr_devices);
    338		if (!mmio)
    339			goto out;
    340		bus->mmio = mmio;
    341	}
    342
    343	/* Fetch basic information about each core/device */
    344	for (i = 0, dev_i = 0; i < bus->nr_devices; i++) {
    345		err = scan_switchcore(bus, i);
    346		if (err)
    347			goto err_unmap;
    348		dev = &(bus->devices[dev_i]);
    349
    350		idhi = scan_read32(bus, i, SSB_IDHIGH);
    351		dev->id.coreid = (idhi & SSB_IDHIGH_CC) >> SSB_IDHIGH_CC_SHIFT;
    352		dev->id.revision = (idhi & SSB_IDHIGH_RCLO);
    353		dev->id.revision |= (idhi & SSB_IDHIGH_RCHI) >> SSB_IDHIGH_RCHI_SHIFT;
    354		dev->id.vendor = (idhi & SSB_IDHIGH_VC) >> SSB_IDHIGH_VC_SHIFT;
    355		dev->core_index = i;
    356		dev->bus = bus;
    357		dev->ops = bus->ops;
    358
    359		pr_debug("Core %d found: %s (cc 0x%03X, rev 0x%02X, vendor 0x%04X)\n",
    360			 i, ssb_core_name(dev->id.coreid),
    361			 dev->id.coreid, dev->id.revision, dev->id.vendor);
    362
    363		switch (dev->id.coreid) {
    364		case SSB_DEV_80211:
    365			nr_80211_cores++;
    366			if (nr_80211_cores > 1) {
    367				if (!we_support_multiple_80211_cores(bus)) {
    368					pr_debug("Ignoring additional 802.11 core\n");
    369					continue;
    370				}
    371			}
    372			break;
    373		case SSB_DEV_EXTIF:
    374#ifdef CONFIG_SSB_DRIVER_EXTIF
    375			if (bus->extif.dev) {
    376				pr_warn("WARNING: Multiple EXTIFs found\n");
    377				break;
    378			}
    379			bus->extif.dev = dev;
    380#endif /* CONFIG_SSB_DRIVER_EXTIF */
    381			break;
    382		case SSB_DEV_CHIPCOMMON:
    383			if (bus->chipco.dev) {
    384				pr_warn("WARNING: Multiple ChipCommon found\n");
    385				break;
    386			}
    387			bus->chipco.dev = dev;
    388			break;
    389		case SSB_DEV_MIPS:
    390		case SSB_DEV_MIPS_3302:
    391#ifdef CONFIG_SSB_DRIVER_MIPS
    392			if (bus->mipscore.dev) {
    393				pr_warn("WARNING: Multiple MIPS cores found\n");
    394				break;
    395			}
    396			bus->mipscore.dev = dev;
    397#endif /* CONFIG_SSB_DRIVER_MIPS */
    398			break;
    399		case SSB_DEV_PCI:
    400		case SSB_DEV_PCIE:
    401#ifdef CONFIG_SSB_DRIVER_PCICORE
    402			if (bus->bustype == SSB_BUSTYPE_PCI) {
    403				/* Ignore PCI cores on PCI-E cards.
    404				 * Ignore PCI-E cores on PCI cards.
    405				 */
    406				if (dev->id.coreid == SSB_DEV_PCI) {
    407					if (pci_is_pcie(bus->host_pci))
    408						continue;
    409				} else {
    410					if (!pci_is_pcie(bus->host_pci))
    411						continue;
    412				}
    413			}
    414			if (bus->pcicore.dev) {
    415				pr_warn("WARNING: Multiple PCI(E) cores found\n");
    416				break;
    417			}
    418			bus->pcicore.dev = dev;
    419#endif /* CONFIG_SSB_DRIVER_PCICORE */
    420			break;
    421		case SSB_DEV_ETHERNET:
    422			if (bus->bustype == SSB_BUSTYPE_PCI) {
    423				if (bus->host_pci->vendor == PCI_VENDOR_ID_BROADCOM &&
    424				    (bus->host_pci->device & 0xFF00) == 0x4300) {
    425					/* This is a dangling ethernet core on a
    426					 * wireless device. Ignore it.
    427					 */
    428					continue;
    429				}
    430			}
    431			break;
    432		default:
    433			break;
    434		}
    435
    436		dev_i++;
    437	}
    438	bus->nr_devices = dev_i;
    439
    440	err = 0;
    441out:
    442	return err;
    443err_unmap:
    444	ssb_iounmap(bus);
    445	goto out;
    446}