linux/drivers/gpu/drm/drm_pci.c
<<
>>
Prefs
   1/* drm_pci.h -- PCI DMA memory management wrappers for DRM -*- linux-c -*- */
   2/**
   3 * \file drm_pci.c
   4 * \brief Functions and ioctls to manage PCI memory
   5 *
   6 * \warning These interfaces aren't stable yet.
   7 *
   8 * \todo Implement the remaining ioctl's for the PCI pools.
   9 * \todo The wrappers here are so thin that they would be better off inlined..
  10 *
  11 * \author José Fonseca <jrfonseca@tungstengraphics.com>
  12 * \author Leif Delgass <ldelgass@retinalburn.net>
  13 */
  14
  15/*
  16 * Copyright 2003 José Fonseca.
  17 * Copyright 2003 Leif Delgass.
  18 * All Rights Reserved.
  19 *
  20 * Permission is hereby granted, free of charge, to any person obtaining a
  21 * copy of this software and associated documentation files (the "Software"),
  22 * to deal in the Software without restriction, including without limitation
  23 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
  24 * and/or sell copies of the Software, and to permit persons to whom the
  25 * Software is furnished to do so, subject to the following conditions:
  26 *
  27 * The above copyright notice and this permission notice (including the next
  28 * paragraph) shall be included in all copies or substantial portions of the
  29 * Software.
  30 *
  31 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  32 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  33 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL THE
  34 * AUTHORS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
  35 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
  36 * WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
  37 */
  38
  39#include <linux/pci.h>
  40#include <linux/slab.h>
  41#include <linux/dma-mapping.h>
  42#include <linux/export.h>
  43#include "drmP.h"
  44
  45/**********************************************************************/
  46/** \name PCI memory */
  47/*@{*/
  48
  49/**
  50 * \brief Allocate a PCI consistent memory block, for DMA.
  51 */
  52drm_dma_handle_t *drm_pci_alloc(struct drm_device * dev, size_t size, size_t align)
  53{
  54        drm_dma_handle_t *dmah;
  55#if 1
  56        unsigned long addr;
  57        size_t sz;
  58#endif
  59
  60        /* pci_alloc_consistent only guarantees alignment to the smallest
  61         * PAGE_SIZE order which is greater than or equal to the requested size.
  62         * Return NULL here for now to make sure nobody tries for larger alignment
  63         */
  64        if (align > size)
  65                return NULL;
  66
  67        dmah = kmalloc(sizeof(drm_dma_handle_t), GFP_KERNEL);
  68        if (!dmah)
  69                return NULL;
  70
  71        dmah->size = size;
  72        dmah->vaddr = dma_alloc_coherent(&dev->pdev->dev, size, &dmah->busaddr, GFP_KERNEL | __GFP_COMP);
  73
  74        if (dmah->vaddr == NULL) {
  75                kfree(dmah);
  76                return NULL;
  77        }
  78
  79        memset(dmah->vaddr, 0, size);
  80
  81        /* XXX - Is virt_to_page() legal for consistent mem? */
  82        /* Reserve */
  83        for (addr = (unsigned long)dmah->vaddr, sz = size;
  84             sz > 0; addr += PAGE_SIZE, sz -= PAGE_SIZE) {
  85                SetPageReserved(virt_to_page(addr));
  86        }
  87
  88        return dmah;
  89}
  90
  91EXPORT_SYMBOL(drm_pci_alloc);
  92
  93/**
  94 * \brief Free a PCI consistent memory block without freeing its descriptor.
  95 *
  96 * This function is for internal use in the Linux-specific DRM core code.
  97 */
  98void __drm_pci_free(struct drm_device * dev, drm_dma_handle_t * dmah)
  99{
 100#if 1
 101        unsigned long addr;
 102        size_t sz;
 103#endif
 104
 105        if (dmah->vaddr) {
 106                /* XXX - Is virt_to_page() legal for consistent mem? */
 107                /* Unreserve */
 108                for (addr = (unsigned long)dmah->vaddr, sz = dmah->size;
 109                     sz > 0; addr += PAGE_SIZE, sz -= PAGE_SIZE) {
 110                        ClearPageReserved(virt_to_page(addr));
 111                }
 112                dma_free_coherent(&dev->pdev->dev, dmah->size, dmah->vaddr,
 113                                  dmah->busaddr);
 114        }
 115}
 116
 117/**
 118 * \brief Free a PCI consistent memory block
 119 */
 120void drm_pci_free(struct drm_device * dev, drm_dma_handle_t * dmah)
 121{
 122        __drm_pci_free(dev, dmah);
 123        kfree(dmah);
 124}
 125
 126EXPORT_SYMBOL(drm_pci_free);
 127
 128#ifdef CONFIG_PCI
 129
 130static int drm_get_pci_domain(struct drm_device *dev)
 131{
 132#ifndef __alpha__
 133        /* For historical reasons, drm_get_pci_domain() is busticated
 134         * on most archs and has to remain so for userspace interface
 135         * < 1.4, except on alpha which was right from the beginning
 136         */
 137        if (dev->if_version < 0x10004)
 138                return 0;
 139#endif /* __alpha__ */
 140
 141        return pci_domain_nr(dev->pdev->bus);
 142}
 143
 144static int drm_pci_get_irq(struct drm_device *dev)
 145{
 146        return dev->pdev->irq;
 147}
 148
 149static const char *drm_pci_get_name(struct drm_device *dev)
 150{
 151        struct pci_driver *pdriver = dev->driver->kdriver.pci;
 152        return pdriver->name;
 153}
 154
 155int drm_pci_set_busid(struct drm_device *dev, struct drm_master *master)
 156{
 157        int len, ret;
 158        struct pci_driver *pdriver = dev->driver->kdriver.pci;
 159        master->unique_len = 40;
 160        master->unique_size = master->unique_len;
 161        master->unique = kmalloc(master->unique_size, GFP_KERNEL);
 162        if (master->unique == NULL)
 163                return -ENOMEM;
 164
 165
 166        len = snprintf(master->unique, master->unique_len,
 167                       "pci:%04x:%02x:%02x.%d",
 168                       drm_get_pci_domain(dev),
 169                       dev->pdev->bus->number,
 170                       PCI_SLOT(dev->pdev->devfn),
 171                       PCI_FUNC(dev->pdev->devfn));
 172
 173        if (len >= master->unique_len) {
 174                DRM_ERROR("buffer overflow");
 175                ret = -EINVAL;
 176                goto err;
 177        } else
 178                master->unique_len = len;
 179
 180        dev->devname =
 181                kmalloc(strlen(pdriver->name) +
 182                        master->unique_len + 2, GFP_KERNEL);
 183
 184        if (dev->devname == NULL) {
 185                ret = -ENOMEM;
 186                goto err;
 187        }
 188
 189        sprintf(dev->devname, "%s@%s", pdriver->name,
 190                master->unique);
 191
 192        return 0;
 193err:
 194        return ret;
 195}
 196
 197int drm_pci_set_unique(struct drm_device *dev,
 198                       struct drm_master *master,
 199                       struct drm_unique *u)
 200{
 201        int domain, bus, slot, func, ret;
 202        const char *bus_name;
 203
 204        master->unique_len = u->unique_len;
 205        master->unique_size = u->unique_len + 1;
 206        master->unique = kmalloc(master->unique_size, GFP_KERNEL);
 207        if (!master->unique) {
 208                ret = -ENOMEM;
 209                goto err;
 210        }
 211
 212        if (copy_from_user(master->unique, u->unique, master->unique_len)) {
 213                ret = -EFAULT;
 214                goto err;
 215        }
 216
 217        master->unique[master->unique_len] = '\0';
 218
 219        bus_name = dev->driver->bus->get_name(dev);
 220        dev->devname = kmalloc(strlen(bus_name) +
 221                               strlen(master->unique) + 2, GFP_KERNEL);
 222        if (!dev->devname) {
 223                ret = -ENOMEM;
 224                goto err;
 225        }
 226
 227        sprintf(dev->devname, "%s@%s", bus_name,
 228                master->unique);
 229
 230        /* Return error if the busid submitted doesn't match the device's actual
 231         * busid.
 232         */
 233        ret = sscanf(master->unique, "PCI:%d:%d:%d", &bus, &slot, &func);
 234        if (ret != 3) {
 235                ret = -EINVAL;
 236                goto err;
 237        }
 238
 239        domain = bus >> 8;
 240        bus &= 0xff;
 241
 242        if ((domain != drm_get_pci_domain(dev)) ||
 243            (bus != dev->pdev->bus->number) ||
 244            (slot != PCI_SLOT(dev->pdev->devfn)) ||
 245            (func != PCI_FUNC(dev->pdev->devfn))) {
 246                ret = -EINVAL;
 247                goto err;
 248        }
 249        return 0;
 250err:
 251        return ret;
 252}
 253
 254
 255static int drm_pci_irq_by_busid(struct drm_device *dev, struct drm_irq_busid *p)
 256{
 257        if ((p->busnum >> 8) != drm_get_pci_domain(dev) ||
 258            (p->busnum & 0xff) != dev->pdev->bus->number ||
 259            p->devnum != PCI_SLOT(dev->pdev->devfn) || p->funcnum != PCI_FUNC(dev->pdev->devfn))
 260                return -EINVAL;
 261
 262        p->irq = dev->pdev->irq;
 263
 264        DRM_DEBUG("%d:%d:%d => IRQ %d\n", p->busnum, p->devnum, p->funcnum,
 265                  p->irq);
 266        return 0;
 267}
 268
 269int drm_pci_agp_init(struct drm_device *dev)
 270{
 271        if (drm_core_has_AGP(dev)) {
 272                if (drm_pci_device_is_agp(dev))
 273                        dev->agp = drm_agp_init(dev);
 274                if (drm_core_check_feature(dev, DRIVER_REQUIRE_AGP)
 275                    && (dev->agp == NULL)) {
 276                        DRM_ERROR("Cannot initialize the agpgart module.\n");
 277                        return -EINVAL;
 278                }
 279                if (drm_core_has_MTRR(dev)) {
 280                        if (dev->agp)
 281                                dev->agp->agp_mtrr =
 282                                        mtrr_add(dev->agp->agp_info.aper_base,
 283                                                 dev->agp->agp_info.aper_size *
 284                                                 1024 * 1024, MTRR_TYPE_WRCOMB, 1);
 285                }
 286        }
 287        return 0;
 288}
 289
 290static struct drm_bus drm_pci_bus = {
 291        .bus_type = DRIVER_BUS_PCI,
 292        .get_irq = drm_pci_get_irq,
 293        .get_name = drm_pci_get_name,
 294        .set_busid = drm_pci_set_busid,
 295        .set_unique = drm_pci_set_unique,
 296        .irq_by_busid = drm_pci_irq_by_busid,
 297        .agp_init = drm_pci_agp_init,
 298};
 299
 300/**
 301 * Register.
 302 *
 303 * \param pdev - PCI device structure
 304 * \param ent entry from the PCI ID table with device type flags
 305 * \return zero on success or a negative number on failure.
 306 *
 307 * Attempt to gets inter module "drm" information. If we are first
 308 * then register the character device and inter module information.
 309 * Try and register, if we fail to register, backout previous work.
 310 */
 311int drm_get_pci_dev(struct pci_dev *pdev, const struct pci_device_id *ent,
 312                    struct drm_driver *driver)
 313{
 314        struct drm_device *dev;
 315        int ret;
 316
 317        DRM_DEBUG("\n");
 318
 319        dev = kzalloc(sizeof(*dev), GFP_KERNEL);
 320        if (!dev)
 321                return -ENOMEM;
 322
 323        ret = pci_enable_device(pdev);
 324        if (ret)
 325                goto err_g1;
 326
 327        dev->pdev = pdev;
 328        dev->dev = &pdev->dev;
 329
 330        dev->pci_device = pdev->device;
 331        dev->pci_vendor = pdev->vendor;
 332
 333#ifdef __alpha__
 334        dev->hose = pdev->sysdata;
 335#endif
 336
 337        mutex_lock(&drm_global_mutex);
 338
 339        if ((ret = drm_fill_in_dev(dev, ent, driver))) {
 340                printk(KERN_ERR "DRM: Fill_in_dev failed.\n");
 341                goto err_g2;
 342        }
 343
 344        if (drm_core_check_feature(dev, DRIVER_MODESET)) {
 345                pci_set_drvdata(pdev, dev);
 346                ret = drm_get_minor(dev, &dev->control, DRM_MINOR_CONTROL);
 347                if (ret)
 348                        goto err_g2;
 349        }
 350
 351        if ((ret = drm_get_minor(dev, &dev->primary, DRM_MINOR_LEGACY)))
 352                goto err_g3;
 353
 354        if (dev->driver->load) {
 355                ret = dev->driver->load(dev, ent->driver_data);
 356                if (ret)
 357                        goto err_g4;
 358        }
 359
 360        /* setup the grouping for the legacy output */
 361        if (drm_core_check_feature(dev, DRIVER_MODESET)) {
 362                ret = drm_mode_group_init_legacy_group(dev,
 363                                                &dev->primary->mode_group);
 364                if (ret)
 365                        goto err_g4;
 366        }
 367
 368        list_add_tail(&dev->driver_item, &driver->device_list);
 369
 370        DRM_INFO("Initialized %s %d.%d.%d %s for %s on minor %d\n",
 371                 driver->name, driver->major, driver->minor, driver->patchlevel,
 372                 driver->date, pci_name(pdev), dev->primary->index);
 373
 374        mutex_unlock(&drm_global_mutex);
 375        return 0;
 376
 377err_g4:
 378        drm_put_minor(&dev->primary);
 379err_g3:
 380        if (drm_core_check_feature(dev, DRIVER_MODESET))
 381                drm_put_minor(&dev->control);
 382err_g2:
 383        pci_disable_device(pdev);
 384err_g1:
 385        kfree(dev);
 386        mutex_unlock(&drm_global_mutex);
 387        return ret;
 388}
 389EXPORT_SYMBOL(drm_get_pci_dev);
 390
 391/**
 392 * PCI device initialization. Called direct from modules at load time.
 393 *
 394 * \return zero on success or a negative number on failure.
 395 *
 396 * Initializes a drm_device structures,registering the
 397 * stubs and initializing the AGP device.
 398 *
 399 * Expands the \c DRIVER_PREINIT and \c DRIVER_POST_INIT macros before and
 400 * after the initialization for driver customization.
 401 */
 402int drm_pci_init(struct drm_driver *driver, struct pci_driver *pdriver)
 403{
 404        struct pci_dev *pdev = NULL;
 405        const struct pci_device_id *pid;
 406        int i;
 407
 408        DRM_DEBUG("\n");
 409
 410        INIT_LIST_HEAD(&driver->device_list);
 411        driver->kdriver.pci = pdriver;
 412        driver->bus = &drm_pci_bus;
 413
 414        if (driver->driver_features & DRIVER_MODESET)
 415                return pci_register_driver(pdriver);
 416
 417        /* If not using KMS, fall back to stealth mode manual scanning. */
 418        for (i = 0; pdriver->id_table[i].vendor != 0; i++) {
 419                pid = &pdriver->id_table[i];
 420
 421                /* Loop around setting up a DRM device for each PCI device
 422                 * matching our ID and device class.  If we had the internal
 423                 * function that pci_get_subsys and pci_get_class used, we'd
 424                 * be able to just pass pid in instead of doing a two-stage
 425                 * thing.
 426                 */
 427                pdev = NULL;
 428                while ((pdev =
 429                        pci_get_subsys(pid->vendor, pid->device, pid->subvendor,
 430                                       pid->subdevice, pdev)) != NULL) {
 431                        if ((pdev->class & pid->class_mask) != pid->class)
 432                                continue;
 433
 434                        /* stealth mode requires a manual probe */
 435                        pci_dev_get(pdev);
 436                        drm_get_pci_dev(pdev, pid, driver);
 437                }
 438        }
 439        return 0;
 440}
 441
 442#else
 443
 444int drm_pci_init(struct drm_driver *driver, struct pci_driver *pdriver)
 445{
 446        return -1;
 447}
 448
 449#endif
 450
 451EXPORT_SYMBOL(drm_pci_init);
 452
 453/*@}*/
 454void drm_pci_exit(struct drm_driver *driver, struct pci_driver *pdriver)
 455{
 456        struct drm_device *dev, *tmp;
 457        DRM_DEBUG("\n");
 458
 459        if (driver->driver_features & DRIVER_MODESET) {
 460                pci_unregister_driver(pdriver);
 461        } else {
 462                list_for_each_entry_safe(dev, tmp, &driver->device_list, driver_item)
 463                        drm_put_dev(dev);
 464        }
 465        DRM_INFO("Module unloaded\n");
 466}
 467EXPORT_SYMBOL(drm_pci_exit);
 468