linux/arch/parisc/kernel/drivers.c
<<
>>
Prefs
   1/*
   2 * drivers.c
   3 *
   4 * This program is free software; you can redistribute it and/or
   5 * modify it under the terms of the GNU General Public License
   6 * as published by the Free Software Foundation; either version
   7 * 2 of the License, or (at your option) any later version.
   8 *
   9 * Copyright (c) 1999 The Puffin Group
  10 * Copyright (c) 2001 Matthew Wilcox for Hewlett Packard
  11 * Copyright (c) 2001 Helge Deller <deller@gmx.de>
  12 * Copyright (c) 2001,2002 Ryan Bradetich 
  13 * Copyright (c) 2004-2005 Thibaut VARENE <varenet@parisc-linux.org>
  14 * 
  15 * The file handles registering devices and drivers, then matching them.
  16 * It's the closest we get to a dating agency.
  17 *
  18 * If you're thinking about modifying this file, here are some gotchas to
  19 * bear in mind:
  20 *  - 715/Mirage device paths have a dummy device between Lasi and its children
  21 *  - The EISA adapter may show up as a sibling or child of Wax
  22 *  - Dino has an optionally functional serial port.  If firmware enables it,
  23 *    it shows up as a child of Dino.  If firmware disables it, the buswalk
  24 *    finds it and it shows up as a child of Cujo
  25 *  - Dino has both parisc and pci devices as children
  26 *  - parisc devices are discovered in a random order, including children
  27 *    before parents in some cases.
  28 */
  29
  30#include <linux/slab.h>
  31#include <linux/types.h>
  32#include <linux/kernel.h>
  33#include <linux/pci.h>
  34#include <linux/spinlock.h>
  35#include <linux/string.h>
  36#include <linux/export.h>
  37#include <asm/hardware.h>
  38#include <asm/io.h>
  39#include <asm/pdc.h>
  40#include <asm/parisc-device.h>
  41
  42/* See comments in include/asm-parisc/pci.h */
  43const struct dma_map_ops *hppa_dma_ops __read_mostly;
  44EXPORT_SYMBOL(hppa_dma_ops);
  45
  46static struct device root = {
  47        .init_name = "parisc",
  48};
  49
  50static inline int check_dev(struct device *dev)
  51{
  52        if (dev->bus == &parisc_bus_type) {
  53                struct parisc_device *pdev;
  54                pdev = to_parisc_device(dev);
  55                return pdev->id.hw_type != HPHW_FAULTY;
  56        }
  57        return 1;
  58}
  59
  60static struct device *
  61parse_tree_node(struct device *parent, int index, struct hardware_path *modpath);
  62
  63struct recurse_struct {
  64        void * obj;
  65        int (*fn)(struct device *, void *);
  66};
  67
  68static int descend_children(struct device * dev, void * data)
  69{
  70        struct recurse_struct * recurse_data = (struct recurse_struct *)data;
  71
  72        if (recurse_data->fn(dev, recurse_data->obj))
  73                return 1;
  74        else
  75                return device_for_each_child(dev, recurse_data, descend_children);
  76}
  77
  78/**
  79 *      for_each_padev - Iterate over all devices in the tree
  80 *      @fn:    Function to call for each device.
  81 *      @data:  Data to pass to the called function.
  82 *
  83 *      This performs a depth-first traversal of the tree, calling the
  84 *      function passed for each node.  It calls the function for parents
  85 *      before children.
  86 */
  87
  88static int for_each_padev(int (*fn)(struct device *, void *), void * data)
  89{
  90        struct recurse_struct recurse_data = {
  91                .obj    = data,
  92                .fn     = fn,
  93        };
  94        return device_for_each_child(&root, &recurse_data, descend_children);
  95}
  96
  97/**
  98 * match_device - Report whether this driver can handle this device
  99 * @driver: the PA-RISC driver to try
 100 * @dev: the PA-RISC device to try
 101 */
 102static int match_device(struct parisc_driver *driver, struct parisc_device *dev)
 103{
 104        const struct parisc_device_id *ids;
 105
 106        for (ids = driver->id_table; ids->sversion; ids++) {
 107                if ((ids->sversion != SVERSION_ANY_ID) &&
 108                    (ids->sversion != dev->id.sversion))
 109                        continue;
 110
 111                if ((ids->hw_type != HWTYPE_ANY_ID) &&
 112                    (ids->hw_type != dev->id.hw_type))
 113                        continue;
 114
 115                if ((ids->hversion != HVERSION_ANY_ID) &&
 116                    (ids->hversion != dev->id.hversion))
 117                        continue;
 118
 119                return 1;
 120        }
 121        return 0;
 122}
 123
 124static int parisc_driver_probe(struct device *dev)
 125{
 126        int rc;
 127        struct parisc_device *pa_dev = to_parisc_device(dev);
 128        struct parisc_driver *pa_drv = to_parisc_driver(dev->driver);
 129
 130        rc = pa_drv->probe(pa_dev);
 131
 132        if (!rc)
 133                pa_dev->driver = pa_drv;
 134
 135        return rc;
 136}
 137
 138static int __exit parisc_driver_remove(struct device *dev)
 139{
 140        struct parisc_device *pa_dev = to_parisc_device(dev);
 141        struct parisc_driver *pa_drv = to_parisc_driver(dev->driver);
 142        if (pa_drv->remove)
 143                pa_drv->remove(pa_dev);
 144
 145        return 0;
 146}
 147        
 148
 149/**
 150 * register_parisc_driver - Register this driver if it can handle a device
 151 * @driver: the PA-RISC driver to try
 152 */
 153int register_parisc_driver(struct parisc_driver *driver)
 154{
 155        /* FIXME: we need this because apparently the sti
 156         * driver can be registered twice */
 157        if (driver->drv.name) {
 158                pr_warn("BUG: skipping previously registered driver %s\n",
 159                        driver->name);
 160                return 1;
 161        }
 162
 163        if (!driver->probe) {
 164                pr_warn("BUG: driver %s has no probe routine\n", driver->name);
 165                return 1;
 166        }
 167
 168        driver->drv.bus = &parisc_bus_type;
 169
 170        /* We install our own probe and remove routines */
 171        WARN_ON(driver->drv.probe != NULL);
 172        WARN_ON(driver->drv.remove != NULL);
 173
 174        driver->drv.name = driver->name;
 175
 176        return driver_register(&driver->drv);
 177}
 178EXPORT_SYMBOL(register_parisc_driver);
 179
 180
 181struct match_count {
 182        struct parisc_driver * driver;
 183        int count;
 184};
 185
 186static int match_and_count(struct device * dev, void * data)
 187{
 188        struct match_count * m = data;
 189        struct parisc_device * pdev = to_parisc_device(dev);
 190
 191        if (check_dev(dev)) {
 192                if (match_device(m->driver, pdev))
 193                        m->count++;
 194        }
 195        return 0;
 196}
 197
 198/**
 199 * count_parisc_driver - count # of devices this driver would match
 200 * @driver: the PA-RISC driver to try
 201 *
 202 * Use by IOMMU support to "guess" the right size IOPdir.
 203 * Formula is something like memsize/(num_iommu * entry_size).
 204 */
 205int __init count_parisc_driver(struct parisc_driver *driver)
 206{
 207        struct match_count m = {
 208                .driver = driver,
 209                .count  = 0,
 210        };
 211
 212        for_each_padev(match_and_count, &m);
 213
 214        return m.count;
 215}
 216
 217
 218
 219/**
 220 * unregister_parisc_driver - Unregister this driver from the list of drivers
 221 * @driver: the PA-RISC driver to unregister
 222 */
 223int unregister_parisc_driver(struct parisc_driver *driver)
 224{
 225        driver_unregister(&driver->drv);
 226        return 0;
 227}
 228EXPORT_SYMBOL(unregister_parisc_driver);
 229
 230struct find_data {
 231        unsigned long hpa;
 232        struct parisc_device * dev;
 233};
 234
 235static int find_device(struct device * dev, void * data)
 236{
 237        struct parisc_device * pdev = to_parisc_device(dev);
 238        struct find_data * d = (struct find_data*)data;
 239
 240        if (check_dev(dev)) {
 241                if (pdev->hpa.start == d->hpa) {
 242                        d->dev = pdev;
 243                        return 1;
 244                }
 245        }
 246        return 0;
 247}
 248
 249static struct parisc_device *find_device_by_addr(unsigned long hpa)
 250{
 251        struct find_data d = {
 252                .hpa    = hpa,
 253        };
 254        int ret;
 255
 256        ret = for_each_padev(find_device, &d);
 257        return ret ? d.dev : NULL;
 258}
 259
 260/**
 261 * find_pa_parent_type - Find a parent of a specific type
 262 * @dev: The device to start searching from
 263 * @type: The device type to search for.
 264 *
 265 * Walks up the device tree looking for a device of the specified type.
 266 * If it finds it, it returns it.  If not, it returns NULL.
 267 */
 268const struct parisc_device *
 269find_pa_parent_type(const struct parisc_device *padev, int type)
 270{
 271        const struct device *dev = &padev->dev;
 272        while (dev != &root) {
 273                struct parisc_device *candidate = to_parisc_device(dev);
 274                if (candidate->id.hw_type == type)
 275                        return candidate;
 276                dev = dev->parent;
 277        }
 278
 279        return NULL;
 280}
 281
 282/*
 283 * get_node_path fills in @path with the firmware path to the device.
 284 * Note that if @node is a parisc device, we don't fill in the 'mod' field.
 285 * This is because both callers pass the parent and fill in the mod
 286 * themselves.  If @node is a PCI device, we do fill it in, even though this
 287 * is inconsistent.
 288 */
 289static void get_node_path(struct device *dev, struct hardware_path *path)
 290{
 291        int i = 5;
 292        memset(&path->bc, -1, 6);
 293
 294        if (dev_is_pci(dev)) {
 295                unsigned int devfn = to_pci_dev(dev)->devfn;
 296                path->mod = PCI_FUNC(devfn);
 297                path->bc[i--] = PCI_SLOT(devfn);
 298                dev = dev->parent;
 299        }
 300
 301        while (dev != &root) {
 302                if (dev_is_pci(dev)) {
 303                        unsigned int devfn = to_pci_dev(dev)->devfn;
 304                        path->bc[i--] = PCI_SLOT(devfn) | (PCI_FUNC(devfn)<< 5);
 305                } else if (dev->bus == &parisc_bus_type) {
 306                        path->bc[i--] = to_parisc_device(dev)->hw_path;
 307                }
 308                dev = dev->parent;
 309        }
 310}
 311
 312static char *print_hwpath(struct hardware_path *path, char *output)
 313{
 314        int i;
 315        for (i = 0; i < 6; i++) {
 316                if (path->bc[i] == -1)
 317                        continue;
 318                output += sprintf(output, "%u/", (unsigned char) path->bc[i]);
 319        }
 320        output += sprintf(output, "%u", (unsigned char) path->mod);
 321        return output;
 322}
 323
 324/**
 325 * print_pa_hwpath - Returns hardware path for PA devices
 326 * dev: The device to return the path for
 327 * output: Pointer to a previously-allocated array to place the path in.
 328 *
 329 * This function fills in the output array with a human-readable path
 330 * to a PA device.  This string is compatible with that used by PDC, and
 331 * may be printed on the outside of the box.
 332 */
 333char *print_pa_hwpath(struct parisc_device *dev, char *output)
 334{
 335        struct hardware_path path;
 336
 337        get_node_path(dev->dev.parent, &path);
 338        path.mod = dev->hw_path;
 339        return print_hwpath(&path, output);
 340}
 341EXPORT_SYMBOL(print_pa_hwpath);
 342
 343#if defined(CONFIG_PCI) || defined(CONFIG_ISA)
 344/**
 345 * get_pci_node_path - Determines the hardware path for a PCI device
 346 * @pdev: The device to return the path for
 347 * @path: Pointer to a previously-allocated array to place the path in.
 348 *
 349 * This function fills in the hardware_path structure with the route to
 350 * the specified PCI device.  This structure is suitable for passing to
 351 * PDC calls.
 352 */
 353void get_pci_node_path(struct pci_dev *pdev, struct hardware_path *path)
 354{
 355        get_node_path(&pdev->dev, path);
 356}
 357EXPORT_SYMBOL(get_pci_node_path);
 358
 359/**
 360 * print_pci_hwpath - Returns hardware path for PCI devices
 361 * dev: The device to return the path for
 362 * output: Pointer to a previously-allocated array to place the path in.
 363 *
 364 * This function fills in the output array with a human-readable path
 365 * to a PCI device.  This string is compatible with that used by PDC, and
 366 * may be printed on the outside of the box.
 367 */
 368char *print_pci_hwpath(struct pci_dev *dev, char *output)
 369{
 370        struct hardware_path path;
 371
 372        get_pci_node_path(dev, &path);
 373        return print_hwpath(&path, output);
 374}
 375EXPORT_SYMBOL(print_pci_hwpath);
 376
 377#endif /* defined(CONFIG_PCI) || defined(CONFIG_ISA) */
 378
 379static void setup_bus_id(struct parisc_device *padev)
 380{
 381        struct hardware_path path;
 382        char name[28];
 383        char *output = name;
 384        int i;
 385
 386        get_node_path(padev->dev.parent, &path);
 387
 388        for (i = 0; i < 6; i++) {
 389                if (path.bc[i] == -1)
 390                        continue;
 391                output += sprintf(output, "%u:", (unsigned char) path.bc[i]);
 392        }
 393        sprintf(output, "%u", (unsigned char) padev->hw_path);
 394        dev_set_name(&padev->dev, name);
 395}
 396
 397struct parisc_device * __init create_tree_node(char id, struct device *parent)
 398{
 399        struct parisc_device *dev = kzalloc(sizeof(*dev), GFP_KERNEL);
 400        if (!dev)
 401                return NULL;
 402
 403        dev->hw_path = id;
 404        dev->id.hw_type = HPHW_FAULTY;
 405
 406        dev->dev.parent = parent;
 407        setup_bus_id(dev);
 408
 409        dev->dev.bus = &parisc_bus_type;
 410        dev->dma_mask = 0xffffffffUL;   /* PARISC devices are 32-bit */
 411
 412        /* make the generic dma mask a pointer to the parisc one */
 413        dev->dev.dma_mask = &dev->dma_mask;
 414        dev->dev.coherent_dma_mask = dev->dma_mask;
 415        if (device_register(&dev->dev)) {
 416                kfree(dev);
 417                return NULL;
 418        }
 419
 420        return dev;
 421}
 422
 423struct match_id_data {
 424        char id;
 425        struct parisc_device * dev;
 426};
 427
 428static int match_by_id(struct device * dev, void * data)
 429{
 430        struct parisc_device * pdev = to_parisc_device(dev);
 431        struct match_id_data * d = data;
 432
 433        if (pdev->hw_path == d->id) {
 434                d->dev = pdev;
 435                return 1;
 436        }
 437        return 0;
 438}
 439
 440/**
 441 * alloc_tree_node - returns a device entry in the iotree
 442 * @parent: the parent node in the tree
 443 * @id: the element of the module path for this entry
 444 *
 445 * Checks all the children of @parent for a matching @id.  If none
 446 * found, it allocates a new device and returns it.
 447 */
 448static struct parisc_device * __init alloc_tree_node(
 449                        struct device *parent, char id)
 450{
 451        struct match_id_data d = {
 452                .id = id,
 453        };
 454        if (device_for_each_child(parent, &d, match_by_id))
 455                return d.dev;
 456        else
 457                return create_tree_node(id, parent);
 458}
 459
 460static struct parisc_device *create_parisc_device(struct hardware_path *modpath)
 461{
 462        int i;
 463        struct device *parent = &root;
 464        for (i = 0; i < 6; i++) {
 465                if (modpath->bc[i] == -1)
 466                        continue;
 467                parent = &alloc_tree_node(parent, modpath->bc[i])->dev;
 468        }
 469        return alloc_tree_node(parent, modpath->mod);
 470}
 471
 472struct parisc_device * __init
 473alloc_pa_dev(unsigned long hpa, struct hardware_path *mod_path)
 474{
 475        int status;
 476        unsigned long bytecnt;
 477        u8 iodc_data[32];
 478        struct parisc_device *dev;
 479        const char *name;
 480
 481        /* Check to make sure this device has not already been added - Ryan */
 482        if (find_device_by_addr(hpa) != NULL)
 483                return NULL;
 484
 485        status = pdc_iodc_read(&bytecnt, hpa, 0, &iodc_data, 32);
 486        if (status != PDC_OK)
 487                return NULL;
 488
 489        dev = create_parisc_device(mod_path);
 490        if (dev->id.hw_type != HPHW_FAULTY) {
 491                pr_err("Two devices have hardware path [%s].  IODC data for second device: %7phN\n"
 492                       "Rearranging GSC cards sometimes helps\n",
 493                        parisc_pathname(dev), iodc_data);
 494                return NULL;
 495        }
 496
 497        dev->id.hw_type = iodc_data[3] & 0x1f;
 498        dev->id.hversion = (iodc_data[0] << 4) | ((iodc_data[1] & 0xf0) >> 4);
 499        dev->id.hversion_rev = iodc_data[1] & 0x0f;
 500        dev->id.sversion = ((iodc_data[4] & 0x0f) << 16) |
 501                        (iodc_data[5] << 8) | iodc_data[6];
 502        dev->hpa.name = parisc_pathname(dev);
 503        dev->hpa.start = hpa;
 504        /* This is awkward.  The STI spec says that gfx devices may occupy
 505         * 32MB or 64MB.  Unfortunately, we don't know how to tell whether
 506         * it's the former or the latter.  Assumptions either way can hurt us.
 507         */
 508        if (hpa == 0xf4000000 || hpa == 0xf8000000) {
 509                dev->hpa.end = hpa + 0x03ffffff;
 510        } else if (hpa == 0xf6000000 || hpa == 0xfa000000) {
 511                dev->hpa.end = hpa + 0x01ffffff;
 512        } else {
 513                dev->hpa.end = hpa + 0xfff;
 514        }
 515        dev->hpa.flags = IORESOURCE_MEM;
 516        name = parisc_hardware_description(&dev->id);
 517        if (name) {
 518                strlcpy(dev->name, name, sizeof(dev->name));
 519        }
 520
 521        /* Silently fail things like mouse ports which are subsumed within
 522         * the keyboard controller
 523         */
 524        if ((hpa & 0xfff) == 0 && insert_resource(&iomem_resource, &dev->hpa))
 525                pr_warn("Unable to claim HPA %lx for device %s\n", hpa, name);
 526
 527        return dev;
 528}
 529
 530static int parisc_generic_match(struct device *dev, struct device_driver *drv)
 531{
 532        return match_device(to_parisc_driver(drv), to_parisc_device(dev));
 533}
 534
 535static ssize_t make_modalias(struct device *dev, char *buf)
 536{
 537        const struct parisc_device *padev = to_parisc_device(dev);
 538        const struct parisc_device_id *id = &padev->id;
 539
 540        return sprintf(buf, "parisc:t%02Xhv%04Xrev%02Xsv%08X\n",
 541                (u8)id->hw_type, (u16)id->hversion, (u8)id->hversion_rev,
 542                (u32)id->sversion);
 543}
 544
 545static int parisc_uevent(struct device *dev, struct kobj_uevent_env *env)
 546{
 547        const struct parisc_device *padev;
 548        char modalias[40];
 549
 550        if (!dev)
 551                return -ENODEV;
 552
 553        padev = to_parisc_device(dev);
 554        if (!padev)
 555                return -ENODEV;
 556
 557        if (add_uevent_var(env, "PARISC_NAME=%s", padev->name))
 558                return -ENOMEM;
 559
 560        make_modalias(dev, modalias);
 561        if (add_uevent_var(env, "MODALIAS=%s", modalias))
 562                return -ENOMEM;
 563
 564        return 0;
 565}
 566
 567#define pa_dev_attr(name, field, format_string)                         \
 568static ssize_t name##_show(struct device *dev, struct device_attribute *attr, char *buf)                \
 569{                                                                       \
 570        struct parisc_device *padev = to_parisc_device(dev);            \
 571        return sprintf(buf, format_string, padev->field);               \
 572}                                                                       \
 573static DEVICE_ATTR_RO(name);
 574
 575#define pa_dev_attr_id(field, format) pa_dev_attr(field, id.field, format)
 576
 577pa_dev_attr(irq, irq, "%u\n");
 578pa_dev_attr_id(hw_type, "0x%02x\n");
 579pa_dev_attr(rev, id.hversion_rev, "0x%x\n");
 580pa_dev_attr_id(hversion, "0x%03x\n");
 581pa_dev_attr_id(sversion, "0x%05x\n");
 582
 583static ssize_t modalias_show(struct device *dev, struct device_attribute *attr, char *buf)
 584{
 585        return make_modalias(dev, buf);
 586}
 587static DEVICE_ATTR_RO(modalias);
 588
 589static struct attribute *parisc_device_attrs[] = {
 590        &dev_attr_irq.attr,
 591        &dev_attr_hw_type.attr,
 592        &dev_attr_rev.attr,
 593        &dev_attr_hversion.attr,
 594        &dev_attr_sversion.attr,
 595        &dev_attr_modalias.attr,
 596        NULL,
 597};
 598ATTRIBUTE_GROUPS(parisc_device);
 599
 600struct bus_type parisc_bus_type = {
 601        .name = "parisc",
 602        .match = parisc_generic_match,
 603        .uevent = parisc_uevent,
 604        .dev_groups = parisc_device_groups,
 605        .probe = parisc_driver_probe,
 606        .remove = __exit_p(parisc_driver_remove),
 607};
 608
 609/**
 610 * register_parisc_device - Locate a driver to manage this device.
 611 * @dev: The parisc device.
 612 *
 613 * Search the driver list for a driver that is willing to manage
 614 * this device.
 615 */
 616int __init register_parisc_device(struct parisc_device *dev)
 617{
 618        if (!dev)
 619                return 0;
 620
 621        if (dev->driver)
 622                return 1;
 623
 624        return 0;
 625}
 626
 627/**
 628 * match_pci_device - Matches a pci device against a given hardware path
 629 * entry.
 630 * @dev: the generic device (known to be contained by a pci_dev).
 631 * @index: the current BC index
 632 * @modpath: the hardware path.
 633 * @return: true if the device matches the hardware path.
 634 */
 635static int match_pci_device(struct device *dev, int index,
 636                struct hardware_path *modpath)
 637{
 638        struct pci_dev *pdev = to_pci_dev(dev);
 639        int id;
 640
 641        if (index == 5) {
 642                /* we are at the end of the path, and on the actual device */
 643                unsigned int devfn = pdev->devfn;
 644                return ((modpath->bc[5] == PCI_SLOT(devfn)) &&
 645                                        (modpath->mod == PCI_FUNC(devfn)));
 646        }
 647
 648        /* index might be out of bounds for bc[] */
 649        if (index >= 6)
 650                return 0;
 651
 652        id = PCI_SLOT(pdev->devfn) | (PCI_FUNC(pdev->devfn) << 5);
 653        return (modpath->bc[index] == id);
 654}
 655
 656/**
 657 * match_parisc_device - Matches a parisc device against a given hardware
 658 * path entry.
 659 * @dev: the generic device (known to be contained by a parisc_device).
 660 * @index: the current BC index
 661 * @modpath: the hardware path.
 662 * @return: true if the device matches the hardware path.
 663 */
 664static int match_parisc_device(struct device *dev, int index,
 665                struct hardware_path *modpath)
 666{
 667        struct parisc_device *curr = to_parisc_device(dev);
 668        char id = (index == 6) ? modpath->mod : modpath->bc[index];
 669
 670        return (curr->hw_path == id);
 671}
 672
 673struct parse_tree_data {
 674        int index;
 675        struct hardware_path * modpath;
 676        struct device * dev;
 677};
 678
 679static int check_parent(struct device * dev, void * data)
 680{
 681        struct parse_tree_data * d = data;
 682
 683        if (check_dev(dev)) {
 684                if (dev->bus == &parisc_bus_type) {
 685                        if (match_parisc_device(dev, d->index, d->modpath))
 686                                d->dev = dev;
 687                } else if (dev_is_pci(dev)) {
 688                        if (match_pci_device(dev, d->index, d->modpath))
 689                                d->dev = dev;
 690                } else if (dev->bus == NULL) {
 691                        /* we are on a bus bridge */
 692                        struct device *new = parse_tree_node(dev, d->index, d->modpath);
 693                        if (new)
 694                                d->dev = new;
 695                }
 696        }
 697        return d->dev != NULL;
 698}
 699
 700/**
 701 * parse_tree_node - returns a device entry in the iotree
 702 * @parent: the parent node in the tree
 703 * @index: the current BC index
 704 * @modpath: the hardware_path struct to match a device against
 705 * @return: The corresponding device if found, NULL otherwise.
 706 *
 707 * Checks all the children of @parent for a matching @id.  If none
 708 * found, it returns NULL.
 709 */
 710static struct device *
 711parse_tree_node(struct device *parent, int index, struct hardware_path *modpath)
 712{
 713        struct parse_tree_data d = {
 714                .index          = index,
 715                .modpath        = modpath,
 716        };
 717
 718        struct recurse_struct recurse_data = {
 719                .obj    = &d,
 720                .fn     = check_parent,
 721        };
 722
 723        if (device_for_each_child(parent, &recurse_data, descend_children))
 724                /* nothing */;
 725
 726        return d.dev;
 727}
 728
 729/**
 730 * hwpath_to_device - Finds the generic device corresponding to a given hardware path.
 731 * @modpath: the hardware path.
 732 * @return: The target device, NULL if not found.
 733 */
 734struct device *hwpath_to_device(struct hardware_path *modpath)
 735{
 736        int i;
 737        struct device *parent = &root;
 738        for (i = 0; i < 6; i++) {
 739                if (modpath->bc[i] == -1)
 740                        continue;
 741                parent = parse_tree_node(parent, i, modpath);
 742                if (!parent)
 743                        return NULL;
 744        }
 745        if (dev_is_pci(parent)) /* pci devices already parse MOD */
 746                return parent;
 747        else
 748                return parse_tree_node(parent, 6, modpath);
 749}
 750EXPORT_SYMBOL(hwpath_to_device);
 751
 752/**
 753 * device_to_hwpath - Populates the hwpath corresponding to the given device.
 754 * @param dev the target device
 755 * @param path pointer to a previously allocated hwpath struct to be filled in
 756 */
 757void device_to_hwpath(struct device *dev, struct hardware_path *path)
 758{
 759        struct parisc_device *padev;
 760        if (dev->bus == &parisc_bus_type) {
 761                padev = to_parisc_device(dev);
 762                get_node_path(dev->parent, path);
 763                path->mod = padev->hw_path;
 764        } else if (dev_is_pci(dev)) {
 765                get_node_path(dev, path);
 766        }
 767}
 768EXPORT_SYMBOL(device_to_hwpath);
 769
 770#define BC_PORT_MASK 0x8
 771#define BC_LOWER_PORT 0x8
 772
 773#define BUS_CONVERTER(dev) \
 774        ((dev->id.hw_type == HPHW_IOA) || (dev->id.hw_type == HPHW_BCPORT))
 775
 776#define IS_LOWER_PORT(dev) \
 777        ((gsc_readl(dev->hpa.start + offsetof(struct bc_module, io_status)) \
 778                & BC_PORT_MASK) == BC_LOWER_PORT)
 779
 780#define MAX_NATIVE_DEVICES 64
 781#define NATIVE_DEVICE_OFFSET 0x1000
 782
 783#define FLEX_MASK       F_EXTEND(0xfffc0000)
 784#define IO_IO_LOW       offsetof(struct bc_module, io_io_low)
 785#define IO_IO_HIGH      offsetof(struct bc_module, io_io_high)
 786#define READ_IO_IO_LOW(dev)  (unsigned long)(signed int)gsc_readl(dev->hpa.start + IO_IO_LOW)
 787#define READ_IO_IO_HIGH(dev) (unsigned long)(signed int)gsc_readl(dev->hpa.start + IO_IO_HIGH)
 788
 789static void walk_native_bus(unsigned long io_io_low, unsigned long io_io_high,
 790                            struct device *parent);
 791
 792static void walk_lower_bus(struct parisc_device *dev)
 793{
 794        unsigned long io_io_low, io_io_high;
 795
 796        if (!BUS_CONVERTER(dev) || IS_LOWER_PORT(dev))
 797                return;
 798
 799        if (dev->id.hw_type == HPHW_IOA) {
 800                io_io_low = (unsigned long)(signed int)(READ_IO_IO_LOW(dev) << 16);
 801                io_io_high = io_io_low + MAX_NATIVE_DEVICES * NATIVE_DEVICE_OFFSET;
 802        } else {
 803                io_io_low = (READ_IO_IO_LOW(dev) + ~FLEX_MASK) & FLEX_MASK;
 804                io_io_high = (READ_IO_IO_HIGH(dev)+ ~FLEX_MASK) & FLEX_MASK;
 805        }
 806
 807        walk_native_bus(io_io_low, io_io_high, &dev->dev);
 808}
 809
 810/**
 811 * walk_native_bus -- Probe a bus for devices
 812 * @io_io_low: Base address of this bus.
 813 * @io_io_high: Last address of this bus.
 814 * @parent: The parent bus device.
 815 * 
 816 * A native bus (eg Runway or GSC) may have up to 64 devices on it,
 817 * spaced at intervals of 0x1000 bytes.  PDC may not inform us of these
 818 * devices, so we have to probe for them.  Unfortunately, we may find
 819 * devices which are not physically connected (such as extra serial &
 820 * keyboard ports).  This problem is not yet solved.
 821 */
 822static void __init walk_native_bus(unsigned long io_io_low,
 823        unsigned long io_io_high, struct device *parent)
 824{
 825        int i, devices_found = 0;
 826        unsigned long hpa = io_io_low;
 827        struct hardware_path path;
 828
 829        get_node_path(parent, &path);
 830        do {
 831                for(i = 0; i < MAX_NATIVE_DEVICES; i++, hpa += NATIVE_DEVICE_OFFSET) {
 832                        struct parisc_device *dev;
 833
 834                        /* Was the device already added by Firmware? */
 835                        dev = find_device_by_addr(hpa);
 836                        if (!dev) {
 837                                path.mod = i;
 838                                dev = alloc_pa_dev(hpa, &path);
 839                                if (!dev)
 840                                        continue;
 841
 842                                register_parisc_device(dev);
 843                                devices_found++;
 844                        }
 845                        walk_lower_bus(dev);
 846                }
 847        } while(!devices_found && hpa < io_io_high);
 848}
 849
 850#define CENTRAL_BUS_ADDR F_EXTEND(0xfff80000)
 851
 852/**
 853 * walk_central_bus - Find devices attached to the central bus
 854 *
 855 * PDC doesn't tell us about all devices in the system.  This routine
 856 * finds devices connected to the central bus.
 857 */
 858void __init walk_central_bus(void)
 859{
 860        walk_native_bus(CENTRAL_BUS_ADDR,
 861                        CENTRAL_BUS_ADDR + (MAX_NATIVE_DEVICES * NATIVE_DEVICE_OFFSET),
 862                        &root);
 863}
 864
 865static void print_parisc_device(struct parisc_device *dev)
 866{
 867        char hw_path[64];
 868        static int count;
 869
 870        print_pa_hwpath(dev, hw_path);
 871        pr_info("%d. %s at 0x%px [%s] { %d, 0x%x, 0x%.3x, 0x%.5x }",
 872                ++count, dev->name, (void*) dev->hpa.start, hw_path, dev->id.hw_type,
 873                dev->id.hversion_rev, dev->id.hversion, dev->id.sversion);
 874
 875        if (dev->num_addrs) {
 876                int k;
 877                pr_cont(", additional addresses: ");
 878                for (k = 0; k < dev->num_addrs; k++)
 879                        pr_cont("0x%lx ", dev->addr[k]);
 880        }
 881        pr_cont("\n");
 882}
 883
 884/**
 885 * init_parisc_bus - Some preparation to be done before inventory
 886 */
 887void __init init_parisc_bus(void)
 888{
 889        if (bus_register(&parisc_bus_type))
 890                panic("Could not register PA-RISC bus type\n");
 891        if (device_register(&root))
 892                panic("Could not register PA-RISC root device\n");
 893        get_device(&root);
 894}
 895
 896static __init void qemu_header(void)
 897{
 898        int num;
 899        unsigned long *p;
 900
 901        pr_info("--- cut here ---\n");
 902        pr_info("/* AUTO-GENERATED HEADER FILE FOR SEABIOS FIRMWARE */\n");
 903        pr_cont("/* generated with Linux kernel */\n");
 904        pr_cont("/* search for PARISC_QEMU_MACHINE_HEADER in Linux */\n\n");
 905
 906        pr_info("#define PARISC_MODEL \"%s\"\n\n",
 907                        boot_cpu_data.pdc.sys_model_name);
 908
 909        pr_info("#define PARISC_PDC_MODEL 0x%lx, 0x%lx, 0x%lx, "
 910                "0x%lx, 0x%lx, 0x%lx, 0x%lx, 0x%lx, 0x%lx\n\n",
 911        #define p ((unsigned long *)&boot_cpu_data.pdc.model)
 912                p[0], p[1], p[2], p[3], p[4], p[5], p[6], p[7], p[8]);
 913        #undef p
 914
 915        pr_info("#define PARISC_PDC_VERSION 0x%04lx\n\n",
 916                        boot_cpu_data.pdc.versions);
 917
 918        pr_info("#define PARISC_PDC_CPUID 0x%04lx\n\n",
 919                        boot_cpu_data.pdc.cpuid);
 920
 921        pr_info("#define PARISC_PDC_CAPABILITIES 0x%04lx\n\n",
 922                        boot_cpu_data.pdc.capabilities);
 923
 924        pr_info("#define PARISC_PDC_ENTRY_ORG 0x%04lx\n\n",
 925#ifdef CONFIG_64BIT
 926                (unsigned long)(PAGE0->mem_pdc_hi) << 32 |
 927#endif
 928                (unsigned long)PAGE0->mem_pdc);
 929
 930        pr_info("#define PARISC_PDC_CACHE_INFO");
 931        p = (unsigned long *) &cache_info;
 932        for (num = 0; num < sizeof(cache_info); num += sizeof(unsigned long)) {
 933                if (((num % 5) == 0)) {
 934                        pr_cont(" \\\n");
 935                        pr_info("\t");
 936                }
 937                pr_cont("%s0x%04lx",
 938                        num?", ":"", *p++);
 939        }
 940        pr_cont("\n\n");
 941}
 942
 943static __init int qemu_print_hpa(struct device *lin_dev, void *data)
 944{
 945        struct parisc_device *dev = to_parisc_device(lin_dev);
 946        unsigned long hpa = dev->hpa.start;
 947
 948        pr_cont("\t{\t.hpa = 0x%08lx,\\\n", hpa);
 949        pr_cont("\t\t.iodc = &iodc_data_hpa_%08lx,\\\n", hpa);
 950        pr_cont("\t\t.mod_info = &mod_info_hpa_%08lx,\\\n", hpa);
 951        pr_cont("\t\t.mod_path = &mod_path_hpa_%08lx,\\\n", hpa);
 952        pr_cont("\t\t.num_addr = HPA_%08lx_num_addr,\\\n", hpa);
 953        pr_cont("\t\t.add_addr = { HPA_%08lx_add_addr } },\\\n", hpa);
 954        return 0;
 955}
 956
 957
 958static __init void qemu_footer(void)
 959{
 960        pr_info("\n\n#define PARISC_DEVICE_LIST \\\n");
 961        for_each_padev(qemu_print_hpa, NULL);
 962        pr_cont("\t{ 0, }\n");
 963        pr_info("--- cut here ---\n");
 964}
 965
 966/* print iodc data of the various hpa modules for qemu inclusion */
 967static __init int qemu_print_iodc_data(struct device *lin_dev, void *data)
 968{
 969        struct parisc_device *dev = to_parisc_device(lin_dev);
 970        unsigned long count;
 971        unsigned long hpa = dev->hpa.start;
 972        int status;
 973        struct pdc_iodc iodc_data;
 974
 975        int mod_index;
 976        struct pdc_system_map_mod_info pdc_mod_info;
 977        struct pdc_module_path mod_path;
 978
 979        status = pdc_iodc_read(&count, hpa, 0,
 980                &iodc_data, sizeof(iodc_data));
 981        if (status != PDC_OK) {
 982                pr_info("No IODC data for hpa 0x%08lx\n", hpa);
 983                return 0;
 984        }
 985
 986        pr_info("\n");
 987
 988        pr_info("#define HPA_%08lx_DESCRIPTION \"%s\"\n",
 989                hpa, parisc_hardware_description(&dev->id));
 990
 991        mod_index = 0;
 992        do {
 993                status = pdc_system_map_find_mods(&pdc_mod_info,
 994                                &mod_path, mod_index++);
 995        } while (status == PDC_OK && pdc_mod_info.mod_addr != hpa);
 996
 997        pr_info("static struct pdc_system_map_mod_info"
 998                " mod_info_hpa_%08lx = {\n", hpa);
 999        #define DO(member) \
1000                pr_cont("\t." #member " = 0x%x,\n", \
1001                        (unsigned int)pdc_mod_info.member)
1002        DO(mod_addr);
1003        DO(mod_pgs);
1004        DO(add_addrs);
1005        pr_cont("};\n");
1006        #undef DO
1007        pr_info("static struct pdc_module_path "
1008                "mod_path_hpa_%08lx = {\n", hpa);
1009        pr_cont("\t.path = { ");
1010        pr_cont(".flags = 0x%x, ", mod_path.path.flags);
1011        pr_cont(".bc = { 0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x }, ",
1012                (unsigned char)mod_path.path.bc[0],
1013                (unsigned char)mod_path.path.bc[1],
1014                (unsigned char)mod_path.path.bc[2],
1015                (unsigned char)mod_path.path.bc[3],
1016                (unsigned char)mod_path.path.bc[4],
1017                (unsigned char)mod_path.path.bc[5]);
1018        pr_cont(".mod = 0x%x ", mod_path.path.mod);
1019        pr_cont(" },\n");
1020        pr_cont("\t.layers = { 0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x }\n",
1021                mod_path.layers[0], mod_path.layers[1], mod_path.layers[2],
1022                mod_path.layers[3], mod_path.layers[4], mod_path.layers[5]);
1023        pr_cont("};\n");
1024
1025        pr_info("static struct pdc_iodc iodc_data_hpa_%08lx = {\n", hpa);
1026        #define DO(member) \
1027                pr_cont("\t." #member " = 0x%04lx,\n", \
1028                        (unsigned long)iodc_data.member)
1029        DO(hversion_model);
1030        DO(hversion);
1031        DO(spa);
1032        DO(type);
1033        DO(sversion_rev);
1034        DO(sversion_model);
1035        DO(sversion_opt);
1036        DO(rev);
1037        DO(dep);
1038        DO(features);
1039        DO(checksum);
1040        DO(length);
1041        #undef DO
1042        pr_cont("\t/* pad: 0x%04x, 0x%04x */\n",
1043                iodc_data.pad[0], iodc_data.pad[1]);
1044        pr_cont("};\n");
1045
1046        pr_info("#define HPA_%08lx_num_addr %d\n", hpa, dev->num_addrs);
1047        pr_info("#define HPA_%08lx_add_addr ", hpa);
1048        count = 0;
1049        if (dev->num_addrs == 0)
1050                pr_cont("0");
1051        while (count < dev->num_addrs) {
1052                pr_cont("0x%08lx, ", dev->addr[count]);
1053                count++;
1054        }
1055        pr_cont("\n\n");
1056
1057        return 0;
1058}
1059
1060
1061
1062static int print_one_device(struct device * dev, void * data)
1063{
1064        struct parisc_device * pdev = to_parisc_device(dev);
1065
1066        if (check_dev(dev))
1067                print_parisc_device(pdev);
1068        return 0;
1069}
1070
1071/**
1072 * print_parisc_devices - Print out a list of devices found in this system
1073 */
1074void __init print_parisc_devices(void)
1075{
1076        for_each_padev(print_one_device, NULL);
1077        #define PARISC_QEMU_MACHINE_HEADER 0
1078        if (PARISC_QEMU_MACHINE_HEADER) {
1079                qemu_header();
1080                for_each_padev(qemu_print_iodc_data, NULL);
1081                qemu_footer();
1082        }
1083}
1084