diff options
Diffstat (limited to 'drivers')
152 files changed, 3565 insertions, 4899 deletions
diff --git a/drivers/Kconfig b/drivers/Kconfig index 9f5c0da57c90..5c91d6afb117 100644 --- a/drivers/Kconfig +++ b/drivers/Kconfig | |||
| @@ -64,6 +64,8 @@ source "drivers/usb/Kconfig" | |||
| 64 | 64 | ||
| 65 | source "drivers/mmc/Kconfig" | 65 | source "drivers/mmc/Kconfig" |
| 66 | 66 | ||
| 67 | source "drivers/leds/Kconfig" | ||
| 68 | |||
| 67 | source "drivers/infiniband/Kconfig" | 69 | source "drivers/infiniband/Kconfig" |
| 68 | 70 | ||
| 69 | source "drivers/sn/Kconfig" | 71 | source "drivers/sn/Kconfig" |
diff --git a/drivers/Makefile b/drivers/Makefile index 424955274e60..d6e8ffbd8132 100644 --- a/drivers/Makefile +++ b/drivers/Makefile | |||
| @@ -69,6 +69,7 @@ obj-$(CONFIG_MCA) += mca/ | |||
| 69 | obj-$(CONFIG_EISA) += eisa/ | 69 | obj-$(CONFIG_EISA) += eisa/ |
| 70 | obj-$(CONFIG_CPU_FREQ) += cpufreq/ | 70 | obj-$(CONFIG_CPU_FREQ) += cpufreq/ |
| 71 | obj-$(CONFIG_MMC) += mmc/ | 71 | obj-$(CONFIG_MMC) += mmc/ |
| 72 | obj-$(CONFIG_NEW_LEDS) += leds/ | ||
| 72 | obj-$(CONFIG_INFINIBAND) += infiniband/ | 73 | obj-$(CONFIG_INFINIBAND) += infiniband/ |
| 73 | obj-$(CONFIG_SGI_SN) += sn/ | 74 | obj-$(CONFIG_SGI_SN) += sn/ |
| 74 | obj-y += firmware/ | 75 | obj-y += firmware/ |
diff --git a/drivers/acpi/ec.c b/drivers/acpi/ec.c index 79b09d76c180..eee0864ba300 100644 --- a/drivers/acpi/ec.c +++ b/drivers/acpi/ec.c | |||
| @@ -1572,7 +1572,7 @@ static void __exit acpi_ec_exit(void) | |||
| 1572 | static int __init acpi_fake_ecdt_setup(char *str) | 1572 | static int __init acpi_fake_ecdt_setup(char *str) |
| 1573 | { | 1573 | { |
| 1574 | acpi_fake_ecdt_enabled = 1; | 1574 | acpi_fake_ecdt_enabled = 1; |
| 1575 | return 0; | 1575 | return 1; |
| 1576 | } | 1576 | } |
| 1577 | 1577 | ||
| 1578 | __setup("acpi_fake_ecdt", acpi_fake_ecdt_setup); | 1578 | __setup("acpi_fake_ecdt", acpi_fake_ecdt_setup); |
| @@ -1591,7 +1591,7 @@ static int __init acpi_ec_set_intr_mode(char *str) | |||
| 1591 | acpi_ec_driver.ops.add = acpi_ec_poll_add; | 1591 | acpi_ec_driver.ops.add = acpi_ec_poll_add; |
| 1592 | } | 1592 | } |
| 1593 | printk(KERN_INFO PREFIX "EC %s mode.\n", intr ? "interrupt" : "polling"); | 1593 | printk(KERN_INFO PREFIX "EC %s mode.\n", intr ? "interrupt" : "polling"); |
| 1594 | return 0; | 1594 | return 1; |
| 1595 | } | 1595 | } |
| 1596 | 1596 | ||
| 1597 | __setup("ec_intr=", acpi_ec_set_intr_mode); | 1597 | __setup("ec_intr=", acpi_ec_set_intr_mode); |
diff --git a/drivers/block/amiflop.c b/drivers/block/amiflop.c index b6e290956214..2a8af685926f 100644 --- a/drivers/block/amiflop.c +++ b/drivers/block/amiflop.c | |||
| @@ -1850,6 +1850,7 @@ static int __init amiga_floppy_setup (char *str) | |||
| 1850 | return 0; | 1850 | return 0; |
| 1851 | printk (KERN_INFO "amiflop: Setting default df0 to %x\n", n); | 1851 | printk (KERN_INFO "amiflop: Setting default df0 to %x\n", n); |
| 1852 | fd_def_df0 = n; | 1852 | fd_def_df0 = n; |
| 1853 | return 1; | ||
| 1853 | } | 1854 | } |
| 1854 | 1855 | ||
| 1855 | __setup("floppy=", amiga_floppy_setup); | 1856 | __setup("floppy=", amiga_floppy_setup); |
diff --git a/drivers/char/drm/drmP.h b/drivers/char/drm/drmP.h index 107df9fdba4e..edc72a6348a7 100644 --- a/drivers/char/drm/drmP.h +++ b/drivers/char/drm/drmP.h | |||
| @@ -357,6 +357,12 @@ typedef struct drm_freelist { | |||
| 357 | spinlock_t lock; | 357 | spinlock_t lock; |
| 358 | } drm_freelist_t; | 358 | } drm_freelist_t; |
| 359 | 359 | ||
| 360 | typedef struct drm_dma_handle { | ||
| 361 | dma_addr_t busaddr; | ||
| 362 | void *vaddr; | ||
| 363 | size_t size; | ||
| 364 | } drm_dma_handle_t; | ||
| 365 | |||
| 360 | /** | 366 | /** |
| 361 | * Buffer entry. There is one of this for each buffer size order. | 367 | * Buffer entry. There is one of this for each buffer size order. |
| 362 | */ | 368 | */ |
| @@ -366,7 +372,7 @@ typedef struct drm_buf_entry { | |||
| 366 | drm_buf_t *buflist; /**< buffer list */ | 372 | drm_buf_t *buflist; /**< buffer list */ |
| 367 | int seg_count; | 373 | int seg_count; |
| 368 | int page_order; | 374 | int page_order; |
| 369 | unsigned long *seglist; | 375 | drm_dma_handle_t **seglist; |
| 370 | 376 | ||
| 371 | drm_freelist_t freelist; | 377 | drm_freelist_t freelist; |
| 372 | } drm_buf_entry_t; | 378 | } drm_buf_entry_t; |
| @@ -483,12 +489,6 @@ typedef struct drm_sigdata { | |||
| 483 | drm_hw_lock_t *lock; | 489 | drm_hw_lock_t *lock; |
| 484 | } drm_sigdata_t; | 490 | } drm_sigdata_t; |
| 485 | 491 | ||
| 486 | typedef struct drm_dma_handle { | ||
| 487 | dma_addr_t busaddr; | ||
| 488 | void *vaddr; | ||
| 489 | size_t size; | ||
| 490 | } drm_dma_handle_t; | ||
| 491 | |||
| 492 | /** | 492 | /** |
| 493 | * Mappings list | 493 | * Mappings list |
| 494 | */ | 494 | */ |
| @@ -813,8 +813,6 @@ extern void drm_mem_init(void); | |||
| 813 | extern int drm_mem_info(char *buf, char **start, off_t offset, | 813 | extern int drm_mem_info(char *buf, char **start, off_t offset, |
| 814 | int request, int *eof, void *data); | 814 | int request, int *eof, void *data); |
| 815 | extern void *drm_realloc(void *oldpt, size_t oldsize, size_t size, int area); | 815 | extern void *drm_realloc(void *oldpt, size_t oldsize, size_t size, int area); |
| 816 | extern unsigned long drm_alloc_pages(int order, int area); | ||
| 817 | extern void drm_free_pages(unsigned long address, int order, int area); | ||
| 818 | extern void *drm_ioremap(unsigned long offset, unsigned long size, | 816 | extern void *drm_ioremap(unsigned long offset, unsigned long size, |
| 819 | drm_device_t * dev); | 817 | drm_device_t * dev); |
| 820 | extern void *drm_ioremap_nocache(unsigned long offset, unsigned long size, | 818 | extern void *drm_ioremap_nocache(unsigned long offset, unsigned long size, |
diff --git a/drivers/char/drm/drm_bufs.c b/drivers/char/drm/drm_bufs.c index e2637b4d51de..8a9cf12e6183 100644 --- a/drivers/char/drm/drm_bufs.c +++ b/drivers/char/drm/drm_bufs.c | |||
| @@ -474,8 +474,7 @@ static void drm_cleanup_buf_error(drm_device_t * dev, drm_buf_entry_t * entry) | |||
| 474 | if (entry->seg_count) { | 474 | if (entry->seg_count) { |
| 475 | for (i = 0; i < entry->seg_count; i++) { | 475 | for (i = 0; i < entry->seg_count; i++) { |
| 476 | if (entry->seglist[i]) { | 476 | if (entry->seglist[i]) { |
| 477 | drm_free_pages(entry->seglist[i], | 477 | drm_pci_free(dev, entry->seglist[i]); |
| 478 | entry->page_order, DRM_MEM_DMA); | ||
| 479 | } | 478 | } |
| 480 | } | 479 | } |
| 481 | drm_free(entry->seglist, | 480 | drm_free(entry->seglist, |
| @@ -678,7 +677,7 @@ int drm_addbufs_pci(drm_device_t * dev, drm_buf_desc_t * request) | |||
| 678 | int total; | 677 | int total; |
| 679 | int page_order; | 678 | int page_order; |
| 680 | drm_buf_entry_t *entry; | 679 | drm_buf_entry_t *entry; |
| 681 | unsigned long page; | 680 | drm_dma_handle_t *dmah; |
| 682 | drm_buf_t *buf; | 681 | drm_buf_t *buf; |
| 683 | int alignment; | 682 | int alignment; |
| 684 | unsigned long offset; | 683 | unsigned long offset; |
| @@ -781,8 +780,10 @@ int drm_addbufs_pci(drm_device_t * dev, drm_buf_desc_t * request) | |||
| 781 | page_count = 0; | 780 | page_count = 0; |
| 782 | 781 | ||
| 783 | while (entry->buf_count < count) { | 782 | while (entry->buf_count < count) { |
| 784 | page = drm_alloc_pages(page_order, DRM_MEM_DMA); | 783 | |
| 785 | if (!page) { | 784 | dmah = drm_pci_alloc(dev, PAGE_SIZE << page_order, 0x1000, 0xfffffffful); |
| 785 | |||
| 786 | if (!dmah) { | ||
| 786 | /* Set count correctly so we free the proper amount. */ | 787 | /* Set count correctly so we free the proper amount. */ |
| 787 | entry->buf_count = count; | 788 | entry->buf_count = count; |
| 788 | entry->seg_count = count; | 789 | entry->seg_count = count; |
| @@ -794,13 +795,13 @@ int drm_addbufs_pci(drm_device_t * dev, drm_buf_desc_t * request) | |||
| 794 | atomic_dec(&dev->buf_alloc); | 795 | atomic_dec(&dev->buf_alloc); |
| 795 | return -ENOMEM; | 796 | return -ENOMEM; |
| 796 | } | 797 | } |
| 797 | entry->seglist[entry->seg_count++] = page; | 798 | entry->seglist[entry->seg_count++] = dmah; |
| 798 | for (i = 0; i < (1 << page_order); i++) { | 799 | for (i = 0; i < (1 << page_order); i++) { |
| 799 | DRM_DEBUG("page %d @ 0x%08lx\n", | 800 | DRM_DEBUG("page %d @ 0x%08lx\n", |
| 800 | dma->page_count + page_count, | 801 | dma->page_count + page_count, |
| 801 | page + PAGE_SIZE * i); | 802 | (unsigned long)dmah->vaddr + PAGE_SIZE * i); |
| 802 | temp_pagelist[dma->page_count + page_count++] | 803 | temp_pagelist[dma->page_count + page_count++] |
| 803 | = page + PAGE_SIZE * i; | 804 | = (unsigned long)dmah->vaddr + PAGE_SIZE * i; |
| 804 | } | 805 | } |
| 805 | for (offset = 0; | 806 | for (offset = 0; |
| 806 | offset + size <= total && entry->buf_count < count; | 807 | offset + size <= total && entry->buf_count < count; |
| @@ -811,7 +812,8 @@ int drm_addbufs_pci(drm_device_t * dev, drm_buf_desc_t * request) | |||
| 811 | buf->order = order; | 812 | buf->order = order; |
| 812 | buf->used = 0; | 813 | buf->used = 0; |
| 813 | buf->offset = (dma->byte_count + byte_count + offset); | 814 | buf->offset = (dma->byte_count + byte_count + offset); |
| 814 | buf->address = (void *)(page + offset); | 815 | buf->address = (void *)(dmah->vaddr + offset); |
| 816 | buf->bus_address = dmah->busaddr + offset; | ||
| 815 | buf->next = NULL; | 817 | buf->next = NULL; |
| 816 | buf->waiting = 0; | 818 | buf->waiting = 0; |
| 817 | buf->pending = 0; | 819 | buf->pending = 0; |
diff --git a/drivers/char/drm/drm_dma.c b/drivers/char/drm/drm_dma.c index 2afab95ca036..892db7096986 100644 --- a/drivers/char/drm/drm_dma.c +++ b/drivers/char/drm/drm_dma.c | |||
| @@ -85,9 +85,7 @@ void drm_dma_takedown(drm_device_t * dev) | |||
| 85 | dma->bufs[i].seg_count); | 85 | dma->bufs[i].seg_count); |
| 86 | for (j = 0; j < dma->bufs[i].seg_count; j++) { | 86 | for (j = 0; j < dma->bufs[i].seg_count; j++) { |
| 87 | if (dma->bufs[i].seglist[j]) { | 87 | if (dma->bufs[i].seglist[j]) { |
| 88 | drm_free_pages(dma->bufs[i].seglist[j], | 88 | drm_pci_free(dev, dma->bufs[i].seglist[j]); |
| 89 | dma->bufs[i].page_order, | ||
| 90 | DRM_MEM_DMA); | ||
| 91 | } | 89 | } |
| 92 | } | 90 | } |
| 93 | drm_free(dma->bufs[i].seglist, | 91 | drm_free(dma->bufs[i].seglist, |
diff --git a/drivers/char/drm/drm_memory.c b/drivers/char/drm/drm_memory.c index 8074771e348f..dddf8de66143 100644 --- a/drivers/char/drm/drm_memory.c +++ b/drivers/char/drm/drm_memory.c | |||
| @@ -79,65 +79,6 @@ void *drm_realloc(void *oldpt, size_t oldsize, size_t size, int area) | |||
| 79 | return pt; | 79 | return pt; |
| 80 | } | 80 | } |
| 81 | 81 | ||
| 82 | /** | ||
| 83 | * Allocate pages. | ||
| 84 | * | ||
| 85 | * \param order size order. | ||
| 86 | * \param area memory area. (Not used.) | ||
| 87 | * \return page address on success, or zero on failure. | ||
| 88 | * | ||
| 89 | * Allocate and reserve free pages. | ||
| 90 | */ | ||
| 91 | unsigned long drm_alloc_pages(int order, int area) | ||
| 92 | { | ||
| 93 | unsigned long address; | ||
| 94 | unsigned long bytes = PAGE_SIZE << order; | ||
| 95 | unsigned long addr; | ||
| 96 | unsigned int sz; | ||
| 97 | |||
| 98 | address = __get_free_pages(GFP_KERNEL|__GFP_COMP, order); | ||
| 99 | if (!address) | ||
| 100 | return 0; | ||
| 101 | |||
| 102 | /* Zero */ | ||
| 103 | memset((void *)address, 0, bytes); | ||
| 104 | |||
| 105 | /* Reserve */ | ||
| 106 | for (addr = address, sz = bytes; | ||
| 107 | sz > 0; addr += PAGE_SIZE, sz -= PAGE_SIZE) { | ||
| 108 | SetPageReserved(virt_to_page(addr)); | ||
| 109 | } | ||
| 110 | |||
| 111 | return address; | ||
| 112 | } | ||
| 113 | |||
| 114 | /** | ||
| 115 | * Free pages. | ||
| 116 | * | ||
| 117 | * \param address address of the pages to free. | ||
| 118 | * \param order size order. | ||
| 119 | * \param area memory area. (Not used.) | ||
| 120 | * | ||
| 121 | * Unreserve and free pages allocated by alloc_pages(). | ||
| 122 | */ | ||
| 123 | void drm_free_pages(unsigned long address, int order, int area) | ||
| 124 | { | ||
| 125 | unsigned long bytes = PAGE_SIZE << order; | ||
| 126 | unsigned long addr; | ||
| 127 | unsigned int sz; | ||
| 128 | |||
| 129 | if (!address) | ||
| 130 | return; | ||
| 131 | |||
| 132 | /* Unreserve */ | ||
| 133 | for (addr = address, sz = bytes; | ||
| 134 | sz > 0; addr += PAGE_SIZE, sz -= PAGE_SIZE) { | ||
| 135 | ClearPageReserved(virt_to_page(addr)); | ||
| 136 | } | ||
| 137 | |||
| 138 | free_pages(address, order); | ||
| 139 | } | ||
| 140 | |||
| 141 | #if __OS_HAS_AGP | 82 | #if __OS_HAS_AGP |
| 142 | /** Wrapper around agp_allocate_memory() */ | 83 | /** Wrapper around agp_allocate_memory() */ |
| 143 | DRM_AGP_MEM *drm_alloc_agp(drm_device_t * dev, int pages, u32 type) | 84 | DRM_AGP_MEM *drm_alloc_agp(drm_device_t * dev, int pages, u32 type) |
diff --git a/drivers/char/drm/drm_memory_debug.h b/drivers/char/drm/drm_memory_debug.h index e84605fc54af..7868341817da 100644 --- a/drivers/char/drm/drm_memory_debug.h +++ b/drivers/char/drm/drm_memory_debug.h | |||
| @@ -206,76 +206,6 @@ void drm_free (void *pt, size_t size, int area) { | |||
| 206 | } | 206 | } |
| 207 | } | 207 | } |
| 208 | 208 | ||
| 209 | unsigned long drm_alloc_pages (int order, int area) { | ||
| 210 | unsigned long address; | ||
| 211 | unsigned long bytes = PAGE_SIZE << order; | ||
| 212 | unsigned long addr; | ||
| 213 | unsigned int sz; | ||
| 214 | |||
| 215 | spin_lock(&drm_mem_lock); | ||
| 216 | if ((drm_ram_used >> PAGE_SHIFT) | ||
| 217 | > (DRM_RAM_PERCENT * drm_ram_available) / 100) { | ||
| 218 | spin_unlock(&drm_mem_lock); | ||
| 219 | return 0; | ||
| 220 | } | ||
| 221 | spin_unlock(&drm_mem_lock); | ||
| 222 | |||
| 223 | address = __get_free_pages(GFP_KERNEL|__GFP_COMP, order); | ||
| 224 | if (!address) { | ||
| 225 | spin_lock(&drm_mem_lock); | ||
| 226 | ++drm_mem_stats[area].fail_count; | ||
| 227 | spin_unlock(&drm_mem_lock); | ||
| 228 | return 0; | ||
| 229 | } | ||
| 230 | spin_lock(&drm_mem_lock); | ||
| 231 | ++drm_mem_stats[area].succeed_count; | ||
| 232 | drm_mem_stats[area].bytes_allocated += bytes; | ||
| 233 | drm_ram_used += bytes; | ||
| 234 | spin_unlock(&drm_mem_lock); | ||
| 235 | |||
| 236 | /* Zero outside the lock */ | ||
| 237 | memset((void *)address, 0, bytes); | ||
| 238 | |||
| 239 | /* Reserve */ | ||
| 240 | for (addr = address, sz = bytes; | ||
| 241 | sz > 0; addr += PAGE_SIZE, sz -= PAGE_SIZE) { | ||
| 242 | SetPageReserved(virt_to_page(addr)); | ||
| 243 | } | ||
| 244 | |||
| 245 | return address; | ||
| 246 | } | ||
| 247 | |||
| 248 | void drm_free_pages (unsigned long address, int order, int area) { | ||
| 249 | unsigned long bytes = PAGE_SIZE << order; | ||
| 250 | int alloc_count; | ||
| 251 | int free_count; | ||
| 252 | unsigned long addr; | ||
| 253 | unsigned int sz; | ||
| 254 | |||
| 255 | if (!address) { | ||
| 256 | DRM_MEM_ERROR(area, "Attempt to free address 0\n"); | ||
| 257 | } else { | ||
| 258 | /* Unreserve */ | ||
| 259 | for (addr = address, sz = bytes; | ||
| 260 | sz > 0; addr += PAGE_SIZE, sz -= PAGE_SIZE) { | ||
| 261 | ClearPageReserved(virt_to_page(addr)); | ||
| 262 | } | ||
| 263 | free_pages(address, order); | ||
| 264 | } | ||
| 265 | |||
| 266 | spin_lock(&drm_mem_lock); | ||
| 267 | free_count = ++drm_mem_stats[area].free_count; | ||
| 268 | alloc_count = drm_mem_stats[area].succeed_count; | ||
| 269 | drm_mem_stats[area].bytes_freed += bytes; | ||
| 270 | drm_ram_used -= bytes; | ||
| 271 | spin_unlock(&drm_mem_lock); | ||
| 272 | if (free_count > alloc_count) { | ||
| 273 | DRM_MEM_ERROR(area, | ||
| 274 | "Excess frees: %d frees, %d allocs\n", | ||
| 275 | free_count, alloc_count); | ||
| 276 | } | ||
| 277 | } | ||
| 278 | |||
| 279 | void *drm_ioremap (unsigned long offset, unsigned long size, | 209 | void *drm_ioremap (unsigned long offset, unsigned long size, |
| 280 | drm_device_t * dev) { | 210 | drm_device_t * dev) { |
| 281 | void *pt; | 211 | void *pt; |
diff --git a/drivers/char/drm/drm_pci.c b/drivers/char/drm/drm_pci.c index 1fd7ff164817..b28ca9cea8a2 100644 --- a/drivers/char/drm/drm_pci.c +++ b/drivers/char/drm/drm_pci.c | |||
| @@ -50,6 +50,10 @@ drm_dma_handle_t *drm_pci_alloc(drm_device_t * dev, size_t size, size_t align, | |||
| 50 | dma_addr_t maxaddr) | 50 | dma_addr_t maxaddr) |
| 51 | { | 51 | { |
| 52 | drm_dma_handle_t *dmah; | 52 | drm_dma_handle_t *dmah; |
| 53 | #if 1 | ||
| 54 | unsigned long addr; | ||
| 55 | size_t sz; | ||
| 56 | #endif | ||
| 53 | #ifdef DRM_DEBUG_MEMORY | 57 | #ifdef DRM_DEBUG_MEMORY |
| 54 | int area = DRM_MEM_DMA; | 58 | int area = DRM_MEM_DMA; |
| 55 | 59 | ||
| @@ -79,7 +83,7 @@ drm_dma_handle_t *drm_pci_alloc(drm_device_t * dev, size_t size, size_t align, | |||
| 79 | return NULL; | 83 | return NULL; |
| 80 | 84 | ||
| 81 | dmah->size = size; | 85 | dmah->size = size; |
| 82 | dmah->vaddr = pci_alloc_consistent(dev->pdev, size, &dmah->busaddr); | 86 | dmah->vaddr = dma_alloc_coherent(&dev->pdev->dev, size, &dmah->busaddr, GFP_KERNEL | __GFP_COMP); |
| 83 | 87 | ||
| 84 | #ifdef DRM_DEBUG_MEMORY | 88 | #ifdef DRM_DEBUG_MEMORY |
| 85 | if (dmah->vaddr == NULL) { | 89 | if (dmah->vaddr == NULL) { |
| @@ -104,18 +108,29 @@ drm_dma_handle_t *drm_pci_alloc(drm_device_t * dev, size_t size, size_t align, | |||
| 104 | 108 | ||
| 105 | memset(dmah->vaddr, 0, size); | 109 | memset(dmah->vaddr, 0, size); |
| 106 | 110 | ||
| 111 | /* XXX - Is virt_to_page() legal for consistent mem? */ | ||
| 112 | /* Reserve */ | ||
| 113 | for (addr = (unsigned long)dmah->vaddr, sz = size; | ||
| 114 | sz > 0; addr += PAGE_SIZE, sz -= PAGE_SIZE) { | ||
| 115 | SetPageReserved(virt_to_page(addr)); | ||
| 116 | } | ||
| 117 | |||
| 107 | return dmah; | 118 | return dmah; |
| 108 | } | 119 | } |
| 109 | 120 | ||
| 110 | EXPORT_SYMBOL(drm_pci_alloc); | 121 | EXPORT_SYMBOL(drm_pci_alloc); |
| 111 | 122 | ||
| 112 | /** | 123 | /** |
| 113 | * \brief Free a PCI consistent memory block with freeing its descriptor. | 124 | * \brief Free a PCI consistent memory block without freeing its descriptor. |
| 114 | * | 125 | * |
| 115 | * This function is for internal use in the Linux-specific DRM core code. | 126 | * This function is for internal use in the Linux-specific DRM core code. |
| 116 | */ | 127 | */ |
| 117 | void __drm_pci_free(drm_device_t * dev, drm_dma_handle_t * dmah) | 128 | void __drm_pci_free(drm_device_t * dev, drm_dma_handle_t * dmah) |
| 118 | { | 129 | { |
| 130 | #if 1 | ||
| 131 | unsigned long addr; | ||
| 132 | size_t sz; | ||
| 133 | #endif | ||
| 119 | #ifdef DRM_DEBUG_MEMORY | 134 | #ifdef DRM_DEBUG_MEMORY |
| 120 | int area = DRM_MEM_DMA; | 135 | int area = DRM_MEM_DMA; |
| 121 | int alloc_count; | 136 | int alloc_count; |
| @@ -127,8 +142,14 @@ void __drm_pci_free(drm_device_t * dev, drm_dma_handle_t * dmah) | |||
| 127 | DRM_MEM_ERROR(area, "Attempt to free address 0\n"); | 142 | DRM_MEM_ERROR(area, "Attempt to free address 0\n"); |
| 128 | #endif | 143 | #endif |
| 129 | } else { | 144 | } else { |
| 130 | pci_free_consistent(dev->pdev, dmah->size, dmah->vaddr, | 145 | /* XXX - Is virt_to_page() legal for consistent mem? */ |
| 131 | dmah->busaddr); | 146 | /* Unreserve */ |
| 147 | for (addr = (unsigned long)dmah->vaddr, sz = dmah->size; | ||
| 148 | sz > 0; addr += PAGE_SIZE, sz -= PAGE_SIZE) { | ||
| 149 | ClearPageReserved(virt_to_page(addr)); | ||
| 150 | } | ||
| 151 | dma_free_coherent(&dev->pdev->dev, dmah->size, dmah->vaddr, | ||
| 152 | dmah->busaddr); | ||
| 132 | } | 153 | } |
| 133 | 154 | ||
| 134 | #ifdef DRM_DEBUG_MEMORY | 155 | #ifdef DRM_DEBUG_MEMORY |
diff --git a/drivers/char/drm/drm_pciids.h b/drivers/char/drm/drm_pciids.h index 2c17e88a8847..b1bb3c7b568d 100644 --- a/drivers/char/drm/drm_pciids.h +++ b/drivers/char/drm/drm_pciids.h | |||
| @@ -3,49 +3,69 @@ | |||
| 3 | Please contact dri-devel@lists.sf.net to add new cards to this list | 3 | Please contact dri-devel@lists.sf.net to add new cards to this list |
| 4 | */ | 4 | */ |
| 5 | #define radeon_PCI_IDS \ | 5 | #define radeon_PCI_IDS \ |
| 6 | {0x1002, 0x3150, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV350},\ | 6 | {0x1002, 0x3150, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV380|CHIP_IS_MOBILITY}, \ |
| 7 | {0x1002, 0x3152, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV380|CHIP_IS_MOBILITY|CHIP_NEW_MEMMAP}, \ | ||
| 8 | {0x1002, 0x3154, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV380|CHIP_IS_MOBILITY|CHIP_NEW_MEMMAP}, \ | ||
| 9 | {0x1002, 0x3E50, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV380|CHIP_NEW_MEMMAP}, \ | ||
| 10 | {0x1002, 0x3E54, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV380|CHIP_NEW_MEMMAP}, \ | ||
| 7 | {0x1002, 0x4136, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RS100|CHIP_IS_IGP}, \ | 11 | {0x1002, 0x4136, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RS100|CHIP_IS_IGP}, \ |
| 8 | {0x1002, 0x4137, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RS200|CHIP_IS_IGP}, \ | 12 | {0x1002, 0x4137, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RS200|CHIP_IS_IGP}, \ |
| 9 | {0x1002, 0x4144, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R300}, \ | 13 | {0x1002, 0x4144, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R300}, \ |
| 10 | {0x1002, 0x4145, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R300}, \ | 14 | {0x1002, 0x4145, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R300}, \ |
| 11 | {0x1002, 0x4146, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R300}, \ | 15 | {0x1002, 0x4146, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R300}, \ |
| 12 | {0x1002, 0x4147, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R300}, \ | 16 | {0x1002, 0x4147, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R300}, \ |
| 17 | {0x1002, 0x4148, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R350}, \ | ||
| 18 | {0x1002, 0x4149, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R350}, \ | ||
| 19 | {0x1002, 0x414A, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R350}, \ | ||
| 20 | {0x1002, 0x414B, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R350}, \ | ||
| 13 | {0x1002, 0x4150, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV350}, \ | 21 | {0x1002, 0x4150, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV350}, \ |
| 14 | {0x1002, 0x4151, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV350}, \ | 22 | {0x1002, 0x4151, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV350}, \ |
| 15 | {0x1002, 0x4152, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV350}, \ | 23 | {0x1002, 0x4152, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV350}, \ |
| 16 | {0x1002, 0x4153, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV350}, \ | 24 | {0x1002, 0x4153, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV350}, \ |
| 17 | {0x1002, 0x4154, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV350}, \ | 25 | {0x1002, 0x4154, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV350}, \ |
| 26 | {0x1002, 0x4155, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV350}, \ | ||
| 18 | {0x1002, 0x4156, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV350}, \ | 27 | {0x1002, 0x4156, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV350}, \ |
| 19 | {0x1002, 0x4237, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RS250|CHIP_IS_IGP}, \ | 28 | {0x1002, 0x4237, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RS200|CHIP_IS_IGP}, \ |
| 20 | {0x1002, 0x4242, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R200}, \ | 29 | {0x1002, 0x4242, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R200}, \ |
| 21 | {0x1002, 0x4243, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R200}, \ | 30 | {0x1002, 0x4243, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R200}, \ |
| 22 | {0x1002, 0x4336, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RS100|CHIP_IS_IGP|CHIP_IS_MOBILITY}, \ | 31 | {0x1002, 0x4336, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RS100|CHIP_IS_IGP|CHIP_IS_MOBILITY}, \ |
| 23 | {0x1002, 0x4337, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RS200|CHIP_IS_IGP|CHIP_IS_MOBILITY}, \ | 32 | {0x1002, 0x4337, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RS200|CHIP_IS_IGP|CHIP_IS_MOBILITY}, \ |
| 24 | {0x1002, 0x4437, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RS250|CHIP_IS_IGP|CHIP_IS_MOBILITY}, \ | 33 | {0x1002, 0x4437, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RS200|CHIP_IS_IGP|CHIP_IS_MOBILITY}, \ |
| 25 | {0x1002, 0x4964, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R250}, \ | 34 | {0x1002, 0x4966, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV250}, \ |
| 26 | {0x1002, 0x4965, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R250}, \ | 35 | {0x1002, 0x4967, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV250}, \ |
| 27 | {0x1002, 0x4966, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R250}, \ | 36 | {0x1002, 0x4A48, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_NEW_MEMMAP}, \ |
| 28 | {0x1002, 0x4967, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R250}, \ | 37 | {0x1002, 0x4A49, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_NEW_MEMMAP}, \ |
| 29 | {0x1002, 0x4A49, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420}, \ | 38 | {0x1002, 0x4A4A, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_NEW_MEMMAP}, \ |
| 30 | {0x1002, 0x4A4B, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420}, \ | 39 | {0x1002, 0x4A4B, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_NEW_MEMMAP}, \ |
| 40 | {0x1002, 0x4A4C, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_NEW_MEMMAP}, \ | ||
| 41 | {0x1002, 0x4A4D, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_NEW_MEMMAP}, \ | ||
| 42 | {0x1002, 0x4A4E, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_IS_MOBILITY|CHIP_NEW_MEMMAP}, \ | ||
| 43 | {0x1002, 0x4A4F, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_NEW_MEMMAP}, \ | ||
| 44 | {0x1002, 0x4A50, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_NEW_MEMMAP}, \ | ||
| 45 | {0x1002, 0x4A54, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_NEW_MEMMAP}, \ | ||
| 46 | {0x1002, 0x4B49, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_NEW_MEMMAP}, \ | ||
| 47 | {0x1002, 0x4B4A, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_NEW_MEMMAP}, \ | ||
| 48 | {0x1002, 0x4B4B, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_NEW_MEMMAP}, \ | ||
| 49 | {0x1002, 0x4B4C, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_NEW_MEMMAP}, \ | ||
| 31 | {0x1002, 0x4C57, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV200|CHIP_IS_MOBILITY}, \ | 50 | {0x1002, 0x4C57, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV200|CHIP_IS_MOBILITY}, \ |
| 32 | {0x1002, 0x4C58, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV200|CHIP_IS_MOBILITY}, \ | 51 | {0x1002, 0x4C58, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV200|CHIP_IS_MOBILITY}, \ |
| 33 | {0x1002, 0x4C59, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV100|CHIP_IS_MOBILITY}, \ | 52 | {0x1002, 0x4C59, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV100|CHIP_IS_MOBILITY}, \ |
| 34 | {0x1002, 0x4C5A, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV100|CHIP_IS_MOBILITY}, \ | 53 | {0x1002, 0x4C5A, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV100|CHIP_IS_MOBILITY}, \ |
| 35 | {0x1002, 0x4C64, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R250|CHIP_IS_MOBILITY}, \ | 54 | {0x1002, 0x4C64, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV250|CHIP_IS_MOBILITY}, \ |
| 36 | {0x1002, 0x4C65, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R250|CHIP_IS_MOBILITY}, \ | 55 | {0x1002, 0x4C66, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV250|CHIP_IS_MOBILITY}, \ |
| 37 | {0x1002, 0x4C66, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R250|CHIP_IS_MOBILITY}, \ | 56 | {0x1002, 0x4C67, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV250|CHIP_IS_MOBILITY}, \ |
| 38 | {0x1002, 0x4C67, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R250|CHIP_IS_MOBILITY}, \ | ||
| 39 | {0x1002, 0x4E44, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R300}, \ | 57 | {0x1002, 0x4E44, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R300}, \ |
| 40 | {0x1002, 0x4E45, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R300}, \ | 58 | {0x1002, 0x4E45, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R300}, \ |
| 41 | {0x1002, 0x4E46, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV350}, \ | 59 | {0x1002, 0x4E46, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R300}, \ |
| 42 | {0x1002, 0x4E47, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R300}, \ | 60 | {0x1002, 0x4E47, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R300}, \ |
| 43 | {0x1002, 0x4E48, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R350}, \ | 61 | {0x1002, 0x4E48, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R350}, \ |
| 44 | {0x1002, 0x4E49, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R350}, \ | 62 | {0x1002, 0x4E49, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R350}, \ |
| 45 | {0x1002, 0x4E4A, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV350}, \ | 63 | {0x1002, 0x4E4A, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R350}, \ |
| 46 | {0x1002, 0x4E4B, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R350}, \ | 64 | {0x1002, 0x4E4B, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R350}, \ |
| 47 | {0x1002, 0x4E50, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV350|CHIP_IS_MOBILITY}, \ | 65 | {0x1002, 0x4E50, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV350|CHIP_IS_MOBILITY}, \ |
| 48 | {0x1002, 0x4E51, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV350|CHIP_IS_MOBILITY}, \ | 66 | {0x1002, 0x4E51, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV350|CHIP_IS_MOBILITY}, \ |
| 67 | {0x1002, 0x4E52, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV350|CHIP_IS_MOBILITY}, \ | ||
| 68 | {0x1002, 0x4E53, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV350|CHIP_IS_MOBILITY}, \ | ||
| 49 | {0x1002, 0x4E54, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV350|CHIP_IS_MOBILITY}, \ | 69 | {0x1002, 0x4E54, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV350|CHIP_IS_MOBILITY}, \ |
| 50 | {0x1002, 0x4E56, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV350|CHIP_IS_MOBILITY}, \ | 70 | {0x1002, 0x4E56, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV350|CHIP_IS_MOBILITY}, \ |
| 51 | {0x1002, 0x5144, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R100|CHIP_SINGLE_CRTC}, \ | 71 | {0x1002, 0x5144, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R100|CHIP_SINGLE_CRTC}, \ |
| @@ -53,44 +73,66 @@ | |||
| 53 | {0x1002, 0x5146, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R100|CHIP_SINGLE_CRTC}, \ | 73 | {0x1002, 0x5146, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R100|CHIP_SINGLE_CRTC}, \ |
| 54 | {0x1002, 0x5147, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R100|CHIP_SINGLE_CRTC}, \ | 74 | {0x1002, 0x5147, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R100|CHIP_SINGLE_CRTC}, \ |
| 55 | {0x1002, 0x5148, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R200}, \ | 75 | {0x1002, 0x5148, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R200}, \ |
| 56 | {0x1002, 0x5149, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R200}, \ | ||
| 57 | {0x1002, 0x514A, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R200}, \ | ||
| 58 | {0x1002, 0x514B, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R200}, \ | ||
| 59 | {0x1002, 0x514C, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R200}, \ | 76 | {0x1002, 0x514C, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R200}, \ |
| 60 | {0x1002, 0x514D, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R200}, \ | 77 | {0x1002, 0x514D, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R200}, \ |
| 61 | {0x1002, 0x514E, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R200}, \ | ||
| 62 | {0x1002, 0x514F, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R200}, \ | ||
| 63 | {0x1002, 0x5157, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV200}, \ | 78 | {0x1002, 0x5157, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV200}, \ |
| 64 | {0x1002, 0x5158, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV200}, \ | 79 | {0x1002, 0x5158, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV200}, \ |
| 65 | {0x1002, 0x5159, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV100}, \ | 80 | {0x1002, 0x5159, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV100}, \ |
| 66 | {0x1002, 0x515A, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV100}, \ | 81 | {0x1002, 0x515A, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV100}, \ |
| 67 | {0x1002, 0x515E, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV100}, \ | 82 | {0x1002, 0x515E, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV100}, \ |
| 68 | {0x1002, 0x5168, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R200}, \ | 83 | {0x1002, 0x5460, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV380|CHIP_IS_MOBILITY}, \ |
| 69 | {0x1002, 0x5169, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R200}, \ | 84 | {0x1002, 0x5462, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV380|CHIP_IS_MOBILITY}, \ |
| 70 | {0x1002, 0x516A, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R200}, \ | 85 | {0x1002, 0x5464, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV380|CHIP_IS_MOBILITY}, \ |
| 71 | {0x1002, 0x516B, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R200}, \ | 86 | {0x1002, 0x5548, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_NEW_MEMMAP}, \ |
| 72 | {0x1002, 0x516C, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R200}, \ | 87 | {0x1002, 0x5549, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_NEW_MEMMAP}, \ |
| 73 | {0x1002, 0x5460, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV350}, \ | 88 | {0x1002, 0x554A, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_NEW_MEMMAP}, \ |
| 74 | {0x1002, 0x554F, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R350}, \ | 89 | {0x1002, 0x554B, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_NEW_MEMMAP}, \ |
| 90 | {0x1002, 0x554C, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_NEW_MEMMAP}, \ | ||
| 91 | {0x1002, 0x554D, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_NEW_MEMMAP}, \ | ||
| 92 | {0x1002, 0x554E, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_NEW_MEMMAP}, \ | ||
| 93 | {0x1002, 0x554F, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_NEW_MEMMAP}, \ | ||
| 94 | {0x1002, 0x5550, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_NEW_MEMMAP}, \ | ||
| 95 | {0x1002, 0x5551, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_NEW_MEMMAP}, \ | ||
| 96 | {0x1002, 0x5552, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_NEW_MEMMAP}, \ | ||
| 97 | {0x1002, 0x5554, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_NEW_MEMMAP}, \ | ||
| 98 | {0x1002, 0x564A, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV410|CHIP_IS_MOBILITY|CHIP_NEW_MEMMAP}, \ | ||
| 99 | {0x1002, 0x564B, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV410|CHIP_IS_MOBILITY|CHIP_NEW_MEMMAP}, \ | ||
| 100 | {0x1002, 0x564F, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV410|CHIP_IS_MOBILITY|CHIP_NEW_MEMMAP}, \ | ||
| 101 | {0x1002, 0x5652, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV410|CHIP_IS_MOBILITY|CHIP_NEW_MEMMAP}, \ | ||
| 102 | {0x1002, 0x5653, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV410|CHIP_IS_MOBILITY|CHIP_NEW_MEMMAP}, \ | ||
| 75 | {0x1002, 0x5834, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RS300|CHIP_IS_IGP}, \ | 103 | {0x1002, 0x5834, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RS300|CHIP_IS_IGP}, \ |
| 76 | {0x1002, 0x5835, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RS300|CHIP_IS_IGP|CHIP_IS_MOBILITY}, \ | 104 | {0x1002, 0x5835, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RS300|CHIP_IS_IGP|CHIP_IS_MOBILITY}, \ |
| 77 | {0x1002, 0x5836, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RS300|CHIP_IS_IGP}, \ | ||
| 78 | {0x1002, 0x5837, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RS300|CHIP_IS_IGP}, \ | ||
| 79 | {0x1002, 0x5960, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV280}, \ | 105 | {0x1002, 0x5960, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV280}, \ |
| 80 | {0x1002, 0x5961, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV280}, \ | 106 | {0x1002, 0x5961, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV280}, \ |
| 81 | {0x1002, 0x5962, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV280}, \ | 107 | {0x1002, 0x5962, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV280}, \ |
| 82 | {0x1002, 0x5963, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV280}, \ | ||
| 83 | {0x1002, 0x5964, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV280}, \ | 108 | {0x1002, 0x5964, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV280}, \ |
| 84 | {0x1002, 0x5968, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV280}, \ | 109 | {0x1002, 0x5965, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV280}, \ |
| 85 | {0x1002, 0x5969, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV100}, \ | 110 | {0x1002, 0x5969, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV100}, \ |
| 86 | {0x1002, 0x596A, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV280}, \ | 111 | {0x1002, 0x5b60, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV380|CHIP_NEW_MEMMAP}, \ |
| 87 | {0x1002, 0x596B, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV280}, \ | 112 | {0x1002, 0x5b62, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV380|CHIP_NEW_MEMMAP}, \ |
| 113 | {0x1002, 0x5b63, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV380|CHIP_NEW_MEMMAP}, \ | ||
| 114 | {0x1002, 0x5b64, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV380|CHIP_NEW_MEMMAP}, \ | ||
| 115 | {0x1002, 0x5b65, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV380|CHIP_NEW_MEMMAP}, \ | ||
| 88 | {0x1002, 0x5c61, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV280|CHIP_IS_MOBILITY}, \ | 116 | {0x1002, 0x5c61, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV280|CHIP_IS_MOBILITY}, \ |
| 89 | {0x1002, 0x5c62, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV280}, \ | ||
| 90 | {0x1002, 0x5c63, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV280|CHIP_IS_MOBILITY}, \ | 117 | {0x1002, 0x5c63, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV280|CHIP_IS_MOBILITY}, \ |
| 91 | {0x1002, 0x5c64, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV280}, \ | 118 | {0x1002, 0x5d48, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_IS_MOBILITY|CHIP_NEW_MEMMAP}, \ |
| 92 | {0x1002, 0x5d4d, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R350}, \ | 119 | {0x1002, 0x5d49, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_IS_MOBILITY|CHIP_NEW_MEMMAP}, \ |
| 93 | {0x1002, 0x5e4b, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420}, \ | 120 | {0x1002, 0x5d4a, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_IS_MOBILITY|CHIP_NEW_MEMMAP}, \ |
| 121 | {0x1002, 0x5d4c, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_NEW_MEMMAP}, \ | ||
| 122 | {0x1002, 0x5d4d, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_NEW_MEMMAP}, \ | ||
| 123 | {0x1002, 0x5d4e, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_NEW_MEMMAP}, \ | ||
| 124 | {0x1002, 0x5d4f, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_NEW_MEMMAP}, \ | ||
| 125 | {0x1002, 0x5d50, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_NEW_MEMMAP}, \ | ||
| 126 | {0x1002, 0x5d52, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_NEW_MEMMAP}, \ | ||
| 127 | {0x1002, 0x5d57, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_R420|CHIP_NEW_MEMMAP}, \ | ||
| 128 | {0x1002, 0x5e48, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV410|CHIP_NEW_MEMMAP}, \ | ||
| 129 | {0x1002, 0x5e4a, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV410|CHIP_NEW_MEMMAP}, \ | ||
| 130 | {0x1002, 0x5e4b, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV410|CHIP_NEW_MEMMAP}, \ | ||
| 131 | {0x1002, 0x5e4c, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV410|CHIP_NEW_MEMMAP}, \ | ||
| 132 | {0x1002, 0x5e4d, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV410|CHIP_NEW_MEMMAP}, \ | ||
| 133 | {0x1002, 0x5e4f, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RV410|CHIP_NEW_MEMMAP}, \ | ||
| 134 | {0x1002, 0x7834, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RS300|CHIP_IS_IGP|CHIP_NEW_MEMMAP}, \ | ||
| 135 | {0x1002, 0x7835, PCI_ANY_ID, PCI_ANY_ID, 0, 0, CHIP_RS300|CHIP_IS_IGP|CHIP_IS_MOBILITY|CHIP_NEW_MEMMAP}, \ | ||
| 94 | {0, 0, 0} | 136 | {0, 0, 0} |
| 95 | 137 | ||
| 96 | #define r128_PCI_IDS \ | 138 | #define r128_PCI_IDS \ |
diff --git a/drivers/char/drm/i915_dma.c b/drivers/char/drm/i915_dma.c index 1ff4c7ca0bff..9f4b8ce4c05e 100644 --- a/drivers/char/drm/i915_dma.c +++ b/drivers/char/drm/i915_dma.c | |||
| @@ -495,8 +495,6 @@ static int i915_dispatch_batchbuffer(drm_device_t * dev, | |||
| 495 | } | 495 | } |
| 496 | } | 496 | } |
| 497 | 497 | ||
| 498 | dev_priv->sarea_priv->last_enqueue = dev_priv->counter++; | ||
| 499 | |||
| 500 | i915_emit_breadcrumb(dev); | 498 | i915_emit_breadcrumb(dev); |
| 501 | 499 | ||
| 502 | return 0; | 500 | return 0; |
diff --git a/drivers/char/drm/i915_irq.c b/drivers/char/drm/i915_irq.c index d3879ac9970f..a752afd86ab8 100644 --- a/drivers/char/drm/i915_irq.c +++ b/drivers/char/drm/i915_irq.c | |||
| @@ -53,6 +53,8 @@ irqreturn_t i915_driver_irq_handler(DRM_IRQ_ARGS) | |||
| 53 | 53 | ||
| 54 | I915_WRITE16(I915REG_INT_IDENTITY_R, temp); | 54 | I915_WRITE16(I915REG_INT_IDENTITY_R, temp); |
| 55 | 55 | ||
| 56 | dev_priv->sarea_priv->last_dispatch = READ_BREADCRUMB(dev_priv); | ||
| 57 | |||
| 56 | if (temp & USER_INT_FLAG) | 58 | if (temp & USER_INT_FLAG) |
| 57 | DRM_WAKEUP(&dev_priv->irq_queue); | 59 | DRM_WAKEUP(&dev_priv->irq_queue); |
| 58 | 60 | ||
diff --git a/drivers/char/drm/r300_cmdbuf.c b/drivers/char/drm/r300_cmdbuf.c index c08fa5076f05..b108c7f913b2 100644 --- a/drivers/char/drm/r300_cmdbuf.c +++ b/drivers/char/drm/r300_cmdbuf.c | |||
| @@ -214,13 +214,13 @@ void r300_init_reg_flags(void) | |||
| 214 | ADD_RANGE(0x4F54, 1); | 214 | ADD_RANGE(0x4F54, 1); |
| 215 | 215 | ||
| 216 | ADD_RANGE(R300_TX_FILTER_0, 16); | 216 | ADD_RANGE(R300_TX_FILTER_0, 16); |
| 217 | ADD_RANGE(R300_TX_UNK1_0, 16); | 217 | ADD_RANGE(R300_TX_FILTER1_0, 16); |
| 218 | ADD_RANGE(R300_TX_SIZE_0, 16); | 218 | ADD_RANGE(R300_TX_SIZE_0, 16); |
| 219 | ADD_RANGE(R300_TX_FORMAT_0, 16); | 219 | ADD_RANGE(R300_TX_FORMAT_0, 16); |
| 220 | ADD_RANGE(R300_TX_PITCH_0, 16); | 220 | ADD_RANGE(R300_TX_PITCH_0, 16); |
| 221 | /* Texture offset is dangerous and needs more checking */ | 221 | /* Texture offset is dangerous and needs more checking */ |
| 222 | ADD_RANGE_MARK(R300_TX_OFFSET_0, 16, MARK_CHECK_OFFSET); | 222 | ADD_RANGE_MARK(R300_TX_OFFSET_0, 16, MARK_CHECK_OFFSET); |
| 223 | ADD_RANGE(R300_TX_UNK4_0, 16); | 223 | ADD_RANGE(R300_TX_CHROMA_KEY_0, 16); |
| 224 | ADD_RANGE(R300_TX_BORDER_COLOR_0, 16); | 224 | ADD_RANGE(R300_TX_BORDER_COLOR_0, 16); |
| 225 | 225 | ||
| 226 | /* Sporadic registers used as primitives are emitted */ | 226 | /* Sporadic registers used as primitives are emitted */ |
| @@ -242,8 +242,10 @@ static __inline__ int r300_check_range(unsigned reg, int count) | |||
| 242 | return 0; | 242 | return 0; |
| 243 | } | 243 | } |
| 244 | 244 | ||
| 245 | /* we expect offsets passed to the framebuffer to be either within video memory or | 245 | /* |
| 246 | within AGP space */ | 246 | * we expect offsets passed to the framebuffer to be either within video |
| 247 | * memory or within AGP space | ||
| 248 | */ | ||
| 247 | static __inline__ int r300_check_offset(drm_radeon_private_t *dev_priv, | 249 | static __inline__ int r300_check_offset(drm_radeon_private_t *dev_priv, |
| 248 | u32 offset) | 250 | u32 offset) |
| 249 | { | 251 | { |
| @@ -251,11 +253,11 @@ static __inline__ int r300_check_offset(drm_radeon_private_t *dev_priv, | |||
| 251 | but this value is not being kept. | 253 | but this value is not being kept. |
| 252 | This code is correct for now (does the same thing as the | 254 | This code is correct for now (does the same thing as the |
| 253 | code that sets MC_FB_LOCATION) in radeon_cp.c */ | 255 | code that sets MC_FB_LOCATION) in radeon_cp.c */ |
| 254 | if ((offset >= dev_priv->fb_location) && | 256 | if (offset >= dev_priv->fb_location && |
| 255 | (offset < dev_priv->gart_vm_start)) | 257 | offset < (dev_priv->fb_location + dev_priv->fb_size)) |
| 256 | return 0; | 258 | return 0; |
| 257 | if ((offset >= dev_priv->gart_vm_start) && | 259 | if (offset >= dev_priv->gart_vm_start && |
| 258 | (offset < dev_priv->gart_vm_start + dev_priv->gart_size)) | 260 | offset < (dev_priv->gart_vm_start + dev_priv->gart_size)) |
| 259 | return 0; | 261 | return 0; |
| 260 | return 1; | 262 | return 1; |
| 261 | } | 263 | } |
| @@ -490,6 +492,7 @@ static __inline__ int r300_emit_3d_load_vbpntr(drm_radeon_private_t *dev_priv, | |||
| 490 | 492 | ||
| 491 | return 0; | 493 | return 0; |
| 492 | } | 494 | } |
| 495 | |||
| 493 | static __inline__ int r300_emit_bitblt_multi(drm_radeon_private_t *dev_priv, | 496 | static __inline__ int r300_emit_bitblt_multi(drm_radeon_private_t *dev_priv, |
| 494 | drm_radeon_kcmd_buffer_t *cmdbuf) | 497 | drm_radeon_kcmd_buffer_t *cmdbuf) |
| 495 | { | 498 | { |
| @@ -701,6 +704,64 @@ static void r300_discard_buffer(drm_device_t * dev, drm_buf_t * buf) | |||
| 701 | buf->used = 0; | 704 | buf->used = 0; |
| 702 | } | 705 | } |
| 703 | 706 | ||
| 707 | static int r300_scratch(drm_radeon_private_t *dev_priv, | ||
| 708 | drm_radeon_kcmd_buffer_t *cmdbuf, | ||
| 709 | drm_r300_cmd_header_t header) | ||
| 710 | { | ||
| 711 | u32 *ref_age_base; | ||
| 712 | u32 i, buf_idx, h_pending; | ||
| 713 | RING_LOCALS; | ||
| 714 | |||
| 715 | if (cmdbuf->bufsz < | ||
| 716 | (sizeof(u64) + header.scratch.n_bufs * sizeof(buf_idx))) { | ||
| 717 | return DRM_ERR(EINVAL); | ||
| 718 | } | ||
| 719 | |||
| 720 | if (header.scratch.reg >= 5) { | ||
| 721 | return DRM_ERR(EINVAL); | ||
| 722 | } | ||
| 723 | |||
| 724 | dev_priv->scratch_ages[header.scratch.reg]++; | ||
| 725 | |||
| 726 | ref_age_base = *(u32 **)cmdbuf->buf; | ||
| 727 | |||
| 728 | cmdbuf->buf += sizeof(u64); | ||
| 729 | cmdbuf->bufsz -= sizeof(u64); | ||
| 730 | |||
| 731 | for (i=0; i < header.scratch.n_bufs; i++) { | ||
| 732 | buf_idx = *(u32 *)cmdbuf->buf; | ||
| 733 | buf_idx *= 2; /* 8 bytes per buf */ | ||
| 734 | |||
| 735 | if (DRM_COPY_TO_USER(ref_age_base + buf_idx, &dev_priv->scratch_ages[header.scratch.reg], sizeof(u32))) { | ||
| 736 | return DRM_ERR(EINVAL); | ||
| 737 | } | ||
| 738 | |||
| 739 | if (DRM_COPY_FROM_USER(&h_pending, ref_age_base + buf_idx + 1, sizeof(u32))) { | ||
| 740 | return DRM_ERR(EINVAL); | ||
| 741 | } | ||
| 742 | |||
| 743 | if (h_pending == 0) { | ||
| 744 | return DRM_ERR(EINVAL); | ||
| 745 | } | ||
| 746 | |||
| 747 | h_pending--; | ||
| 748 | |||
| 749 | if (DRM_COPY_TO_USER(ref_age_base + buf_idx + 1, &h_pending, sizeof(u32))) { | ||
| 750 | return DRM_ERR(EINVAL); | ||
| 751 | } | ||
| 752 | |||
| 753 | cmdbuf->buf += sizeof(buf_idx); | ||
| 754 | cmdbuf->bufsz -= sizeof(buf_idx); | ||
| 755 | } | ||
| 756 | |||
| 757 | BEGIN_RING(2); | ||
| 758 | OUT_RING(CP_PACKET0(RADEON_SCRATCH_REG0 + header.scratch.reg * 4, 0)); | ||
| 759 | OUT_RING(dev_priv->scratch_ages[header.scratch.reg]); | ||
| 760 | ADVANCE_RING(); | ||
| 761 | |||
| 762 | return 0; | ||
| 763 | } | ||
| 764 | |||
| 704 | /** | 765 | /** |
| 705 | * Parses and validates a user-supplied command buffer and emits appropriate | 766 | * Parses and validates a user-supplied command buffer and emits appropriate |
| 706 | * commands on the DMA ring buffer. | 767 | * commands on the DMA ring buffer. |
| @@ -838,6 +899,15 @@ int r300_do_cp_cmdbuf(drm_device_t *dev, | |||
| 838 | } | 899 | } |
| 839 | break; | 900 | break; |
| 840 | 901 | ||
| 902 | case R300_CMD_SCRATCH: | ||
| 903 | DRM_DEBUG("R300_CMD_SCRATCH\n"); | ||
| 904 | ret = r300_scratch(dev_priv, cmdbuf, header); | ||
| 905 | if (ret) { | ||
| 906 | DRM_ERROR("r300_scratch failed\n"); | ||
| 907 | goto cleanup; | ||
| 908 | } | ||
| 909 | break; | ||
| 910 | |||
| 841 | default: | 911 | default: |
| 842 | DRM_ERROR("bad cmd_type %i at %p\n", | 912 | DRM_ERROR("bad cmd_type %i at %p\n", |
| 843 | header.header.cmd_type, | 913 | header.header.cmd_type, |
diff --git a/drivers/char/drm/r300_reg.h b/drivers/char/drm/r300_reg.h index d1e19954406b..a881f96c983e 100644 --- a/drivers/char/drm/r300_reg.h +++ b/drivers/char/drm/r300_reg.h | |||
| @@ -711,8 +711,22 @@ I am fairly certain that they are correct unless stated otherwise in comments. | |||
| 711 | # define R300_TX_MAX_ANISO_16_TO_1 (8 << 21) | 711 | # define R300_TX_MAX_ANISO_16_TO_1 (8 << 21) |
| 712 | # define R300_TX_MAX_ANISO_MASK (14 << 21) | 712 | # define R300_TX_MAX_ANISO_MASK (14 << 21) |
| 713 | 713 | ||
| 714 | #define R300_TX_UNK1_0 0x4440 | 714 | #define R300_TX_FILTER1_0 0x4440 |
| 715 | # define R300_CHROMA_KEY_MODE_DISABLE 0 | ||
| 716 | # define R300_CHROMA_KEY_FORCE 1 | ||
| 717 | # define R300_CHROMA_KEY_BLEND 2 | ||
| 718 | # define R300_MC_ROUND_NORMAL (0<<2) | ||
| 719 | # define R300_MC_ROUND_MPEG4 (1<<2) | ||
| 715 | # define R300_LOD_BIAS_MASK 0x1fff | 720 | # define R300_LOD_BIAS_MASK 0x1fff |
| 721 | # define R300_EDGE_ANISO_EDGE_DIAG (0<<13) | ||
| 722 | # define R300_EDGE_ANISO_EDGE_ONLY (1<<13) | ||
| 723 | # define R300_MC_COORD_TRUNCATE_DISABLE (0<<14) | ||
| 724 | # define R300_MC_COORD_TRUNCATE_MPEG (1<<14) | ||
| 725 | # define R300_TX_TRI_PERF_0_8 (0<<15) | ||
| 726 | # define R300_TX_TRI_PERF_1_8 (1<<15) | ||
| 727 | # define R300_TX_TRI_PERF_1_4 (2<<15) | ||
| 728 | # define R300_TX_TRI_PERF_3_8 (3<<15) | ||
| 729 | # define R300_ANISO_THRESHOLD_MASK (7<<17) | ||
| 716 | 730 | ||
| 717 | #define R300_TX_SIZE_0 0x4480 | 731 | #define R300_TX_SIZE_0 0x4480 |
| 718 | # define R300_TX_WIDTHMASK_SHIFT 0 | 732 | # define R300_TX_WIDTHMASK_SHIFT 0 |
| @@ -722,6 +736,8 @@ I am fairly certain that they are correct unless stated otherwise in comments. | |||
| 722 | # define R300_TX_UNK23 (1 << 23) | 736 | # define R300_TX_UNK23 (1 << 23) |
| 723 | # define R300_TX_SIZE_SHIFT 26 /* largest of width, height */ | 737 | # define R300_TX_SIZE_SHIFT 26 /* largest of width, height */ |
| 724 | # define R300_TX_SIZE_MASK (15 << 26) | 738 | # define R300_TX_SIZE_MASK (15 << 26) |
| 739 | # define R300_TX_SIZE_PROJECTED (1<<30) | ||
| 740 | # define R300_TX_SIZE_TXPITCH_EN (1<<31) | ||
| 725 | #define R300_TX_FORMAT_0 0x44C0 | 741 | #define R300_TX_FORMAT_0 0x44C0 |
| 726 | /* The interpretation of the format word by Wladimir van der Laan */ | 742 | /* The interpretation of the format word by Wladimir van der Laan */ |
| 727 | /* The X, Y, Z and W refer to the layout of the components. | 743 | /* The X, Y, Z and W refer to the layout of the components. |
| @@ -750,7 +766,8 @@ I am fairly certain that they are correct unless stated otherwise in comments. | |||
| 750 | # define R300_TX_FORMAT_B8G8_B8G8 0x14 /* no swizzle */ | 766 | # define R300_TX_FORMAT_B8G8_B8G8 0x14 /* no swizzle */ |
| 751 | # define R300_TX_FORMAT_G8R8_G8B8 0x15 /* no swizzle */ | 767 | # define R300_TX_FORMAT_G8R8_G8B8 0x15 /* no swizzle */ |
| 752 | /* 0x16 - some 16 bit green format.. ?? */ | 768 | /* 0x16 - some 16 bit green format.. ?? */ |
| 753 | # define R300_TX_FORMAT_UNK25 (1 << 25) /* no swizzle */ | 769 | # define R300_TX_FORMAT_UNK25 (1 << 25) /* no swizzle */ |
| 770 | # define R300_TX_FORMAT_CUBIC_MAP (1 << 26) | ||
| 754 | 771 | ||
| 755 | /* gap */ | 772 | /* gap */ |
| 756 | /* Floating point formats */ | 773 | /* Floating point formats */ |
| @@ -800,18 +817,20 @@ I am fairly certain that they are correct unless stated otherwise in comments. | |||
| 800 | 817 | ||
| 801 | # define R300_TX_FORMAT_YUV_MODE 0x00800000 | 818 | # define R300_TX_FORMAT_YUV_MODE 0x00800000 |
| 802 | 819 | ||
| 803 | #define R300_TX_PITCH_0 0x4500 | 820 | #define R300_TX_PITCH_0 0x4500 /* obvious missing in gap */ |
| 804 | #define R300_TX_OFFSET_0 0x4540 | 821 | #define R300_TX_OFFSET_0 0x4540 |
| 805 | /* BEGIN: Guess from R200 */ | 822 | /* BEGIN: Guess from R200 */ |
| 806 | # define R300_TXO_ENDIAN_NO_SWAP (0 << 0) | 823 | # define R300_TXO_ENDIAN_NO_SWAP (0 << 0) |
| 807 | # define R300_TXO_ENDIAN_BYTE_SWAP (1 << 0) | 824 | # define R300_TXO_ENDIAN_BYTE_SWAP (1 << 0) |
| 808 | # define R300_TXO_ENDIAN_WORD_SWAP (2 << 0) | 825 | # define R300_TXO_ENDIAN_WORD_SWAP (2 << 0) |
| 809 | # define R300_TXO_ENDIAN_HALFDW_SWAP (3 << 0) | 826 | # define R300_TXO_ENDIAN_HALFDW_SWAP (3 << 0) |
| 827 | # define R300_TXO_MACRO_TILE (1 << 2) | ||
| 828 | # define R300_TXO_MICRO_TILE (1 << 3) | ||
| 810 | # define R300_TXO_OFFSET_MASK 0xffffffe0 | 829 | # define R300_TXO_OFFSET_MASK 0xffffffe0 |
| 811 | # define R300_TXO_OFFSET_SHIFT 5 | 830 | # define R300_TXO_OFFSET_SHIFT 5 |
| 812 | /* END */ | 831 | /* END */ |
| 813 | #define R300_TX_UNK4_0 0x4580 | 832 | #define R300_TX_CHROMA_KEY_0 0x4580 /* 32 bit chroma key */ |
| 814 | #define R300_TX_BORDER_COLOR_0 0x45C0 //ff00ff00 == { 0, 1.0, 0, 1.0 } | 833 | #define R300_TX_BORDER_COLOR_0 0x45C0 //ff00ff00 == { 0, 1.0, 0, 1.0 } |
| 815 | 834 | ||
| 816 | /* END */ | 835 | /* END */ |
| 817 | 836 | ||
| @@ -868,7 +887,9 @@ I am fairly certain that they are correct unless stated otherwise in comments. | |||
| 868 | # define R300_PFS_NODE_TEX_OFFSET_MASK (31 << 12) | 887 | # define R300_PFS_NODE_TEX_OFFSET_MASK (31 << 12) |
| 869 | # define R300_PFS_NODE_TEX_END_SHIFT 17 | 888 | # define R300_PFS_NODE_TEX_END_SHIFT 17 |
| 870 | # define R300_PFS_NODE_TEX_END_MASK (31 << 17) | 889 | # define R300_PFS_NODE_TEX_END_MASK (31 << 17) |
| 871 | # define R300_PFS_NODE_LAST_NODE (1 << 22) | 890 | /*# define R300_PFS_NODE_LAST_NODE (1 << 22) */ |
| 891 | # define R300_PFS_NODE_OUTPUT_COLOR (1 << 22) | ||
| 892 | # define R300_PFS_NODE_OUTPUT_DEPTH (1 << 23) | ||
| 872 | 893 | ||
| 873 | /* TEX | 894 | /* TEX |
| 874 | // As far as I can tell, texture instructions cannot write into output | 895 | // As far as I can tell, texture instructions cannot write into output |
| @@ -887,6 +908,7 @@ I am fairly certain that they are correct unless stated otherwise in comments. | |||
| 887 | */ | 908 | */ |
| 888 | # define R300_FPITX_OPCODE_SHIFT 15 | 909 | # define R300_FPITX_OPCODE_SHIFT 15 |
| 889 | # define R300_FPITX_OP_TEX 1 | 910 | # define R300_FPITX_OP_TEX 1 |
| 911 | # define R300_FPITX_OP_KIL 2 | ||
| 890 | # define R300_FPITX_OP_TXP 3 | 912 | # define R300_FPITX_OP_TXP 3 |
| 891 | # define R300_FPITX_OP_TXB 4 | 913 | # define R300_FPITX_OP_TXB 4 |
| 892 | 914 | ||
| @@ -962,9 +984,11 @@ I am fairly certain that they are correct unless stated otherwise in comments. | |||
| 962 | # define R300_FPI1_SRC2C_CONST (1 << 17) | 984 | # define R300_FPI1_SRC2C_CONST (1 << 17) |
| 963 | # define R300_FPI1_DSTC_SHIFT 18 | 985 | # define R300_FPI1_DSTC_SHIFT 18 |
| 964 | # define R300_FPI1_DSTC_MASK (31 << 18) | 986 | # define R300_FPI1_DSTC_MASK (31 << 18) |
| 987 | # define R300_FPI1_DSTC_REG_MASK_SHIFT 23 | ||
| 965 | # define R300_FPI1_DSTC_REG_X (1 << 23) | 988 | # define R300_FPI1_DSTC_REG_X (1 << 23) |
| 966 | # define R300_FPI1_DSTC_REG_Y (1 << 24) | 989 | # define R300_FPI1_DSTC_REG_Y (1 << 24) |
| 967 | # define R300_FPI1_DSTC_REG_Z (1 << 25) | 990 | # define R300_FPI1_DSTC_REG_Z (1 << 25) |
| 991 | # define R300_FPI1_DSTC_OUTPUT_MASK_SHIFT 26 | ||
| 968 | # define R300_FPI1_DSTC_OUTPUT_X (1 << 26) | 992 | # define R300_FPI1_DSTC_OUTPUT_X (1 << 26) |
| 969 | # define R300_FPI1_DSTC_OUTPUT_Y (1 << 27) | 993 | # define R300_FPI1_DSTC_OUTPUT_Y (1 << 27) |
| 970 | # define R300_FPI1_DSTC_OUTPUT_Z (1 << 28) | 994 | # define R300_FPI1_DSTC_OUTPUT_Z (1 << 28) |
| @@ -983,6 +1007,7 @@ I am fairly certain that they are correct unless stated otherwise in comments. | |||
| 983 | # define R300_FPI3_DSTA_MASK (31 << 18) | 1007 | # define R300_FPI3_DSTA_MASK (31 << 18) |
| 984 | # define R300_FPI3_DSTA_REG (1 << 23) | 1008 | # define R300_FPI3_DSTA_REG (1 << 23) |
| 985 | # define R300_FPI3_DSTA_OUTPUT (1 << 24) | 1009 | # define R300_FPI3_DSTA_OUTPUT (1 << 24) |
| 1010 | # define R300_FPI3_DSTA_DEPTH (1 << 27) | ||
| 986 | 1011 | ||
| 987 | #define R300_PFS_INSTR0_0 0x48C0 | 1012 | #define R300_PFS_INSTR0_0 0x48C0 |
| 988 | # define R300_FPI0_ARGC_SRC0C_XYZ 0 | 1013 | # define R300_FPI0_ARGC_SRC0C_XYZ 0 |
| @@ -1036,7 +1061,7 @@ I am fairly certain that they are correct unless stated otherwise in comments. | |||
| 1036 | # define R300_FPI0_OUTC_FRC (9 << 23) | 1061 | # define R300_FPI0_OUTC_FRC (9 << 23) |
| 1037 | # define R300_FPI0_OUTC_REPL_ALPHA (10 << 23) | 1062 | # define R300_FPI0_OUTC_REPL_ALPHA (10 << 23) |
| 1038 | # define R300_FPI0_OUTC_SAT (1 << 30) | 1063 | # define R300_FPI0_OUTC_SAT (1 << 30) |
| 1039 | # define R300_FPI0_UNKNOWN_31 (1 << 31) | 1064 | # define R300_FPI0_INSERT_NOP (1 << 31) |
| 1040 | 1065 | ||
| 1041 | #define R300_PFS_INSTR2_0 0x49C0 | 1066 | #define R300_PFS_INSTR2_0 0x49C0 |
| 1042 | # define R300_FPI2_ARGA_SRC0C_X 0 | 1067 | # define R300_FPI2_ARGA_SRC0C_X 0 |
diff --git a/drivers/char/drm/radeon_cp.c b/drivers/char/drm/radeon_cp.c index 9bb8ae0c1c27..7f949c9c9691 100644 --- a/drivers/char/drm/radeon_cp.c +++ b/drivers/char/drm/radeon_cp.c | |||
| @@ -1118,14 +1118,20 @@ static void radeon_cp_init_ring_buffer(drm_device_t * dev, | |||
| 1118 | { | 1118 | { |
| 1119 | u32 ring_start, cur_read_ptr; | 1119 | u32 ring_start, cur_read_ptr; |
| 1120 | u32 tmp; | 1120 | u32 tmp; |
| 1121 | 1121 | ||
| 1122 | /* Initialize the memory controller */ | 1122 | /* Initialize the memory controller. With new memory map, the fb location |
| 1123 | RADEON_WRITE(RADEON_MC_FB_LOCATION, | 1123 | * is not changed, it should have been properly initialized already. Part |
| 1124 | ((dev_priv->gart_vm_start - 1) & 0xffff0000) | 1124 | * of the problem is that the code below is bogus, assuming the GART is |
| 1125 | | (dev_priv->fb_location >> 16)); | 1125 | * always appended to the fb which is not necessarily the case |
| 1126 | */ | ||
| 1127 | if (!dev_priv->new_memmap) | ||
| 1128 | RADEON_WRITE(RADEON_MC_FB_LOCATION, | ||
| 1129 | ((dev_priv->gart_vm_start - 1) & 0xffff0000) | ||
| 1130 | | (dev_priv->fb_location >> 16)); | ||
| 1126 | 1131 | ||
| 1127 | #if __OS_HAS_AGP | 1132 | #if __OS_HAS_AGP |
| 1128 | if (dev_priv->flags & CHIP_IS_AGP) { | 1133 | if (dev_priv->flags & CHIP_IS_AGP) { |
| 1134 | RADEON_WRITE(RADEON_AGP_BASE, (unsigned int)dev->agp->base); | ||
| 1129 | RADEON_WRITE(RADEON_MC_AGP_LOCATION, | 1135 | RADEON_WRITE(RADEON_MC_AGP_LOCATION, |
| 1130 | (((dev_priv->gart_vm_start - 1 + | 1136 | (((dev_priv->gart_vm_start - 1 + |
| 1131 | dev_priv->gart_size) & 0xffff0000) | | 1137 | dev_priv->gart_size) & 0xffff0000) | |
| @@ -1153,8 +1159,6 @@ static void radeon_cp_init_ring_buffer(drm_device_t * dev, | |||
| 1153 | 1159 | ||
| 1154 | #if __OS_HAS_AGP | 1160 | #if __OS_HAS_AGP |
| 1155 | if (dev_priv->flags & CHIP_IS_AGP) { | 1161 | if (dev_priv->flags & CHIP_IS_AGP) { |
| 1156 | /* set RADEON_AGP_BASE here instead of relying on X from user space */ | ||
| 1157 | RADEON_WRITE(RADEON_AGP_BASE, (unsigned int)dev->agp->base); | ||
| 1158 | RADEON_WRITE(RADEON_CP_RB_RPTR_ADDR, | 1162 | RADEON_WRITE(RADEON_CP_RB_RPTR_ADDR, |
| 1159 | dev_priv->ring_rptr->offset | 1163 | dev_priv->ring_rptr->offset |
| 1160 | - dev->agp->base + dev_priv->gart_vm_start); | 1164 | - dev->agp->base + dev_priv->gart_vm_start); |
| @@ -1174,6 +1178,17 @@ static void radeon_cp_init_ring_buffer(drm_device_t * dev, | |||
| 1174 | entry->handle + tmp_ofs); | 1178 | entry->handle + tmp_ofs); |
| 1175 | } | 1179 | } |
| 1176 | 1180 | ||
| 1181 | /* Set ring buffer size */ | ||
| 1182 | #ifdef __BIG_ENDIAN | ||
| 1183 | RADEON_WRITE(RADEON_CP_RB_CNTL, | ||
| 1184 | dev_priv->ring.size_l2qw | RADEON_BUF_SWAP_32BIT); | ||
| 1185 | #else | ||
| 1186 | RADEON_WRITE(RADEON_CP_RB_CNTL, dev_priv->ring.size_l2qw); | ||
| 1187 | #endif | ||
| 1188 | |||
| 1189 | /* Start with assuming that writeback doesn't work */ | ||
| 1190 | dev_priv->writeback_works = 0; | ||
| 1191 | |||
| 1177 | /* Initialize the scratch register pointer. This will cause | 1192 | /* Initialize the scratch register pointer. This will cause |
| 1178 | * the scratch register values to be written out to memory | 1193 | * the scratch register values to be written out to memory |
| 1179 | * whenever they are updated. | 1194 | * whenever they are updated. |
| @@ -1190,28 +1205,9 @@ static void radeon_cp_init_ring_buffer(drm_device_t * dev, | |||
| 1190 | 1205 | ||
| 1191 | RADEON_WRITE(RADEON_SCRATCH_UMSK, 0x7); | 1206 | RADEON_WRITE(RADEON_SCRATCH_UMSK, 0x7); |
| 1192 | 1207 | ||
| 1193 | /* Writeback doesn't seem to work everywhere, test it first */ | 1208 | /* Turn on bus mastering */ |
| 1194 | DRM_WRITE32(dev_priv->ring_rptr, RADEON_SCRATCHOFF(1), 0); | 1209 | tmp = RADEON_READ(RADEON_BUS_CNTL) & ~RADEON_BUS_MASTER_DIS; |
| 1195 | RADEON_WRITE(RADEON_SCRATCH_REG1, 0xdeadbeef); | 1210 | RADEON_WRITE(RADEON_BUS_CNTL, tmp); |
| 1196 | |||
| 1197 | for (tmp = 0; tmp < dev_priv->usec_timeout; tmp++) { | ||
| 1198 | if (DRM_READ32(dev_priv->ring_rptr, RADEON_SCRATCHOFF(1)) == | ||
| 1199 | 0xdeadbeef) | ||
| 1200 | break; | ||
| 1201 | DRM_UDELAY(1); | ||
| 1202 | } | ||
| 1203 | |||
| 1204 | if (tmp < dev_priv->usec_timeout) { | ||
| 1205 | dev_priv->writeback_works = 1; | ||
| 1206 | DRM_DEBUG("writeback test succeeded, tmp=%d\n", tmp); | ||
| 1207 | } else { | ||
| 1208 | dev_priv->writeback_works = 0; | ||
| 1209 | DRM_DEBUG("writeback test failed\n"); | ||
| 1210 | } | ||
| 1211 | if (radeon_no_wb == 1) { | ||
| 1212 | dev_priv->writeback_works = 0; | ||
| 1213 | DRM_DEBUG("writeback forced off\n"); | ||
| 1214 | } | ||
| 1215 | 1211 | ||
| 1216 | dev_priv->sarea_priv->last_frame = dev_priv->scratch[0] = 0; | 1212 | dev_priv->sarea_priv->last_frame = dev_priv->scratch[0] = 0; |
| 1217 | RADEON_WRITE(RADEON_LAST_FRAME_REG, dev_priv->sarea_priv->last_frame); | 1213 | RADEON_WRITE(RADEON_LAST_FRAME_REG, dev_priv->sarea_priv->last_frame); |
| @@ -1223,26 +1219,45 @@ static void radeon_cp_init_ring_buffer(drm_device_t * dev, | |||
| 1223 | dev_priv->sarea_priv->last_clear = dev_priv->scratch[2] = 0; | 1219 | dev_priv->sarea_priv->last_clear = dev_priv->scratch[2] = 0; |
| 1224 | RADEON_WRITE(RADEON_LAST_CLEAR_REG, dev_priv->sarea_priv->last_clear); | 1220 | RADEON_WRITE(RADEON_LAST_CLEAR_REG, dev_priv->sarea_priv->last_clear); |
| 1225 | 1221 | ||
| 1226 | /* Set ring buffer size */ | ||
| 1227 | #ifdef __BIG_ENDIAN | ||
| 1228 | RADEON_WRITE(RADEON_CP_RB_CNTL, | ||
| 1229 | dev_priv->ring.size_l2qw | RADEON_BUF_SWAP_32BIT); | ||
| 1230 | #else | ||
| 1231 | RADEON_WRITE(RADEON_CP_RB_CNTL, dev_priv->ring.size_l2qw); | ||
| 1232 | #endif | ||
| 1233 | |||
| 1234 | radeon_do_wait_for_idle(dev_priv); | 1222 | radeon_do_wait_for_idle(dev_priv); |
| 1235 | 1223 | ||
| 1236 | /* Turn on bus mastering */ | ||
| 1237 | tmp = RADEON_READ(RADEON_BUS_CNTL) & ~RADEON_BUS_MASTER_DIS; | ||
| 1238 | RADEON_WRITE(RADEON_BUS_CNTL, tmp); | ||
| 1239 | |||
| 1240 | /* Sync everything up */ | 1224 | /* Sync everything up */ |
| 1241 | RADEON_WRITE(RADEON_ISYNC_CNTL, | 1225 | RADEON_WRITE(RADEON_ISYNC_CNTL, |
| 1242 | (RADEON_ISYNC_ANY2D_IDLE3D | | 1226 | (RADEON_ISYNC_ANY2D_IDLE3D | |
| 1243 | RADEON_ISYNC_ANY3D_IDLE2D | | 1227 | RADEON_ISYNC_ANY3D_IDLE2D | |
| 1244 | RADEON_ISYNC_WAIT_IDLEGUI | | 1228 | RADEON_ISYNC_WAIT_IDLEGUI | |
| 1245 | RADEON_ISYNC_CPSCRATCH_IDLEGUI)); | 1229 | RADEON_ISYNC_CPSCRATCH_IDLEGUI)); |
| 1230 | |||
| 1231 | } | ||
| 1232 | |||
| 1233 | static void radeon_test_writeback(drm_radeon_private_t * dev_priv) | ||
| 1234 | { | ||
| 1235 | u32 tmp; | ||
| 1236 | |||
| 1237 | /* Writeback doesn't seem to work everywhere, test it here and possibly | ||
| 1238 | * enable it if it appears to work | ||
| 1239 | */ | ||
| 1240 | DRM_WRITE32(dev_priv->ring_rptr, RADEON_SCRATCHOFF(1), 0); | ||
| 1241 | RADEON_WRITE(RADEON_SCRATCH_REG1, 0xdeadbeef); | ||
| 1242 | |||
| 1243 | for (tmp = 0; tmp < dev_priv->usec_timeout; tmp++) { | ||
| 1244 | if (DRM_READ32(dev_priv->ring_rptr, RADEON_SCRATCHOFF(1)) == | ||
| 1245 | 0xdeadbeef) | ||
| 1246 | break; | ||
| 1247 | DRM_UDELAY(1); | ||
| 1248 | } | ||
| 1249 | |||
| 1250 | if (tmp < dev_priv->usec_timeout) { | ||
| 1251 | dev_priv->writeback_works = 1; | ||
| 1252 | DRM_INFO("writeback test succeeded in %d usecs\n", tmp); | ||
| 1253 | } else { | ||
| 1254 | dev_priv->writeback_works = 0; | ||
| 1255 | DRM_INFO("writeback test failed\n"); | ||
| 1256 | } | ||
| 1257 | if (radeon_no_wb == 1) { | ||
| 1258 | dev_priv->writeback_works = 0; | ||
| 1259 | DRM_INFO("writeback forced off\n"); | ||
| 1260 | } | ||
| 1246 | } | 1261 | } |
| 1247 | 1262 | ||
| 1248 | /* Enable or disable PCI-E GART on the chip */ | 1263 | /* Enable or disable PCI-E GART on the chip */ |
| @@ -1317,6 +1332,14 @@ static int radeon_do_init_cp(drm_device_t * dev, drm_radeon_init_t * init) | |||
| 1317 | 1332 | ||
| 1318 | DRM_DEBUG("\n"); | 1333 | DRM_DEBUG("\n"); |
| 1319 | 1334 | ||
| 1335 | /* if we require new memory map but we don't have it fail */ | ||
| 1336 | if ((dev_priv->flags & CHIP_NEW_MEMMAP) && !dev_priv->new_memmap) | ||
| 1337 | { | ||
| 1338 | DRM_ERROR("Cannot initialise DRM on this card\nThis card requires a new X.org DDX\n"); | ||
| 1339 | radeon_do_cleanup_cp(dev); | ||
| 1340 | return DRM_ERR(EINVAL); | ||
| 1341 | } | ||
| 1342 | |||
| 1320 | if (init->is_pci && (dev_priv->flags & CHIP_IS_AGP)) | 1343 | if (init->is_pci && (dev_priv->flags & CHIP_IS_AGP)) |
| 1321 | { | 1344 | { |
| 1322 | DRM_DEBUG("Forcing AGP card to PCI mode\n"); | 1345 | DRM_DEBUG("Forcing AGP card to PCI mode\n"); |
| @@ -1496,6 +1519,9 @@ static int radeon_do_init_cp(drm_device_t * dev, drm_radeon_init_t * init) | |||
| 1496 | 1519 | ||
| 1497 | dev_priv->fb_location = (RADEON_READ(RADEON_MC_FB_LOCATION) | 1520 | dev_priv->fb_location = (RADEON_READ(RADEON_MC_FB_LOCATION) |
| 1498 | & 0xffff) << 16; | 1521 | & 0xffff) << 16; |
| 1522 | dev_priv->fb_size = | ||
| 1523 | ((RADEON_READ(RADEON_MC_FB_LOCATION) & 0xffff0000u) + 0x10000) | ||
| 1524 | - dev_priv->fb_location; | ||
| 1499 | 1525 | ||
| 1500 | dev_priv->front_pitch_offset = (((dev_priv->front_pitch / 64) << 22) | | 1526 | dev_priv->front_pitch_offset = (((dev_priv->front_pitch / 64) << 22) | |
| 1501 | ((dev_priv->front_offset | 1527 | ((dev_priv->front_offset |
| @@ -1510,8 +1536,46 @@ static int radeon_do_init_cp(drm_device_t * dev, drm_radeon_init_t * init) | |||
| 1510 | + dev_priv->fb_location) >> 10)); | 1536 | + dev_priv->fb_location) >> 10)); |
| 1511 | 1537 | ||
| 1512 | dev_priv->gart_size = init->gart_size; | 1538 | dev_priv->gart_size = init->gart_size; |
| 1513 | dev_priv->gart_vm_start = dev_priv->fb_location | 1539 | |
| 1514 | + RADEON_READ(RADEON_CONFIG_APER_SIZE); | 1540 | /* New let's set the memory map ... */ |
| 1541 | if (dev_priv->new_memmap) { | ||
| 1542 | u32 base = 0; | ||
| 1543 | |||
| 1544 | DRM_INFO("Setting GART location based on new memory map\n"); | ||
| 1545 | |||
| 1546 | /* If using AGP, try to locate the AGP aperture at the same | ||
| 1547 | * location in the card and on the bus, though we have to | ||
| 1548 | * align it down. | ||
| 1549 | */ | ||
| 1550 | #if __OS_HAS_AGP | ||
| 1551 | if (dev_priv->flags & CHIP_IS_AGP) { | ||
| 1552 | base = dev->agp->base; | ||
| 1553 | /* Check if valid */ | ||
| 1554 | if ((base + dev_priv->gart_size) > dev_priv->fb_location && | ||
| 1555 | base < (dev_priv->fb_location + dev_priv->fb_size)) { | ||
| 1556 | DRM_INFO("Can't use AGP base @0x%08lx, won't fit\n", | ||
| 1557 | dev->agp->base); | ||
| 1558 | base = 0; | ||
| 1559 | } | ||
| 1560 | } | ||
| 1561 | #endif | ||
| 1562 | /* If not or if AGP is at 0 (Macs), try to put it elsewhere */ | ||
| 1563 | if (base == 0) { | ||
| 1564 | base = dev_priv->fb_location + dev_priv->fb_size; | ||
| 1565 | if (((base + dev_priv->gart_size) & 0xfffffffful) | ||
| 1566 | < base) | ||
| 1567 | base = dev_priv->fb_location | ||
| 1568 | - dev_priv->gart_size; | ||
| 1569 | } | ||
| 1570 | dev_priv->gart_vm_start = base & 0xffc00000u; | ||
| 1571 | if (dev_priv->gart_vm_start != base) | ||
| 1572 | DRM_INFO("GART aligned down from 0x%08x to 0x%08x\n", | ||
| 1573 | base, dev_priv->gart_vm_start); | ||
| 1574 | } else { | ||
| 1575 | DRM_INFO("Setting GART location based on old memory map\n"); | ||
| 1576 | dev_priv->gart_vm_start = dev_priv->fb_location + | ||
| 1577 | RADEON_READ(RADEON_CONFIG_APER_SIZE); | ||
| 1578 | } | ||
| 1515 | 1579 | ||
| 1516 | #if __OS_HAS_AGP | 1580 | #if __OS_HAS_AGP |
| 1517 | if (dev_priv->flags & CHIP_IS_AGP) | 1581 | if (dev_priv->flags & CHIP_IS_AGP) |
| @@ -1596,6 +1660,7 @@ static int radeon_do_init_cp(drm_device_t * dev, drm_radeon_init_t * init) | |||
| 1596 | dev_priv->last_buf = 0; | 1660 | dev_priv->last_buf = 0; |
| 1597 | 1661 | ||
| 1598 | radeon_do_engine_reset(dev); | 1662 | radeon_do_engine_reset(dev); |
| 1663 | radeon_test_writeback(dev_priv); | ||
| 1599 | 1664 | ||
| 1600 | return 0; | 1665 | return 0; |
| 1601 | } | 1666 | } |
diff --git a/drivers/char/drm/radeon_drm.h b/drivers/char/drm/radeon_drm.h index 9c177a6b2a4c..c8e279e89c2e 100644 --- a/drivers/char/drm/radeon_drm.h +++ b/drivers/char/drm/radeon_drm.h | |||
| @@ -222,6 +222,7 @@ typedef union { | |||
| 222 | # define R300_WAIT_3D 0x2 | 222 | # define R300_WAIT_3D 0x2 |
| 223 | # define R300_WAIT_2D_CLEAN 0x3 | 223 | # define R300_WAIT_2D_CLEAN 0x3 |
| 224 | # define R300_WAIT_3D_CLEAN 0x4 | 224 | # define R300_WAIT_3D_CLEAN 0x4 |
| 225 | #define R300_CMD_SCRATCH 8 | ||
| 225 | 226 | ||
| 226 | typedef union { | 227 | typedef union { |
| 227 | unsigned int u; | 228 | unsigned int u; |
| @@ -247,6 +248,9 @@ typedef union { | |||
| 247 | struct { | 248 | struct { |
| 248 | unsigned char cmd_type, flags, pad0, pad1; | 249 | unsigned char cmd_type, flags, pad0, pad1; |
| 249 | } wait; | 250 | } wait; |
| 251 | struct { | ||
| 252 | unsigned char cmd_type, reg, n_bufs, flags; | ||
| 253 | } scratch; | ||
| 250 | } drm_r300_cmd_header_t; | 254 | } drm_r300_cmd_header_t; |
| 251 | 255 | ||
| 252 | #define RADEON_FRONT 0x1 | 256 | #define RADEON_FRONT 0x1 |
| @@ -697,6 +701,7 @@ typedef struct drm_radeon_setparam { | |||
| 697 | #define RADEON_SETPARAM_FB_LOCATION 1 /* determined framebuffer location */ | 701 | #define RADEON_SETPARAM_FB_LOCATION 1 /* determined framebuffer location */ |
| 698 | #define RADEON_SETPARAM_SWITCH_TILING 2 /* enable/disable color tiling */ | 702 | #define RADEON_SETPARAM_SWITCH_TILING 2 /* enable/disable color tiling */ |
| 699 | #define RADEON_SETPARAM_PCIGART_LOCATION 3 /* PCI Gart Location */ | 703 | #define RADEON_SETPARAM_PCIGART_LOCATION 3 /* PCI Gart Location */ |
| 704 | #define RADEON_SETPARAM_NEW_MEMMAP 4 /* Use new memory map */ | ||
| 700 | 705 | ||
| 701 | /* 1.14: Clients can allocate/free a surface | 706 | /* 1.14: Clients can allocate/free a surface |
| 702 | */ | 707 | */ |
diff --git a/drivers/char/drm/radeon_drv.h b/drivers/char/drm/radeon_drv.h index 1f7d2ab8c4fc..78345cee8f8e 100644 --- a/drivers/char/drm/radeon_drv.h +++ b/drivers/char/drm/radeon_drv.h | |||
| @@ -38,7 +38,7 @@ | |||
| 38 | 38 | ||
| 39 | #define DRIVER_NAME "radeon" | 39 | #define DRIVER_NAME "radeon" |
| 40 | #define DRIVER_DESC "ATI Radeon" | 40 | #define DRIVER_DESC "ATI Radeon" |
| 41 | #define DRIVER_DATE "20051229" | 41 | #define DRIVER_DATE "20060225" |
| 42 | 42 | ||
| 43 | /* Interface history: | 43 | /* Interface history: |
| 44 | * | 44 | * |
| @@ -91,9 +91,11 @@ | |||
| 91 | * 1.20- Add support for r300 texrect | 91 | * 1.20- Add support for r300 texrect |
| 92 | * 1.21- Add support for card type getparam | 92 | * 1.21- Add support for card type getparam |
| 93 | * 1.22- Add support for texture cache flushes (R300_TX_CNTL) | 93 | * 1.22- Add support for texture cache flushes (R300_TX_CNTL) |
| 94 | * 1.23- Add new radeon memory map work from benh | ||
| 95 | * 1.24- Add general-purpose packet for manipulating scratch registers (r300) | ||
| 94 | */ | 96 | */ |
| 95 | #define DRIVER_MAJOR 1 | 97 | #define DRIVER_MAJOR 1 |
| 96 | #define DRIVER_MINOR 22 | 98 | #define DRIVER_MINOR 24 |
| 97 | #define DRIVER_PATCHLEVEL 0 | 99 | #define DRIVER_PATCHLEVEL 0 |
| 98 | 100 | ||
| 99 | /* | 101 | /* |
| @@ -101,20 +103,21 @@ | |||
| 101 | */ | 103 | */ |
| 102 | enum radeon_family { | 104 | enum radeon_family { |
| 103 | CHIP_R100, | 105 | CHIP_R100, |
| 104 | CHIP_RS100, | ||
| 105 | CHIP_RV100, | 106 | CHIP_RV100, |
| 107 | CHIP_RS100, | ||
| 106 | CHIP_RV200, | 108 | CHIP_RV200, |
| 107 | CHIP_R200, | ||
| 108 | CHIP_RS200, | 109 | CHIP_RS200, |
| 109 | CHIP_R250, | 110 | CHIP_R200, |
| 110 | CHIP_RS250, | ||
| 111 | CHIP_RV250, | 111 | CHIP_RV250, |
| 112 | CHIP_RS300, | ||
| 112 | CHIP_RV280, | 113 | CHIP_RV280, |
| 113 | CHIP_R300, | 114 | CHIP_R300, |
| 114 | CHIP_RS300, | ||
| 115 | CHIP_R350, | 115 | CHIP_R350, |
| 116 | CHIP_RV350, | 116 | CHIP_RV350, |
| 117 | CHIP_RV380, | ||
| 117 | CHIP_R420, | 118 | CHIP_R420, |
| 119 | CHIP_RV410, | ||
| 120 | CHIP_RS400, | ||
| 118 | CHIP_LAST, | 121 | CHIP_LAST, |
| 119 | }; | 122 | }; |
| 120 | 123 | ||
| @@ -136,9 +139,11 @@ enum radeon_chip_flags { | |||
| 136 | CHIP_IS_AGP = 0x00080000UL, | 139 | CHIP_IS_AGP = 0x00080000UL, |
| 137 | CHIP_HAS_HIERZ = 0x00100000UL, | 140 | CHIP_HAS_HIERZ = 0x00100000UL, |
| 138 | CHIP_IS_PCIE = 0x00200000UL, | 141 | CHIP_IS_PCIE = 0x00200000UL, |
| 142 | CHIP_NEW_MEMMAP = 0x00400000UL, | ||
| 139 | }; | 143 | }; |
| 140 | 144 | ||
| 141 | #define GET_RING_HEAD(dev_priv) DRM_READ32( (dev_priv)->ring_rptr, 0 ) | 145 | #define GET_RING_HEAD(dev_priv) (dev_priv->writeback_works ? \ |
| 146 | DRM_READ32( (dev_priv)->ring_rptr, 0 ) : RADEON_READ(RADEON_CP_RB_RPTR)) | ||
| 142 | #define SET_RING_HEAD(dev_priv,val) DRM_WRITE32( (dev_priv)->ring_rptr, 0, (val) ) | 147 | #define SET_RING_HEAD(dev_priv,val) DRM_WRITE32( (dev_priv)->ring_rptr, 0, (val) ) |
| 143 | 148 | ||
| 144 | typedef struct drm_radeon_freelist { | 149 | typedef struct drm_radeon_freelist { |
| @@ -199,6 +204,8 @@ typedef struct drm_radeon_private { | |||
| 199 | drm_radeon_sarea_t *sarea_priv; | 204 | drm_radeon_sarea_t *sarea_priv; |
| 200 | 205 | ||
| 201 | u32 fb_location; | 206 | u32 fb_location; |
| 207 | u32 fb_size; | ||
| 208 | int new_memmap; | ||
| 202 | 209 | ||
| 203 | int gart_size; | 210 | int gart_size; |
| 204 | u32 gart_vm_start; | 211 | u32 gart_vm_start; |
| @@ -272,6 +279,8 @@ typedef struct drm_radeon_private { | |||
| 272 | unsigned long pcigart_offset; | 279 | unsigned long pcigart_offset; |
| 273 | drm_ati_pcigart_info gart_info; | 280 | drm_ati_pcigart_info gart_info; |
| 274 | 281 | ||
| 282 | u32 scratch_ages[5]; | ||
| 283 | |||
| 275 | /* starting from here on, data is preserved accross an open */ | 284 | /* starting from here on, data is preserved accross an open */ |
| 276 | uint32_t flags; /* see radeon_chip_flags */ | 285 | uint32_t flags; /* see radeon_chip_flags */ |
| 277 | } drm_radeon_private_t; | 286 | } drm_radeon_private_t; |
diff --git a/drivers/char/drm/radeon_state.c b/drivers/char/drm/radeon_state.c index 7bc27516d425..c5b8f774a599 100644 --- a/drivers/char/drm/radeon_state.c +++ b/drivers/char/drm/radeon_state.c | |||
| @@ -45,22 +45,53 @@ static __inline__ int radeon_check_and_fixup_offset(drm_radeon_private_t * | |||
| 45 | u32 off = *offset; | 45 | u32 off = *offset; |
| 46 | struct drm_radeon_driver_file_fields *radeon_priv; | 46 | struct drm_radeon_driver_file_fields *radeon_priv; |
| 47 | 47 | ||
| 48 | if (off >= dev_priv->fb_location && | 48 | /* Hrm ... the story of the offset ... So this function converts |
| 49 | off < (dev_priv->gart_vm_start + dev_priv->gart_size)) | 49 | * the various ideas of what userland clients might have for an |
| 50 | return 0; | 50 | * offset in the card address space into an offset into the card |
| 51 | 51 | * address space :) So with a sane client, it should just keep | |
| 52 | radeon_priv = filp_priv->driver_priv; | 52 | * the value intact and just do some boundary checking. However, |
| 53 | off += radeon_priv->radeon_fb_delta; | 53 | * not all clients are sane. Some older clients pass us 0 based |
| 54 | * offsets relative to the start of the framebuffer and some may | ||
| 55 | * assume the AGP aperture it appended to the framebuffer, so we | ||
| 56 | * try to detect those cases and fix them up. | ||
| 57 | * | ||
| 58 | * Note: It might be a good idea here to make sure the offset lands | ||
| 59 | * in some "allowed" area to protect things like the PCIE GART... | ||
| 60 | */ | ||
| 54 | 61 | ||
| 55 | DRM_DEBUG("offset fixed up to 0x%x\n", off); | 62 | /* First, the best case, the offset already lands in either the |
| 63 | * framebuffer or the GART mapped space | ||
| 64 | */ | ||
| 65 | if ((off >= dev_priv->fb_location && | ||
| 66 | off < (dev_priv->fb_location + dev_priv->fb_size)) || | ||
| 67 | (off >= dev_priv->gart_vm_start && | ||
| 68 | off < (dev_priv->gart_vm_start + dev_priv->gart_size))) | ||
| 69 | return 0; | ||
| 56 | 70 | ||
| 57 | if (off < dev_priv->fb_location || | 71 | /* Ok, that didn't happen... now check if we have a zero based |
| 58 | off >= (dev_priv->gart_vm_start + dev_priv->gart_size)) | 72 | * offset that fits in the framebuffer + gart space, apply the |
| 59 | return DRM_ERR(EINVAL); | 73 | * magic offset we get from SETPARAM or calculated from fb_location |
| 74 | */ | ||
| 75 | if (off < (dev_priv->fb_size + dev_priv->gart_size)) { | ||
| 76 | radeon_priv = filp_priv->driver_priv; | ||
| 77 | off += radeon_priv->radeon_fb_delta; | ||
| 78 | } | ||
| 60 | 79 | ||
| 61 | *offset = off; | 80 | /* Finally, assume we aimed at a GART offset if beyond the fb */ |
| 81 | if (off > (dev_priv->fb_location + dev_priv->fb_size)) | ||
| 82 | off = off - (dev_priv->fb_location + dev_priv->fb_size) + | ||
| 83 | dev_priv->gart_vm_start; | ||
| 62 | 84 | ||
| 63 | return 0; | 85 | /* Now recheck and fail if out of bounds */ |
| 86 | if ((off >= dev_priv->fb_location && | ||
| 87 | off < (dev_priv->fb_location + dev_priv->fb_size)) || | ||
| 88 | (off >= dev_priv->gart_vm_start && | ||
| 89 | off < (dev_priv->gart_vm_start + dev_priv->gart_size))) { | ||
| 90 | DRM_DEBUG("offset fixed up to 0x%x\n", off); | ||
| 91 | *offset = off; | ||
| 92 | return 0; | ||
| 93 | } | ||
| 94 | return DRM_ERR(EINVAL); | ||
| 64 | } | 95 | } |
| 65 | 96 | ||
| 66 | static __inline__ int radeon_check_and_fixup_packets(drm_radeon_private_t * | 97 | static __inline__ int radeon_check_and_fixup_packets(drm_radeon_private_t * |
| @@ -1939,11 +1970,6 @@ static int radeon_surface_alloc(DRM_IOCTL_ARGS) | |||
| 1939 | drm_radeon_private_t *dev_priv = dev->dev_private; | 1970 | drm_radeon_private_t *dev_priv = dev->dev_private; |
| 1940 | drm_radeon_surface_alloc_t alloc; | 1971 | drm_radeon_surface_alloc_t alloc; |
| 1941 | 1972 | ||
| 1942 | if (!dev_priv) { | ||
| 1943 | DRM_ERROR("%s called with no initialization\n", __FUNCTION__); | ||
| 1944 | return DRM_ERR(EINVAL); | ||
| 1945 | } | ||
| 1946 | |||
| 1947 | DRM_COPY_FROM_USER_IOCTL(alloc, | 1973 | DRM_COPY_FROM_USER_IOCTL(alloc, |
| 1948 | (drm_radeon_surface_alloc_t __user *) data, | 1974 | (drm_radeon_surface_alloc_t __user *) data, |
| 1949 | sizeof(alloc)); | 1975 | sizeof(alloc)); |
| @@ -1960,12 +1986,7 @@ static int radeon_surface_free(DRM_IOCTL_ARGS) | |||
| 1960 | drm_radeon_private_t *dev_priv = dev->dev_private; | 1986 | drm_radeon_private_t *dev_priv = dev->dev_private; |
| 1961 | drm_radeon_surface_free_t memfree; | 1987 | drm_radeon_surface_free_t memfree; |
| 1962 | 1988 | ||
| 1963 | if (!dev_priv) { | 1989 | DRM_COPY_FROM_USER_IOCTL(memfree, (drm_radeon_surface_free_t __user *) data, |
| 1964 | DRM_ERROR("%s called with no initialization\n", __FUNCTION__); | ||
| 1965 | return DRM_ERR(EINVAL); | ||
| 1966 | } | ||
| 1967 | |||
| 1968 | DRM_COPY_FROM_USER_IOCTL(memfree, (drm_radeon_mem_free_t __user *) data, | ||
| 1969 | sizeof(memfree)); | 1990 | sizeof(memfree)); |
| 1970 | 1991 | ||
| 1971 | if (free_surface(filp, dev_priv, memfree.address)) | 1992 | if (free_surface(filp, dev_priv, memfree.address)) |
| @@ -2100,11 +2121,6 @@ static int radeon_cp_vertex(DRM_IOCTL_ARGS) | |||
| 2100 | 2121 | ||
| 2101 | LOCK_TEST_WITH_RETURN(dev, filp); | 2122 | LOCK_TEST_WITH_RETURN(dev, filp); |
| 2102 | 2123 | ||
| 2103 | if (!dev_priv) { | ||
| 2104 | DRM_ERROR("%s called with no initialization\n", __FUNCTION__); | ||
| 2105 | return DRM_ERR(EINVAL); | ||
| 2106 | } | ||
| 2107 | |||
| 2108 | DRM_GET_PRIV_WITH_RETURN(filp_priv, filp); | 2124 | DRM_GET_PRIV_WITH_RETURN(filp_priv, filp); |
| 2109 | 2125 | ||
| 2110 | DRM_COPY_FROM_USER_IOCTL(vertex, (drm_radeon_vertex_t __user *) data, | 2126 | DRM_COPY_FROM_USER_IOCTL(vertex, (drm_radeon_vertex_t __user *) data, |
| @@ -2189,11 +2205,6 @@ static int radeon_cp_indices(DRM_IOCTL_ARGS) | |||
| 2189 | 2205 | ||
| 2190 | LOCK_TEST_WITH_RETURN(dev, filp); | 2206 | LOCK_TEST_WITH_RETURN(dev, filp); |
| 2191 | 2207 | ||
| 2192 | if (!dev_priv) { | ||
| 2193 | DRM_ERROR("%s called with no initialization\n", __FUNCTION__); | ||
| 2194 | return DRM_ERR(EINVAL); | ||
| 2195 | } | ||
| 2196 | |||
| 2197 | DRM_GET_PRIV_WITH_RETURN(filp_priv, filp); | 2208 | DRM_GET_PRIV_WITH_RETURN(filp_priv, filp); |
| 2198 | 2209 | ||
| 2199 | DRM_COPY_FROM_USER_IOCTL(elts, (drm_radeon_indices_t __user *) data, | 2210 | DRM_COPY_FROM_USER_IOCTL(elts, (drm_radeon_indices_t __user *) data, |
| @@ -2340,11 +2351,6 @@ static int radeon_cp_indirect(DRM_IOCTL_ARGS) | |||
| 2340 | 2351 | ||
| 2341 | LOCK_TEST_WITH_RETURN(dev, filp); | 2352 | LOCK_TEST_WITH_RETURN(dev, filp); |
| 2342 | 2353 | ||
| 2343 | if (!dev_priv) { | ||
| 2344 | DRM_ERROR("%s called with no initialization\n", __FUNCTION__); | ||
| 2345 | return DRM_ERR(EINVAL); | ||
| 2346 | } | ||
| 2347 | |||
| 2348 | DRM_COPY_FROM_USER_IOCTL(indirect, | 2354 | DRM_COPY_FROM_USER_IOCTL(indirect, |
| 2349 | (drm_radeon_indirect_t __user *) data, | 2355 | (drm_radeon_indirect_t __user *) data, |
| 2350 | sizeof(indirect)); | 2356 | sizeof(indirect)); |
| @@ -2417,11 +2423,6 @@ static int radeon_cp_vertex2(DRM_IOCTL_ARGS) | |||
| 2417 | 2423 | ||
| 2418 | LOCK_TEST_WITH_RETURN(dev, filp); | 2424 | LOCK_TEST_WITH_RETURN(dev, filp); |
| 2419 | 2425 | ||
| 2420 | if (!dev_priv) { | ||
| 2421 | DRM_ERROR("%s called with no initialization\n", __FUNCTION__); | ||
| 2422 | return DRM_ERR(EINVAL); | ||
| 2423 | } | ||
| 2424 | |||
| 2425 | DRM_GET_PRIV_WITH_RETURN(filp_priv, filp); | 2426 | DRM_GET_PRIV_WITH_RETURN(filp_priv, filp); |
| 2426 | 2427 | ||
| 2427 | DRM_COPY_FROM_USER_IOCTL(vertex, (drm_radeon_vertex2_t __user *) data, | 2428 | DRM_COPY_FROM_USER_IOCTL(vertex, (drm_radeon_vertex2_t __user *) data, |
| @@ -2738,11 +2739,6 @@ static int radeon_cp_cmdbuf(DRM_IOCTL_ARGS) | |||
| 2738 | 2739 | ||
| 2739 | LOCK_TEST_WITH_RETURN(dev, filp); | 2740 | LOCK_TEST_WITH_RETURN(dev, filp); |
| 2740 | 2741 | ||
| 2741 | if (!dev_priv) { | ||
| 2742 | DRM_ERROR("%s called with no initialization\n", __FUNCTION__); | ||
| 2743 | return DRM_ERR(EINVAL); | ||
| 2744 | } | ||
| 2745 | |||
| 2746 | DRM_GET_PRIV_WITH_RETURN(filp_priv, filp); | 2742 | DRM_GET_PRIV_WITH_RETURN(filp_priv, filp); |
| 2747 | 2743 | ||
| 2748 | DRM_COPY_FROM_USER_IOCTL(cmdbuf, | 2744 | DRM_COPY_FROM_USER_IOCTL(cmdbuf, |
| @@ -2897,11 +2893,6 @@ static int radeon_cp_getparam(DRM_IOCTL_ARGS) | |||
| 2897 | drm_radeon_getparam_t param; | 2893 | drm_radeon_getparam_t param; |
| 2898 | int value; | 2894 | int value; |
| 2899 | 2895 | ||
| 2900 | if (!dev_priv) { | ||
| 2901 | DRM_ERROR("%s called with no initialization\n", __FUNCTION__); | ||
| 2902 | return DRM_ERR(EINVAL); | ||
| 2903 | } | ||
| 2904 | |||
| 2905 | DRM_COPY_FROM_USER_IOCTL(param, (drm_radeon_getparam_t __user *) data, | 2896 | DRM_COPY_FROM_USER_IOCTL(param, (drm_radeon_getparam_t __user *) data, |
| 2906 | sizeof(param)); | 2897 | sizeof(param)); |
| 2907 | 2898 | ||
| @@ -2981,11 +2972,6 @@ static int radeon_cp_setparam(DRM_IOCTL_ARGS) | |||
| 2981 | drm_radeon_setparam_t sp; | 2972 | drm_radeon_setparam_t sp; |
| 2982 | struct drm_radeon_driver_file_fields *radeon_priv; | 2973 | struct drm_radeon_driver_file_fields *radeon_priv; |
| 2983 | 2974 | ||
| 2984 | if (!dev_priv) { | ||
| 2985 | DRM_ERROR("%s called with no initialization\n", __FUNCTION__); | ||
| 2986 | return DRM_ERR(EINVAL); | ||
| 2987 | } | ||
| 2988 | |||
| 2989 | DRM_GET_PRIV_WITH_RETURN(filp_priv, filp); | 2975 | DRM_GET_PRIV_WITH_RETURN(filp_priv, filp); |
| 2990 | 2976 | ||
| 2991 | DRM_COPY_FROM_USER_IOCTL(sp, (drm_radeon_setparam_t __user *) data, | 2977 | DRM_COPY_FROM_USER_IOCTL(sp, (drm_radeon_setparam_t __user *) data, |
| @@ -3012,6 +2998,9 @@ static int radeon_cp_setparam(DRM_IOCTL_ARGS) | |||
| 3012 | case RADEON_SETPARAM_PCIGART_LOCATION: | 2998 | case RADEON_SETPARAM_PCIGART_LOCATION: |
| 3013 | dev_priv->pcigart_offset = sp.value; | 2999 | dev_priv->pcigart_offset = sp.value; |
| 3014 | break; | 3000 | break; |
| 3001 | case RADEON_SETPARAM_NEW_MEMMAP: | ||
| 3002 | dev_priv->new_memmap = sp.value; | ||
| 3003 | break; | ||
| 3015 | default: | 3004 | default: |
| 3016 | DRM_DEBUG("Invalid parameter %d\n", sp.param); | 3005 | DRM_DEBUG("Invalid parameter %d\n", sp.param); |
| 3017 | return DRM_ERR(EINVAL); | 3006 | return DRM_ERR(EINVAL); |
diff --git a/drivers/char/drm/sis_mm.c b/drivers/char/drm/sis_mm.c index 6774d2fe3452..5e9936bc307f 100644 --- a/drivers/char/drm/sis_mm.c +++ b/drivers/char/drm/sis_mm.c | |||
| @@ -110,7 +110,7 @@ static int sis_fb_alloc(DRM_IOCTL_ARGS) | |||
| 110 | 110 | ||
| 111 | DRM_COPY_TO_USER_IOCTL(argp, fb, sizeof(fb)); | 111 | DRM_COPY_TO_USER_IOCTL(argp, fb, sizeof(fb)); |
| 112 | 112 | ||
| 113 | DRM_DEBUG("alloc fb, size = %d, offset = %ld\n", fb.size, req.offset); | 113 | DRM_DEBUG("alloc fb, size = %d, offset = %d\n", fb.size, req.offset); |
| 114 | 114 | ||
| 115 | return retval; | 115 | return retval; |
| 116 | } | 116 | } |
diff --git a/drivers/char/ipmi/ipmi_devintf.c b/drivers/char/ipmi/ipmi_devintf.c index 932feedda262..e1c95374984c 100644 --- a/drivers/char/ipmi/ipmi_devintf.c +++ b/drivers/char/ipmi/ipmi_devintf.c | |||
| @@ -42,7 +42,7 @@ | |||
| 42 | #include <linux/slab.h> | 42 | #include <linux/slab.h> |
| 43 | #include <linux/devfs_fs_kernel.h> | 43 | #include <linux/devfs_fs_kernel.h> |
| 44 | #include <linux/ipmi.h> | 44 | #include <linux/ipmi.h> |
| 45 | #include <asm/semaphore.h> | 45 | #include <linux/mutex.h> |
| 46 | #include <linux/init.h> | 46 | #include <linux/init.h> |
| 47 | #include <linux/device.h> | 47 | #include <linux/device.h> |
| 48 | #include <linux/compat.h> | 48 | #include <linux/compat.h> |
| @@ -55,7 +55,7 @@ struct ipmi_file_private | |||
| 55 | struct file *file; | 55 | struct file *file; |
| 56 | struct fasync_struct *fasync_queue; | 56 | struct fasync_struct *fasync_queue; |
| 57 | wait_queue_head_t wait; | 57 | wait_queue_head_t wait; |
| 58 | struct semaphore recv_sem; | 58 | struct mutex recv_mutex; |
| 59 | int default_retries; | 59 | int default_retries; |
| 60 | unsigned int default_retry_time_ms; | 60 | unsigned int default_retry_time_ms; |
| 61 | }; | 61 | }; |
| @@ -141,7 +141,7 @@ static int ipmi_open(struct inode *inode, struct file *file) | |||
| 141 | INIT_LIST_HEAD(&(priv->recv_msgs)); | 141 | INIT_LIST_HEAD(&(priv->recv_msgs)); |
| 142 | init_waitqueue_head(&priv->wait); | 142 | init_waitqueue_head(&priv->wait); |
| 143 | priv->fasync_queue = NULL; | 143 | priv->fasync_queue = NULL; |
| 144 | sema_init(&(priv->recv_sem), 1); | 144 | mutex_init(&priv->recv_mutex); |
| 145 | 145 | ||
| 146 | /* Use the low-level defaults. */ | 146 | /* Use the low-level defaults. */ |
| 147 | priv->default_retries = -1; | 147 | priv->default_retries = -1; |
| @@ -285,15 +285,15 @@ static int ipmi_ioctl(struct inode *inode, | |||
| 285 | break; | 285 | break; |
| 286 | } | 286 | } |
| 287 | 287 | ||
| 288 | /* We claim a semaphore because we don't want two | 288 | /* We claim a mutex because we don't want two |
| 289 | users getting something from the queue at a time. | 289 | users getting something from the queue at a time. |
| 290 | Since we have to release the spinlock before we can | 290 | Since we have to release the spinlock before we can |
| 291 | copy the data to the user, it's possible another | 291 | copy the data to the user, it's possible another |
| 292 | user will grab something from the queue, too. Then | 292 | user will grab something from the queue, too. Then |
| 293 | the messages might get out of order if something | 293 | the messages might get out of order if something |
| 294 | fails and the message gets put back onto the | 294 | fails and the message gets put back onto the |
| 295 | queue. This semaphore prevents that problem. */ | 295 | queue. This mutex prevents that problem. */ |
| 296 | down(&(priv->recv_sem)); | 296 | mutex_lock(&priv->recv_mutex); |
| 297 | 297 | ||
| 298 | /* Grab the message off the list. */ | 298 | /* Grab the message off the list. */ |
| 299 | spin_lock_irqsave(&(priv->recv_msg_lock), flags); | 299 | spin_lock_irqsave(&(priv->recv_msg_lock), flags); |
| @@ -352,7 +352,7 @@ static int ipmi_ioctl(struct inode *inode, | |||
| 352 | goto recv_putback_on_err; | 352 | goto recv_putback_on_err; |
| 353 | } | 353 | } |
| 354 | 354 | ||
| 355 | up(&(priv->recv_sem)); | 355 | mutex_unlock(&priv->recv_mutex); |
| 356 | ipmi_free_recv_msg(msg); | 356 | ipmi_free_recv_msg(msg); |
| 357 | break; | 357 | break; |
| 358 | 358 | ||
| @@ -362,11 +362,11 @@ static int ipmi_ioctl(struct inode *inode, | |||
| 362 | spin_lock_irqsave(&(priv->recv_msg_lock), flags); | 362 | spin_lock_irqsave(&(priv->recv_msg_lock), flags); |
| 363 | list_add(entry, &(priv->recv_msgs)); | 363 | list_add(entry, &(priv->recv_msgs)); |
| 364 | spin_unlock_irqrestore(&(priv->recv_msg_lock), flags); | 364 | spin_unlock_irqrestore(&(priv->recv_msg_lock), flags); |
| 365 | up(&(priv->recv_sem)); | 365 | mutex_unlock(&priv->recv_mutex); |
| 366 | break; | 366 | break; |
| 367 | 367 | ||
| 368 | recv_err: | 368 | recv_err: |
| 369 | up(&(priv->recv_sem)); | 369 | mutex_unlock(&priv->recv_mutex); |
| 370 | break; | 370 | break; |
| 371 | } | 371 | } |
| 372 | 372 | ||
diff --git a/drivers/char/ipmi/ipmi_kcs_sm.c b/drivers/char/ipmi/ipmi_kcs_sm.c index da1554194d3d..2062675f9e99 100644 --- a/drivers/char/ipmi/ipmi_kcs_sm.c +++ b/drivers/char/ipmi/ipmi_kcs_sm.c | |||
| @@ -227,7 +227,7 @@ static inline int check_ibf(struct si_sm_data *kcs, unsigned char status, | |||
| 227 | static inline int check_obf(struct si_sm_data *kcs, unsigned char status, | 227 | static inline int check_obf(struct si_sm_data *kcs, unsigned char status, |
| 228 | long time) | 228 | long time) |
| 229 | { | 229 | { |
| 230 | if (! GET_STATUS_OBF(status)) { | 230 | if (!GET_STATUS_OBF(status)) { |
| 231 | kcs->obf_timeout -= time; | 231 | kcs->obf_timeout -= time; |
| 232 | if (kcs->obf_timeout < 0) { | 232 | if (kcs->obf_timeout < 0) { |
| 233 | start_error_recovery(kcs, "OBF not ready in time"); | 233 | start_error_recovery(kcs, "OBF not ready in time"); |
| @@ -407,7 +407,7 @@ static enum si_sm_result kcs_event(struct si_sm_data *kcs, long time) | |||
| 407 | } | 407 | } |
| 408 | 408 | ||
| 409 | if (state == KCS_READ_STATE) { | 409 | if (state == KCS_READ_STATE) { |
| 410 | if (! check_obf(kcs, status, time)) | 410 | if (!check_obf(kcs, status, time)) |
| 411 | return SI_SM_CALL_WITH_DELAY; | 411 | return SI_SM_CALL_WITH_DELAY; |
| 412 | read_next_byte(kcs); | 412 | read_next_byte(kcs); |
| 413 | } else { | 413 | } else { |
| @@ -447,7 +447,7 @@ static enum si_sm_result kcs_event(struct si_sm_data *kcs, long time) | |||
| 447 | "Not in read state for error2"); | 447 | "Not in read state for error2"); |
| 448 | break; | 448 | break; |
| 449 | } | 449 | } |
| 450 | if (! check_obf(kcs, status, time)) | 450 | if (!check_obf(kcs, status, time)) |
| 451 | return SI_SM_CALL_WITH_DELAY; | 451 | return SI_SM_CALL_WITH_DELAY; |
| 452 | 452 | ||
| 453 | clear_obf(kcs, status); | 453 | clear_obf(kcs, status); |
| @@ -462,7 +462,7 @@ static enum si_sm_result kcs_event(struct si_sm_data *kcs, long time) | |||
| 462 | break; | 462 | break; |
| 463 | } | 463 | } |
| 464 | 464 | ||
| 465 | if (! check_obf(kcs, status, time)) | 465 | if (!check_obf(kcs, status, time)) |
| 466 | return SI_SM_CALL_WITH_DELAY; | 466 | return SI_SM_CALL_WITH_DELAY; |
| 467 | 467 | ||
| 468 | clear_obf(kcs, status); | 468 | clear_obf(kcs, status); |
diff --git a/drivers/char/ipmi/ipmi_msghandler.c b/drivers/char/ipmi/ipmi_msghandler.c index 40eb005b9d77..0ded046d5aa8 100644 --- a/drivers/char/ipmi/ipmi_msghandler.c +++ b/drivers/char/ipmi/ipmi_msghandler.c | |||
| @@ -38,6 +38,7 @@ | |||
| 38 | #include <linux/sched.h> | 38 | #include <linux/sched.h> |
| 39 | #include <linux/poll.h> | 39 | #include <linux/poll.h> |
| 40 | #include <linux/spinlock.h> | 40 | #include <linux/spinlock.h> |
| 41 | #include <linux/mutex.h> | ||
| 41 | #include <linux/slab.h> | 42 | #include <linux/slab.h> |
| 42 | #include <linux/ipmi.h> | 43 | #include <linux/ipmi.h> |
| 43 | #include <linux/ipmi_smi.h> | 44 | #include <linux/ipmi_smi.h> |
| @@ -234,7 +235,7 @@ struct ipmi_smi | |||
| 234 | 235 | ||
| 235 | /* The list of command receivers that are registered for commands | 236 | /* The list of command receivers that are registered for commands |
| 236 | on this interface. */ | 237 | on this interface. */ |
| 237 | struct semaphore cmd_rcvrs_lock; | 238 | struct mutex cmd_rcvrs_mutex; |
| 238 | struct list_head cmd_rcvrs; | 239 | struct list_head cmd_rcvrs; |
| 239 | 240 | ||
| 240 | /* Events that were queues because no one was there to receive | 241 | /* Events that were queues because no one was there to receive |
| @@ -387,10 +388,10 @@ static void clean_up_interface_data(ipmi_smi_t intf) | |||
| 387 | 388 | ||
| 388 | /* Wholesale remove all the entries from the list in the | 389 | /* Wholesale remove all the entries from the list in the |
| 389 | * interface and wait for RCU to know that none are in use. */ | 390 | * interface and wait for RCU to know that none are in use. */ |
| 390 | down(&intf->cmd_rcvrs_lock); | 391 | mutex_lock(&intf->cmd_rcvrs_mutex); |
| 391 | list_add_rcu(&list, &intf->cmd_rcvrs); | 392 | list_add_rcu(&list, &intf->cmd_rcvrs); |
| 392 | list_del_rcu(&intf->cmd_rcvrs); | 393 | list_del_rcu(&intf->cmd_rcvrs); |
| 393 | up(&intf->cmd_rcvrs_lock); | 394 | mutex_unlock(&intf->cmd_rcvrs_mutex); |
| 394 | synchronize_rcu(); | 395 | synchronize_rcu(); |
| 395 | 396 | ||
| 396 | list_for_each_entry_safe(rcvr, rcvr2, &list, link) | 397 | list_for_each_entry_safe(rcvr, rcvr2, &list, link) |
| @@ -557,7 +558,7 @@ unsigned int ipmi_addr_length(int addr_type) | |||
| 557 | 558 | ||
| 558 | static void deliver_response(struct ipmi_recv_msg *msg) | 559 | static void deliver_response(struct ipmi_recv_msg *msg) |
| 559 | { | 560 | { |
| 560 | if (! msg->user) { | 561 | if (!msg->user) { |
| 561 | ipmi_smi_t intf = msg->user_msg_data; | 562 | ipmi_smi_t intf = msg->user_msg_data; |
| 562 | unsigned long flags; | 563 | unsigned long flags; |
| 563 | 564 | ||
| @@ -598,11 +599,11 @@ static int intf_next_seq(ipmi_smi_t intf, | |||
| 598 | (i+1)%IPMI_IPMB_NUM_SEQ != intf->curr_seq; | 599 | (i+1)%IPMI_IPMB_NUM_SEQ != intf->curr_seq; |
| 599 | i = (i+1)%IPMI_IPMB_NUM_SEQ) | 600 | i = (i+1)%IPMI_IPMB_NUM_SEQ) |
| 600 | { | 601 | { |
| 601 | if (! intf->seq_table[i].inuse) | 602 | if (!intf->seq_table[i].inuse) |
| 602 | break; | 603 | break; |
| 603 | } | 604 | } |
| 604 | 605 | ||
| 605 | if (! intf->seq_table[i].inuse) { | 606 | if (!intf->seq_table[i].inuse) { |
| 606 | intf->seq_table[i].recv_msg = recv_msg; | 607 | intf->seq_table[i].recv_msg = recv_msg; |
| 607 | 608 | ||
| 608 | /* Start with the maximum timeout, when the send response | 609 | /* Start with the maximum timeout, when the send response |
| @@ -763,7 +764,7 @@ int ipmi_create_user(unsigned int if_num, | |||
| 763 | } | 764 | } |
| 764 | 765 | ||
| 765 | new_user = kmalloc(sizeof(*new_user), GFP_KERNEL); | 766 | new_user = kmalloc(sizeof(*new_user), GFP_KERNEL); |
| 766 | if (! new_user) | 767 | if (!new_user) |
| 767 | return -ENOMEM; | 768 | return -ENOMEM; |
| 768 | 769 | ||
| 769 | spin_lock_irqsave(&interfaces_lock, flags); | 770 | spin_lock_irqsave(&interfaces_lock, flags); |
| @@ -819,14 +820,13 @@ static void free_user(struct kref *ref) | |||
| 819 | 820 | ||
| 820 | int ipmi_destroy_user(ipmi_user_t user) | 821 | int ipmi_destroy_user(ipmi_user_t user) |
| 821 | { | 822 | { |
| 822 | int rv = -ENODEV; | ||
| 823 | ipmi_smi_t intf = user->intf; | 823 | ipmi_smi_t intf = user->intf; |
| 824 | int i; | 824 | int i; |
| 825 | unsigned long flags; | 825 | unsigned long flags; |
| 826 | struct cmd_rcvr *rcvr; | 826 | struct cmd_rcvr *rcvr; |
| 827 | struct cmd_rcvr *rcvrs = NULL; | 827 | struct cmd_rcvr *rcvrs = NULL; |
| 828 | 828 | ||
| 829 | user->valid = 1; | 829 | user->valid = 0; |
| 830 | 830 | ||
| 831 | /* Remove the user from the interface's sequence table. */ | 831 | /* Remove the user from the interface's sequence table. */ |
| 832 | spin_lock_irqsave(&intf->seq_lock, flags); | 832 | spin_lock_irqsave(&intf->seq_lock, flags); |
| @@ -847,7 +847,7 @@ int ipmi_destroy_user(ipmi_user_t user) | |||
| 847 | * since other things may be using it till we do | 847 | * since other things may be using it till we do |
| 848 | * synchronize_rcu()) then free everything in that list. | 848 | * synchronize_rcu()) then free everything in that list. |
| 849 | */ | 849 | */ |
| 850 | down(&intf->cmd_rcvrs_lock); | 850 | mutex_lock(&intf->cmd_rcvrs_mutex); |
| 851 | list_for_each_entry_rcu(rcvr, &intf->cmd_rcvrs, link) { | 851 | list_for_each_entry_rcu(rcvr, &intf->cmd_rcvrs, link) { |
| 852 | if (rcvr->user == user) { | 852 | if (rcvr->user == user) { |
| 853 | list_del_rcu(&rcvr->link); | 853 | list_del_rcu(&rcvr->link); |
| @@ -855,7 +855,7 @@ int ipmi_destroy_user(ipmi_user_t user) | |||
| 855 | rcvrs = rcvr; | 855 | rcvrs = rcvr; |
| 856 | } | 856 | } |
| 857 | } | 857 | } |
| 858 | up(&intf->cmd_rcvrs_lock); | 858 | mutex_unlock(&intf->cmd_rcvrs_mutex); |
| 859 | synchronize_rcu(); | 859 | synchronize_rcu(); |
| 860 | while (rcvrs) { | 860 | while (rcvrs) { |
| 861 | rcvr = rcvrs; | 861 | rcvr = rcvrs; |
| @@ -871,7 +871,7 @@ int ipmi_destroy_user(ipmi_user_t user) | |||
| 871 | 871 | ||
| 872 | kref_put(&user->refcount, free_user); | 872 | kref_put(&user->refcount, free_user); |
| 873 | 873 | ||
| 874 | return rv; | 874 | return 0; |
| 875 | } | 875 | } |
| 876 | 876 | ||
| 877 | void ipmi_get_version(ipmi_user_t user, | 877 | void ipmi_get_version(ipmi_user_t user, |
| @@ -936,7 +936,8 @@ int ipmi_set_gets_events(ipmi_user_t user, int val) | |||
| 936 | 936 | ||
| 937 | if (val) { | 937 | if (val) { |
| 938 | /* Deliver any queued events. */ | 938 | /* Deliver any queued events. */ |
| 939 | list_for_each_entry_safe(msg, msg2, &intf->waiting_events, link) { | 939 | list_for_each_entry_safe(msg, msg2, &intf->waiting_events, |
| 940 | link) { | ||
| 940 | list_del(&msg->link); | 941 | list_del(&msg->link); |
| 941 | list_add_tail(&msg->link, &msgs); | 942 | list_add_tail(&msg->link, &msgs); |
| 942 | } | 943 | } |
| @@ -978,13 +979,13 @@ int ipmi_register_for_cmd(ipmi_user_t user, | |||
| 978 | 979 | ||
| 979 | 980 | ||
| 980 | rcvr = kmalloc(sizeof(*rcvr), GFP_KERNEL); | 981 | rcvr = kmalloc(sizeof(*rcvr), GFP_KERNEL); |
| 981 | if (! rcvr) | 982 | if (!rcvr) |
| 982 | return -ENOMEM; | 983 | return -ENOMEM; |
| 983 | rcvr->cmd = cmd; | 984 | rcvr->cmd = cmd; |
| 984 | rcvr->netfn = netfn; | 985 | rcvr->netfn = netfn; |
| 985 | rcvr->user = user; | 986 | rcvr->user = user; |
| 986 | 987 | ||
| 987 | down(&intf->cmd_rcvrs_lock); | 988 | mutex_lock(&intf->cmd_rcvrs_mutex); |
| 988 | /* Make sure the command/netfn is not already registered. */ | 989 | /* Make sure the command/netfn is not already registered. */ |
| 989 | entry = find_cmd_rcvr(intf, netfn, cmd); | 990 | entry = find_cmd_rcvr(intf, netfn, cmd); |
| 990 | if (entry) { | 991 | if (entry) { |
| @@ -995,7 +996,7 @@ int ipmi_register_for_cmd(ipmi_user_t user, | |||
| 995 | list_add_rcu(&rcvr->link, &intf->cmd_rcvrs); | 996 | list_add_rcu(&rcvr->link, &intf->cmd_rcvrs); |
| 996 | 997 | ||
| 997 | out_unlock: | 998 | out_unlock: |
| 998 | up(&intf->cmd_rcvrs_lock); | 999 | mutex_unlock(&intf->cmd_rcvrs_mutex); |
| 999 | if (rv) | 1000 | if (rv) |
| 1000 | kfree(rcvr); | 1001 | kfree(rcvr); |
| 1001 | 1002 | ||
| @@ -1009,17 +1010,17 @@ int ipmi_unregister_for_cmd(ipmi_user_t user, | |||
| 1009 | ipmi_smi_t intf = user->intf; | 1010 | ipmi_smi_t intf = user->intf; |
| 1010 | struct cmd_rcvr *rcvr; | 1011 | struct cmd_rcvr *rcvr; |
| 1011 | 1012 | ||
| 1012 | down(&intf->cmd_rcvrs_lock); | 1013 | mutex_lock(&intf->cmd_rcvrs_mutex); |
| 1013 | /* Make sure the command/netfn is not already registered. */ | 1014 | /* Make sure the command/netfn is not already registered. */ |
| 1014 | rcvr = find_cmd_rcvr(intf, netfn, cmd); | 1015 | rcvr = find_cmd_rcvr(intf, netfn, cmd); |
| 1015 | if ((rcvr) && (rcvr->user == user)) { | 1016 | if ((rcvr) && (rcvr->user == user)) { |
| 1016 | list_del_rcu(&rcvr->link); | 1017 | list_del_rcu(&rcvr->link); |
| 1017 | up(&intf->cmd_rcvrs_lock); | 1018 | mutex_unlock(&intf->cmd_rcvrs_mutex); |
| 1018 | synchronize_rcu(); | 1019 | synchronize_rcu(); |
| 1019 | kfree(rcvr); | 1020 | kfree(rcvr); |
| 1020 | return 0; | 1021 | return 0; |
| 1021 | } else { | 1022 | } else { |
| 1022 | up(&intf->cmd_rcvrs_lock); | 1023 | mutex_unlock(&intf->cmd_rcvrs_mutex); |
| 1023 | return -ENOENT; | 1024 | return -ENOENT; |
| 1024 | } | 1025 | } |
| 1025 | } | 1026 | } |
| @@ -1514,7 +1515,7 @@ int ipmi_request_settime(ipmi_user_t user, | |||
| 1514 | unsigned char saddr, lun; | 1515 | unsigned char saddr, lun; |
| 1515 | int rv; | 1516 | int rv; |
| 1516 | 1517 | ||
| 1517 | if (! user) | 1518 | if (!user) |
| 1518 | return -EINVAL; | 1519 | return -EINVAL; |
| 1519 | rv = check_addr(user->intf, addr, &saddr, &lun); | 1520 | rv = check_addr(user->intf, addr, &saddr, &lun); |
| 1520 | if (rv) | 1521 | if (rv) |
| @@ -1545,7 +1546,7 @@ int ipmi_request_supply_msgs(ipmi_user_t user, | |||
| 1545 | unsigned char saddr, lun; | 1546 | unsigned char saddr, lun; |
| 1546 | int rv; | 1547 | int rv; |
| 1547 | 1548 | ||
| 1548 | if (! user) | 1549 | if (!user) |
| 1549 | return -EINVAL; | 1550 | return -EINVAL; |
| 1550 | rv = check_addr(user->intf, addr, &saddr, &lun); | 1551 | rv = check_addr(user->intf, addr, &saddr, &lun); |
| 1551 | if (rv) | 1552 | if (rv) |
| @@ -1570,7 +1571,7 @@ static int ipmb_file_read_proc(char *page, char **start, off_t off, | |||
| 1570 | char *out = (char *) page; | 1571 | char *out = (char *) page; |
| 1571 | ipmi_smi_t intf = data; | 1572 | ipmi_smi_t intf = data; |
| 1572 | int i; | 1573 | int i; |
| 1573 | int rv= 0; | 1574 | int rv = 0; |
| 1574 | 1575 | ||
| 1575 | for (i = 0; i < IPMI_MAX_CHANNELS; i++) | 1576 | for (i = 0; i < IPMI_MAX_CHANNELS; i++) |
| 1576 | rv += sprintf(out+rv, "%x ", intf->channels[i].address); | 1577 | rv += sprintf(out+rv, "%x ", intf->channels[i].address); |
| @@ -1989,7 +1990,7 @@ static int ipmi_bmc_register(ipmi_smi_t intf) | |||
| 1989 | } else { | 1990 | } else { |
| 1990 | bmc->dev = platform_device_alloc("ipmi_bmc", | 1991 | bmc->dev = platform_device_alloc("ipmi_bmc", |
| 1991 | bmc->id.device_id); | 1992 | bmc->id.device_id); |
| 1992 | if (! bmc->dev) { | 1993 | if (!bmc->dev) { |
| 1993 | printk(KERN_ERR | 1994 | printk(KERN_ERR |
| 1994 | "ipmi_msghandler:" | 1995 | "ipmi_msghandler:" |
| 1995 | " Unable to allocate platform device\n"); | 1996 | " Unable to allocate platform device\n"); |
| @@ -2305,8 +2306,7 @@ int ipmi_register_smi(struct ipmi_smi_handlers *handlers, | |||
| 2305 | void *send_info, | 2306 | void *send_info, |
| 2306 | struct ipmi_device_id *device_id, | 2307 | struct ipmi_device_id *device_id, |
| 2307 | struct device *si_dev, | 2308 | struct device *si_dev, |
| 2308 | unsigned char slave_addr, | 2309 | unsigned char slave_addr) |
| 2309 | ipmi_smi_t *new_intf) | ||
| 2310 | { | 2310 | { |
| 2311 | int i, j; | 2311 | int i, j; |
| 2312 | int rv; | 2312 | int rv; |
| @@ -2366,7 +2366,7 @@ int ipmi_register_smi(struct ipmi_smi_handlers *handlers, | |||
| 2366 | spin_lock_init(&intf->events_lock); | 2366 | spin_lock_init(&intf->events_lock); |
| 2367 | INIT_LIST_HEAD(&intf->waiting_events); | 2367 | INIT_LIST_HEAD(&intf->waiting_events); |
| 2368 | intf->waiting_events_count = 0; | 2368 | intf->waiting_events_count = 0; |
| 2369 | init_MUTEX(&intf->cmd_rcvrs_lock); | 2369 | mutex_init(&intf->cmd_rcvrs_mutex); |
| 2370 | INIT_LIST_HEAD(&intf->cmd_rcvrs); | 2370 | INIT_LIST_HEAD(&intf->cmd_rcvrs); |
| 2371 | init_waitqueue_head(&intf->waitq); | 2371 | init_waitqueue_head(&intf->waitq); |
| 2372 | 2372 | ||
| @@ -2388,9 +2388,9 @@ int ipmi_register_smi(struct ipmi_smi_handlers *handlers, | |||
| 2388 | if (rv) | 2388 | if (rv) |
| 2389 | goto out; | 2389 | goto out; |
| 2390 | 2390 | ||
| 2391 | /* FIXME - this is an ugly kludge, this sets the intf for the | 2391 | rv = handlers->start_processing(send_info, intf); |
| 2392 | caller before sending any messages with it. */ | 2392 | if (rv) |
| 2393 | *new_intf = intf; | 2393 | goto out; |
| 2394 | 2394 | ||
| 2395 | get_guid(intf); | 2395 | get_guid(intf); |
| 2396 | 2396 | ||
| @@ -2622,7 +2622,7 @@ static int handle_ipmb_get_msg_cmd(ipmi_smi_t intf, | |||
| 2622 | spin_unlock_irqrestore(&intf->counter_lock, flags); | 2622 | spin_unlock_irqrestore(&intf->counter_lock, flags); |
| 2623 | 2623 | ||
| 2624 | recv_msg = ipmi_alloc_recv_msg(); | 2624 | recv_msg = ipmi_alloc_recv_msg(); |
| 2625 | if (! recv_msg) { | 2625 | if (!recv_msg) { |
| 2626 | /* We couldn't allocate memory for the | 2626 | /* We couldn't allocate memory for the |
| 2627 | message, so requeue it for handling | 2627 | message, so requeue it for handling |
| 2628 | later. */ | 2628 | later. */ |
| @@ -2777,7 +2777,7 @@ static int handle_lan_get_msg_cmd(ipmi_smi_t intf, | |||
| 2777 | spin_unlock_irqrestore(&intf->counter_lock, flags); | 2777 | spin_unlock_irqrestore(&intf->counter_lock, flags); |
| 2778 | 2778 | ||
| 2779 | recv_msg = ipmi_alloc_recv_msg(); | 2779 | recv_msg = ipmi_alloc_recv_msg(); |
| 2780 | if (! recv_msg) { | 2780 | if (!recv_msg) { |
| 2781 | /* We couldn't allocate memory for the | 2781 | /* We couldn't allocate memory for the |
| 2782 | message, so requeue it for handling | 2782 | message, so requeue it for handling |
| 2783 | later. */ | 2783 | later. */ |
| @@ -2869,13 +2869,14 @@ static int handle_read_event_rsp(ipmi_smi_t intf, | |||
| 2869 | events. */ | 2869 | events. */ |
| 2870 | rcu_read_lock(); | 2870 | rcu_read_lock(); |
| 2871 | list_for_each_entry_rcu(user, &intf->users, link) { | 2871 | list_for_each_entry_rcu(user, &intf->users, link) { |
| 2872 | if (! user->gets_events) | 2872 | if (!user->gets_events) |
| 2873 | continue; | 2873 | continue; |
| 2874 | 2874 | ||
| 2875 | recv_msg = ipmi_alloc_recv_msg(); | 2875 | recv_msg = ipmi_alloc_recv_msg(); |
| 2876 | if (! recv_msg) { | 2876 | if (!recv_msg) { |
| 2877 | rcu_read_unlock(); | 2877 | rcu_read_unlock(); |
| 2878 | list_for_each_entry_safe(recv_msg, recv_msg2, &msgs, link) { | 2878 | list_for_each_entry_safe(recv_msg, recv_msg2, &msgs, |
| 2879 | link) { | ||
| 2879 | list_del(&recv_msg->link); | 2880 | list_del(&recv_msg->link); |
| 2880 | ipmi_free_recv_msg(recv_msg); | 2881 | ipmi_free_recv_msg(recv_msg); |
| 2881 | } | 2882 | } |
| @@ -2905,7 +2906,7 @@ static int handle_read_event_rsp(ipmi_smi_t intf, | |||
| 2905 | /* No one to receive the message, put it in queue if there's | 2906 | /* No one to receive the message, put it in queue if there's |
| 2906 | not already too many things in the queue. */ | 2907 | not already too many things in the queue. */ |
| 2907 | recv_msg = ipmi_alloc_recv_msg(); | 2908 | recv_msg = ipmi_alloc_recv_msg(); |
| 2908 | if (! recv_msg) { | 2909 | if (!recv_msg) { |
| 2909 | /* We couldn't allocate memory for the | 2910 | /* We couldn't allocate memory for the |
| 2910 | message, so requeue it for handling | 2911 | message, so requeue it for handling |
| 2911 | later. */ | 2912 | later. */ |
| @@ -3190,7 +3191,7 @@ void ipmi_smi_watchdog_pretimeout(ipmi_smi_t intf) | |||
| 3190 | 3191 | ||
| 3191 | rcu_read_lock(); | 3192 | rcu_read_lock(); |
| 3192 | list_for_each_entry_rcu(user, &intf->users, link) { | 3193 | list_for_each_entry_rcu(user, &intf->users, link) { |
| 3193 | if (! user->handler->ipmi_watchdog_pretimeout) | 3194 | if (!user->handler->ipmi_watchdog_pretimeout) |
| 3194 | continue; | 3195 | continue; |
| 3195 | 3196 | ||
| 3196 | user->handler->ipmi_watchdog_pretimeout(user->handler_data); | 3197 | user->handler->ipmi_watchdog_pretimeout(user->handler_data); |
| @@ -3278,7 +3279,7 @@ static void check_msg_timeout(ipmi_smi_t intf, struct seq_table *ent, | |||
| 3278 | 3279 | ||
| 3279 | smi_msg = smi_from_recv_msg(intf, ent->recv_msg, slot, | 3280 | smi_msg = smi_from_recv_msg(intf, ent->recv_msg, slot, |
| 3280 | ent->seqid); | 3281 | ent->seqid); |
| 3281 | if (! smi_msg) | 3282 | if (!smi_msg) |
| 3282 | return; | 3283 | return; |
| 3283 | 3284 | ||
| 3284 | spin_unlock_irqrestore(&intf->seq_lock, *flags); | 3285 | spin_unlock_irqrestore(&intf->seq_lock, *flags); |
| @@ -3314,8 +3315,9 @@ static void ipmi_timeout_handler(long timeout_period) | |||
| 3314 | 3315 | ||
| 3315 | /* See if any waiting messages need to be processed. */ | 3316 | /* See if any waiting messages need to be processed. */ |
| 3316 | spin_lock_irqsave(&intf->waiting_msgs_lock, flags); | 3317 | spin_lock_irqsave(&intf->waiting_msgs_lock, flags); |
| 3317 | list_for_each_entry_safe(smi_msg, smi_msg2, &intf->waiting_msgs, link) { | 3318 | list_for_each_entry_safe(smi_msg, smi_msg2, |
| 3318 | if (! handle_new_recv_msg(intf, smi_msg)) { | 3319 | &intf->waiting_msgs, link) { |
| 3320 | if (!handle_new_recv_msg(intf, smi_msg)) { | ||
| 3319 | list_del(&smi_msg->link); | 3321 | list_del(&smi_msg->link); |
| 3320 | ipmi_free_smi_msg(smi_msg); | 3322 | ipmi_free_smi_msg(smi_msg); |
| 3321 | } else { | 3323 | } else { |
diff --git a/drivers/char/ipmi/ipmi_poweroff.c b/drivers/char/ipmi/ipmi_poweroff.c index 786a2802ca34..d0b5c08e7b4e 100644 --- a/drivers/char/ipmi/ipmi_poweroff.c +++ b/drivers/char/ipmi/ipmi_poweroff.c | |||
| @@ -346,7 +346,7 @@ static int ipmi_dell_chassis_detect (ipmi_user_t user) | |||
| 346 | { | 346 | { |
| 347 | const char ipmi_version_major = ipmi_version & 0xF; | 347 | const char ipmi_version_major = ipmi_version & 0xF; |
| 348 | const char ipmi_version_minor = (ipmi_version >> 4) & 0xF; | 348 | const char ipmi_version_minor = (ipmi_version >> 4) & 0xF; |
| 349 | const char mfr[3]=DELL_IANA_MFR_ID; | 349 | const char mfr[3] = DELL_IANA_MFR_ID; |
| 350 | if (!memcmp(mfr, &mfg_id, sizeof(mfr)) && | 350 | if (!memcmp(mfr, &mfg_id, sizeof(mfr)) && |
| 351 | ipmi_version_major <= 1 && | 351 | ipmi_version_major <= 1 && |
| 352 | ipmi_version_minor < 5) | 352 | ipmi_version_minor < 5) |
diff --git a/drivers/char/ipmi/ipmi_si_intf.c b/drivers/char/ipmi/ipmi_si_intf.c index 35fbd4d8ed4b..a86c0f29953e 100644 --- a/drivers/char/ipmi/ipmi_si_intf.c +++ b/drivers/char/ipmi/ipmi_si_intf.c | |||
| @@ -803,7 +803,7 @@ static int ipmi_thread(void *data) | |||
| 803 | set_user_nice(current, 19); | 803 | set_user_nice(current, 19); |
| 804 | while (!kthread_should_stop()) { | 804 | while (!kthread_should_stop()) { |
| 805 | spin_lock_irqsave(&(smi_info->si_lock), flags); | 805 | spin_lock_irqsave(&(smi_info->si_lock), flags); |
| 806 | smi_result=smi_event_handler(smi_info, 0); | 806 | smi_result = smi_event_handler(smi_info, 0); |
| 807 | spin_unlock_irqrestore(&(smi_info->si_lock), flags); | 807 | spin_unlock_irqrestore(&(smi_info->si_lock), flags); |
| 808 | if (smi_result == SI_SM_CALL_WITHOUT_DELAY) { | 808 | if (smi_result == SI_SM_CALL_WITHOUT_DELAY) { |
| 809 | /* do nothing */ | 809 | /* do nothing */ |
| @@ -972,10 +972,37 @@ static irqreturn_t si_bt_irq_handler(int irq, void *data, struct pt_regs *regs) | |||
| 972 | return si_irq_handler(irq, data, regs); | 972 | return si_irq_handler(irq, data, regs); |
| 973 | } | 973 | } |
| 974 | 974 | ||
| 975 | static int smi_start_processing(void *send_info, | ||
| 976 | ipmi_smi_t intf) | ||
| 977 | { | ||
| 978 | struct smi_info *new_smi = send_info; | ||
| 979 | |||
| 980 | new_smi->intf = intf; | ||
| 981 | |||
| 982 | /* Set up the timer that drives the interface. */ | ||
| 983 | setup_timer(&new_smi->si_timer, smi_timeout, (long)new_smi); | ||
| 984 | new_smi->last_timeout_jiffies = jiffies; | ||
| 985 | mod_timer(&new_smi->si_timer, jiffies + SI_TIMEOUT_JIFFIES); | ||
| 986 | |||
| 987 | if (new_smi->si_type != SI_BT) { | ||
| 988 | new_smi->thread = kthread_run(ipmi_thread, new_smi, | ||
| 989 | "kipmi%d", new_smi->intf_num); | ||
| 990 | if (IS_ERR(new_smi->thread)) { | ||
| 991 | printk(KERN_NOTICE "ipmi_si_intf: Could not start" | ||
| 992 | " kernel thread due to error %ld, only using" | ||
| 993 | " timers to drive the interface\n", | ||
| 994 | PTR_ERR(new_smi->thread)); | ||
| 995 | new_smi->thread = NULL; | ||
| 996 | } | ||
| 997 | } | ||
| 998 | |||
| 999 | return 0; | ||
| 1000 | } | ||
| 975 | 1001 | ||
| 976 | static struct ipmi_smi_handlers handlers = | 1002 | static struct ipmi_smi_handlers handlers = |
| 977 | { | 1003 | { |
| 978 | .owner = THIS_MODULE, | 1004 | .owner = THIS_MODULE, |
| 1005 | .start_processing = smi_start_processing, | ||
| 979 | .sender = sender, | 1006 | .sender = sender, |
| 980 | .request_events = request_events, | 1007 | .request_events = request_events, |
| 981 | .set_run_to_completion = set_run_to_completion, | 1008 | .set_run_to_completion = set_run_to_completion, |
| @@ -987,7 +1014,7 @@ static struct ipmi_smi_handlers handlers = | |||
| 987 | 1014 | ||
| 988 | #define SI_MAX_PARMS 4 | 1015 | #define SI_MAX_PARMS 4 |
| 989 | static LIST_HEAD(smi_infos); | 1016 | static LIST_HEAD(smi_infos); |
| 990 | static DECLARE_MUTEX(smi_infos_lock); | 1017 | static DEFINE_MUTEX(smi_infos_lock); |
| 991 | static int smi_num; /* Used to sequence the SMIs */ | 1018 | static int smi_num; /* Used to sequence the SMIs */ |
| 992 | 1019 | ||
| 993 | #define DEFAULT_REGSPACING 1 | 1020 | #define DEFAULT_REGSPACING 1 |
| @@ -2162,9 +2189,13 @@ static void setup_xaction_handlers(struct smi_info *smi_info) | |||
| 2162 | 2189 | ||
| 2163 | static inline void wait_for_timer_and_thread(struct smi_info *smi_info) | 2190 | static inline void wait_for_timer_and_thread(struct smi_info *smi_info) |
| 2164 | { | 2191 | { |
| 2165 | if (smi_info->thread != NULL && smi_info->thread != ERR_PTR(-ENOMEM)) | 2192 | if (smi_info->intf) { |
| 2166 | kthread_stop(smi_info->thread); | 2193 | /* The timer and thread are only running if the |
| 2167 | del_timer_sync(&smi_info->si_timer); | 2194 | interface has been started up and registered. */ |
| 2195 | if (smi_info->thread != NULL) | ||
| 2196 | kthread_stop(smi_info->thread); | ||
| 2197 | del_timer_sync(&smi_info->si_timer); | ||
| 2198 | } | ||
| 2168 | } | 2199 | } |
| 2169 | 2200 | ||
| 2170 | static struct ipmi_default_vals | 2201 | static struct ipmi_default_vals |
| @@ -2245,7 +2276,7 @@ static int try_smi_init(struct smi_info *new_smi) | |||
| 2245 | new_smi->slave_addr, new_smi->irq); | 2276 | new_smi->slave_addr, new_smi->irq); |
| 2246 | } | 2277 | } |
| 2247 | 2278 | ||
| 2248 | down(&smi_infos_lock); | 2279 | mutex_lock(&smi_infos_lock); |
| 2249 | if (!is_new_interface(new_smi)) { | 2280 | if (!is_new_interface(new_smi)) { |
| 2250 | printk(KERN_WARNING "ipmi_si: duplicate interface\n"); | 2281 | printk(KERN_WARNING "ipmi_si: duplicate interface\n"); |
| 2251 | rv = -EBUSY; | 2282 | rv = -EBUSY; |
| @@ -2341,21 +2372,6 @@ static int try_smi_init(struct smi_info *new_smi) | |||
| 2341 | if (new_smi->irq) | 2372 | if (new_smi->irq) |
| 2342 | new_smi->si_state = SI_CLEARING_FLAGS_THEN_SET_IRQ; | 2373 | new_smi->si_state = SI_CLEARING_FLAGS_THEN_SET_IRQ; |
| 2343 | 2374 | ||
| 2344 | /* The ipmi_register_smi() code does some operations to | ||
| 2345 | determine the channel information, so we must be ready to | ||
| 2346 | handle operations before it is called. This means we have | ||
| 2347 | to stop the timer if we get an error after this point. */ | ||
| 2348 | init_timer(&(new_smi->si_timer)); | ||
| 2349 | new_smi->si_timer.data = (long) new_smi; | ||
| 2350 | new_smi->si_timer.function = smi_timeout; | ||
| 2351 | new_smi->last_timeout_jiffies = jiffies; | ||
| 2352 | new_smi->si_timer.expires = jiffies + SI_TIMEOUT_JIFFIES; | ||
| 2353 | |||
| 2354 | add_timer(&(new_smi->si_timer)); | ||
| 2355 | if (new_smi->si_type != SI_BT) | ||
| 2356 | new_smi->thread = kthread_run(ipmi_thread, new_smi, | ||
| 2357 | "kipmi%d", new_smi->intf_num); | ||
| 2358 | |||
| 2359 | if (!new_smi->dev) { | 2375 | if (!new_smi->dev) { |
| 2360 | /* If we don't already have a device from something | 2376 | /* If we don't already have a device from something |
| 2361 | * else (like PCI), then register a new one. */ | 2377 | * else (like PCI), then register a new one. */ |
| @@ -2365,7 +2381,7 @@ static int try_smi_init(struct smi_info *new_smi) | |||
| 2365 | printk(KERN_ERR | 2381 | printk(KERN_ERR |
| 2366 | "ipmi_si_intf:" | 2382 | "ipmi_si_intf:" |
| 2367 | " Unable to allocate platform device\n"); | 2383 | " Unable to allocate platform device\n"); |
| 2368 | goto out_err_stop_timer; | 2384 | goto out_err; |
| 2369 | } | 2385 | } |
| 2370 | new_smi->dev = &new_smi->pdev->dev; | 2386 | new_smi->dev = &new_smi->pdev->dev; |
| 2371 | new_smi->dev->driver = &ipmi_driver; | 2387 | new_smi->dev->driver = &ipmi_driver; |
| @@ -2377,7 +2393,7 @@ static int try_smi_init(struct smi_info *new_smi) | |||
| 2377 | " Unable to register system interface device:" | 2393 | " Unable to register system interface device:" |
| 2378 | " %d\n", | 2394 | " %d\n", |
| 2379 | rv); | 2395 | rv); |
| 2380 | goto out_err_stop_timer; | 2396 | goto out_err; |
| 2381 | } | 2397 | } |
| 2382 | new_smi->dev_registered = 1; | 2398 | new_smi->dev_registered = 1; |
| 2383 | } | 2399 | } |
| @@ -2386,8 +2402,7 @@ static int try_smi_init(struct smi_info *new_smi) | |||
| 2386 | new_smi, | 2402 | new_smi, |
| 2387 | &new_smi->device_id, | 2403 | &new_smi->device_id, |
| 2388 | new_smi->dev, | 2404 | new_smi->dev, |
| 2389 | new_smi->slave_addr, | 2405 | new_smi->slave_addr); |
| 2390 | &(new_smi->intf)); | ||
| 2391 | if (rv) { | 2406 | if (rv) { |
| 2392 | printk(KERN_ERR | 2407 | printk(KERN_ERR |
| 2393 | "ipmi_si: Unable to register device: error %d\n", | 2408 | "ipmi_si: Unable to register device: error %d\n", |
| @@ -2417,7 +2432,7 @@ static int try_smi_init(struct smi_info *new_smi) | |||
| 2417 | 2432 | ||
| 2418 | list_add_tail(&new_smi->link, &smi_infos); | 2433 | list_add_tail(&new_smi->link, &smi_infos); |
| 2419 | 2434 | ||
| 2420 | up(&smi_infos_lock); | 2435 | mutex_unlock(&smi_infos_lock); |
| 2421 | 2436 | ||
| 2422 | printk(" IPMI %s interface initialized\n",si_to_str[new_smi->si_type]); | 2437 | printk(" IPMI %s interface initialized\n",si_to_str[new_smi->si_type]); |
| 2423 | 2438 | ||
| @@ -2454,7 +2469,7 @@ static int try_smi_init(struct smi_info *new_smi) | |||
| 2454 | 2469 | ||
| 2455 | kfree(new_smi); | 2470 | kfree(new_smi); |
| 2456 | 2471 | ||
| 2457 | up(&smi_infos_lock); | 2472 | mutex_unlock(&smi_infos_lock); |
| 2458 | 2473 | ||
| 2459 | return rv; | 2474 | return rv; |
| 2460 | } | 2475 | } |
| @@ -2512,26 +2527,26 @@ static __devinit int init_ipmi_si(void) | |||
| 2512 | #endif | 2527 | #endif |
| 2513 | 2528 | ||
| 2514 | if (si_trydefaults) { | 2529 | if (si_trydefaults) { |
| 2515 | down(&smi_infos_lock); | 2530 | mutex_lock(&smi_infos_lock); |
| 2516 | if (list_empty(&smi_infos)) { | 2531 | if (list_empty(&smi_infos)) { |
| 2517 | /* No BMC was found, try defaults. */ | 2532 | /* No BMC was found, try defaults. */ |
| 2518 | up(&smi_infos_lock); | 2533 | mutex_unlock(&smi_infos_lock); |
| 2519 | default_find_bmc(); | 2534 | default_find_bmc(); |
| 2520 | } else { | 2535 | } else { |
| 2521 | up(&smi_infos_lock); | 2536 | mutex_unlock(&smi_infos_lock); |
| 2522 | } | 2537 | } |
| 2523 | } | 2538 | } |
| 2524 | 2539 | ||
| 2525 | down(&smi_infos_lock); | 2540 | mutex_lock(&smi_infos_lock); |
| 2526 | if (list_empty(&smi_infos)) { | 2541 | if (list_empty(&smi_infos)) { |
| 2527 | up(&smi_infos_lock); | 2542 | mutex_unlock(&smi_infos_lock); |
| 2528 | #ifdef CONFIG_PCI | 2543 | #ifdef CONFIG_PCI |
| 2529 | pci_unregister_driver(&ipmi_pci_driver); | 2544 | pci_unregister_driver(&ipmi_pci_driver); |
| 2530 | #endif | 2545 | #endif |
| 2531 | printk("ipmi_si: Unable to find any System Interface(s)\n"); | 2546 | printk("ipmi_si: Unable to find any System Interface(s)\n"); |
| 2532 | return -ENODEV; | 2547 | return -ENODEV; |
| 2533 | } else { | 2548 | } else { |
| 2534 | up(&smi_infos_lock); | 2549 | mutex_unlock(&smi_infos_lock); |
| 2535 | return 0; | 2550 | return 0; |
| 2536 | } | 2551 | } |
| 2537 | } | 2552 | } |
| @@ -2607,10 +2622,10 @@ static __exit void cleanup_ipmi_si(void) | |||
| 2607 | pci_unregister_driver(&ipmi_pci_driver); | 2622 | pci_unregister_driver(&ipmi_pci_driver); |
| 2608 | #endif | 2623 | #endif |
| 2609 | 2624 | ||
| 2610 | down(&smi_infos_lock); | 2625 | mutex_lock(&smi_infos_lock); |
| 2611 | list_for_each_entry_safe(e, tmp_e, &smi_infos, link) | 2626 | list_for_each_entry_safe(e, tmp_e, &smi_infos, link) |
| 2612 | cleanup_one_si(e); | 2627 | cleanup_one_si(e); |
| 2613 | up(&smi_infos_lock); | 2628 | mutex_unlock(&smi_infos_lock); |
| 2614 | 2629 | ||
| 2615 | driver_unregister(&ipmi_driver); | 2630 | driver_unregister(&ipmi_driver); |
| 2616 | } | 2631 | } |
diff --git a/drivers/char/ipmi/ipmi_watchdog.c b/drivers/char/ipmi/ipmi_watchdog.c index 7ece9f3c8f70..2d11ddd99e55 100644 --- a/drivers/char/ipmi/ipmi_watchdog.c +++ b/drivers/char/ipmi/ipmi_watchdog.c | |||
| @@ -39,6 +39,7 @@ | |||
| 39 | #include <linux/watchdog.h> | 39 | #include <linux/watchdog.h> |
| 40 | #include <linux/miscdevice.h> | 40 | #include <linux/miscdevice.h> |
| 41 | #include <linux/init.h> | 41 | #include <linux/init.h> |
| 42 | #include <linux/completion.h> | ||
| 42 | #include <linux/rwsem.h> | 43 | #include <linux/rwsem.h> |
| 43 | #include <linux/errno.h> | 44 | #include <linux/errno.h> |
| 44 | #include <asm/uaccess.h> | 45 | #include <asm/uaccess.h> |
| @@ -303,21 +304,22 @@ static int ipmi_heartbeat(void); | |||
| 303 | static void panic_halt_ipmi_heartbeat(void); | 304 | static void panic_halt_ipmi_heartbeat(void); |
| 304 | 305 | ||
| 305 | 306 | ||
| 306 | /* We use a semaphore to make sure that only one thing can send a set | 307 | /* We use a mutex to make sure that only one thing can send a set |
| 307 | timeout at one time, because we only have one copy of the data. | 308 | timeout at one time, because we only have one copy of the data. |
| 308 | The semaphore is claimed when the set_timeout is sent and freed | 309 | The mutex is claimed when the set_timeout is sent and freed |
| 309 | when both messages are free. */ | 310 | when both messages are free. */ |
| 310 | static atomic_t set_timeout_tofree = ATOMIC_INIT(0); | 311 | static atomic_t set_timeout_tofree = ATOMIC_INIT(0); |
| 311 | static DECLARE_MUTEX(set_timeout_lock); | 312 | static DEFINE_MUTEX(set_timeout_lock); |
| 313 | static DECLARE_COMPLETION(set_timeout_wait); | ||
| 312 | static void set_timeout_free_smi(struct ipmi_smi_msg *msg) | 314 | static void set_timeout_free_smi(struct ipmi_smi_msg *msg) |
| 313 | { | 315 | { |
| 314 | if (atomic_dec_and_test(&set_timeout_tofree)) | 316 | if (atomic_dec_and_test(&set_timeout_tofree)) |
| 315 | up(&set_timeout_lock); | 317 | complete(&set_timeout_wait); |
| 316 | } | 318 | } |
| 317 | static void set_timeout_free_recv(struct ipmi_recv_msg *msg) | 319 | static void set_timeout_free_recv(struct ipmi_recv_msg *msg) |
| 318 | { | 320 | { |
| 319 | if (atomic_dec_and_test(&set_timeout_tofree)) | 321 | if (atomic_dec_and_test(&set_timeout_tofree)) |
| 320 | up(&set_timeout_lock); | 322 | complete(&set_timeout_wait); |
| 321 | } | 323 | } |
| 322 | static struct ipmi_smi_msg set_timeout_smi_msg = | 324 | static struct ipmi_smi_msg set_timeout_smi_msg = |
| 323 | { | 325 | { |
| @@ -399,7 +401,7 @@ static int ipmi_set_timeout(int do_heartbeat) | |||
| 399 | 401 | ||
| 400 | 402 | ||
| 401 | /* We can only send one of these at a time. */ | 403 | /* We can only send one of these at a time. */ |
| 402 | down(&set_timeout_lock); | 404 | mutex_lock(&set_timeout_lock); |
| 403 | 405 | ||
| 404 | atomic_set(&set_timeout_tofree, 2); | 406 | atomic_set(&set_timeout_tofree, 2); |
| 405 | 407 | ||
| @@ -407,16 +409,21 @@ static int ipmi_set_timeout(int do_heartbeat) | |||
| 407 | &set_timeout_recv_msg, | 409 | &set_timeout_recv_msg, |
| 408 | &send_heartbeat_now); | 410 | &send_heartbeat_now); |
| 409 | if (rv) { | 411 | if (rv) { |
| 410 | up(&set_timeout_lock); | 412 | mutex_unlock(&set_timeout_lock); |
| 411 | } else { | 413 | goto out; |
| 412 | if ((do_heartbeat == IPMI_SET_TIMEOUT_FORCE_HB) | ||
| 413 | || ((send_heartbeat_now) | ||
| 414 | && (do_heartbeat == IPMI_SET_TIMEOUT_HB_IF_NECESSARY))) | ||
| 415 | { | ||
| 416 | rv = ipmi_heartbeat(); | ||
| 417 | } | ||
| 418 | } | 414 | } |
| 419 | 415 | ||
| 416 | wait_for_completion(&set_timeout_wait); | ||
| 417 | |||
| 418 | if ((do_heartbeat == IPMI_SET_TIMEOUT_FORCE_HB) | ||
| 419 | || ((send_heartbeat_now) | ||
| 420 | && (do_heartbeat == IPMI_SET_TIMEOUT_HB_IF_NECESSARY))) | ||
| 421 | { | ||
| 422 | rv = ipmi_heartbeat(); | ||
| 423 | } | ||
| 424 | mutex_unlock(&set_timeout_lock); | ||
| 425 | |||
| 426 | out: | ||
| 420 | return rv; | 427 | return rv; |
| 421 | } | 428 | } |
| 422 | 429 | ||
| @@ -458,17 +465,17 @@ static void panic_halt_ipmi_set_timeout(void) | |||
| 458 | The semaphore is claimed when the set_timeout is sent and freed | 465 | The semaphore is claimed when the set_timeout is sent and freed |
| 459 | when both messages are free. */ | 466 | when both messages are free. */ |
| 460 | static atomic_t heartbeat_tofree = ATOMIC_INIT(0); | 467 | static atomic_t heartbeat_tofree = ATOMIC_INIT(0); |
| 461 | static DECLARE_MUTEX(heartbeat_lock); | 468 | static DEFINE_MUTEX(heartbeat_lock); |
| 462 | static DECLARE_MUTEX_LOCKED(heartbeat_wait_lock); | 469 | static DECLARE_COMPLETION(heartbeat_wait); |
| 463 | static void heartbeat_free_smi(struct ipmi_smi_msg *msg) | 470 | static void heartbeat_free_smi(struct ipmi_smi_msg *msg) |
| 464 | { | 471 | { |
| 465 | if (atomic_dec_and_test(&heartbeat_tofree)) | 472 | if (atomic_dec_and_test(&heartbeat_tofree)) |
| 466 | up(&heartbeat_wait_lock); | 473 | complete(&heartbeat_wait); |
| 467 | } | 474 | } |
| 468 | static void heartbeat_free_recv(struct ipmi_recv_msg *msg) | 475 | static void heartbeat_free_recv(struct ipmi_recv_msg *msg) |
| 469 | { | 476 | { |
| 470 | if (atomic_dec_and_test(&heartbeat_tofree)) | 477 | if (atomic_dec_and_test(&heartbeat_tofree)) |
| 471 | up(&heartbeat_wait_lock); | 478 | complete(&heartbeat_wait); |
| 472 | } | 479 | } |
| 473 | static struct ipmi_smi_msg heartbeat_smi_msg = | 480 | static struct ipmi_smi_msg heartbeat_smi_msg = |
| 474 | { | 481 | { |
| @@ -511,14 +518,14 @@ static int ipmi_heartbeat(void) | |||
| 511 | return ipmi_set_timeout(IPMI_SET_TIMEOUT_HB_IF_NECESSARY); | 518 | return ipmi_set_timeout(IPMI_SET_TIMEOUT_HB_IF_NECESSARY); |
| 512 | } | 519 | } |
| 513 | 520 | ||
| 514 | down(&heartbeat_lock); | 521 | mutex_lock(&heartbeat_lock); |
| 515 | 522 | ||
| 516 | atomic_set(&heartbeat_tofree, 2); | 523 | atomic_set(&heartbeat_tofree, 2); |
| 517 | 524 | ||
| 518 | /* Don't reset the timer if we have the timer turned off, that | 525 | /* Don't reset the timer if we have the timer turned off, that |
| 519 | re-enables the watchdog. */ | 526 | re-enables the watchdog. */ |
| 520 | if (ipmi_watchdog_state == WDOG_TIMEOUT_NONE) { | 527 | if (ipmi_watchdog_state == WDOG_TIMEOUT_NONE) { |
| 521 | up(&heartbeat_lock); | 528 | mutex_unlock(&heartbeat_lock); |
| 522 | return 0; | 529 | return 0; |
| 523 | } | 530 | } |
| 524 | 531 | ||
| @@ -539,14 +546,14 @@ static int ipmi_heartbeat(void) | |||
| 539 | &heartbeat_recv_msg, | 546 | &heartbeat_recv_msg, |
| 540 | 1); | 547 | 1); |
| 541 | if (rv) { | 548 | if (rv) { |
| 542 | up(&heartbeat_lock); | 549 | mutex_unlock(&heartbeat_lock); |
| 543 | printk(KERN_WARNING PFX "heartbeat failure: %d\n", | 550 | printk(KERN_WARNING PFX "heartbeat failure: %d\n", |
| 544 | rv); | 551 | rv); |
| 545 | return rv; | 552 | return rv; |
| 546 | } | 553 | } |
| 547 | 554 | ||
| 548 | /* Wait for the heartbeat to be sent. */ | 555 | /* Wait for the heartbeat to be sent. */ |
| 549 | down(&heartbeat_wait_lock); | 556 | wait_for_completion(&heartbeat_wait); |
| 550 | 557 | ||
| 551 | if (heartbeat_recv_msg.msg.data[0] != 0) { | 558 | if (heartbeat_recv_msg.msg.data[0] != 0) { |
| 552 | /* Got an error in the heartbeat response. It was already | 559 | /* Got an error in the heartbeat response. It was already |
| @@ -555,7 +562,7 @@ static int ipmi_heartbeat(void) | |||
| 555 | rv = -EINVAL; | 562 | rv = -EINVAL; |
| 556 | } | 563 | } |
| 557 | 564 | ||
| 558 | up(&heartbeat_lock); | 565 | mutex_unlock(&heartbeat_lock); |
| 559 | 566 | ||
| 560 | return rv; | 567 | return rv; |
| 561 | } | 568 | } |
| @@ -589,7 +596,7 @@ static void panic_halt_ipmi_heartbeat(void) | |||
| 589 | 1); | 596 | 1); |
| 590 | } | 597 | } |
| 591 | 598 | ||
| 592 | static struct watchdog_info ident= | 599 | static struct watchdog_info ident = |
| 593 | { | 600 | { |
| 594 | .options = 0, /* WDIOF_SETTIMEOUT, */ | 601 | .options = 0, /* WDIOF_SETTIMEOUT, */ |
| 595 | .firmware_version = 1, | 602 | .firmware_version = 1, |
| @@ -790,13 +797,13 @@ static int ipmi_fasync(int fd, struct file *file, int on) | |||
| 790 | 797 | ||
| 791 | static int ipmi_close(struct inode *ino, struct file *filep) | 798 | static int ipmi_close(struct inode *ino, struct file *filep) |
| 792 | { | 799 | { |
| 793 | if (iminor(ino)==WATCHDOG_MINOR) | 800 | if (iminor(ino) == WATCHDOG_MINOR) { |
| 794 | { | ||
| 795 | if (expect_close == 42) { | 801 | if (expect_close == 42) { |
| 796 | ipmi_watchdog_state = WDOG_TIMEOUT_NONE; | 802 | ipmi_watchdog_state = WDOG_TIMEOUT_NONE; |
| 797 | ipmi_set_timeout(IPMI_SET_TIMEOUT_NO_HB); | 803 | ipmi_set_timeout(IPMI_SET_TIMEOUT_NO_HB); |
| 798 | } else { | 804 | } else { |
| 799 | printk(KERN_CRIT PFX "Unexpected close, not stopping watchdog!\n"); | 805 | printk(KERN_CRIT PFX |
| 806 | "Unexpected close, not stopping watchdog!\n"); | ||
| 800 | ipmi_heartbeat(); | 807 | ipmi_heartbeat(); |
| 801 | } | 808 | } |
| 802 | clear_bit(0, &ipmi_wdog_open); | 809 | clear_bit(0, &ipmi_wdog_open); |
diff --git a/drivers/char/istallion.c b/drivers/char/istallion.c index e5247f85a446..ef20c1fc9c4c 100644 --- a/drivers/char/istallion.c +++ b/drivers/char/istallion.c | |||
| @@ -706,7 +706,6 @@ static int stli_portcmdstats(stliport_t *portp); | |||
| 706 | static int stli_clrportstats(stliport_t *portp, comstats_t __user *cp); | 706 | static int stli_clrportstats(stliport_t *portp, comstats_t __user *cp); |
| 707 | static int stli_getportstruct(stliport_t __user *arg); | 707 | static int stli_getportstruct(stliport_t __user *arg); |
| 708 | static int stli_getbrdstruct(stlibrd_t __user *arg); | 708 | static int stli_getbrdstruct(stlibrd_t __user *arg); |
| 709 | static void *stli_memalloc(int len); | ||
| 710 | static stlibrd_t *stli_allocbrd(void); | 709 | static stlibrd_t *stli_allocbrd(void); |
| 711 | 710 | ||
| 712 | static void stli_ecpinit(stlibrd_t *brdp); | 711 | static void stli_ecpinit(stlibrd_t *brdp); |
| @@ -997,17 +996,6 @@ static int stli_parsebrd(stlconf_t *confp, char **argp) | |||
| 997 | 996 | ||
| 998 | /*****************************************************************************/ | 997 | /*****************************************************************************/ |
| 999 | 998 | ||
| 1000 | /* | ||
| 1001 | * Local driver kernel malloc routine. | ||
| 1002 | */ | ||
| 1003 | |||
| 1004 | static void *stli_memalloc(int len) | ||
| 1005 | { | ||
| 1006 | return((void *) kmalloc(len, GFP_KERNEL)); | ||
| 1007 | } | ||
| 1008 | |||
| 1009 | /*****************************************************************************/ | ||
| 1010 | |||
| 1011 | static int stli_open(struct tty_struct *tty, struct file *filp) | 999 | static int stli_open(struct tty_struct *tty, struct file *filp) |
| 1012 | { | 1000 | { |
| 1013 | stlibrd_t *brdp; | 1001 | stlibrd_t *brdp; |
| @@ -3227,13 +3215,12 @@ static int stli_initports(stlibrd_t *brdp) | |||
| 3227 | #endif | 3215 | #endif |
| 3228 | 3216 | ||
| 3229 | for (i = 0, panelnr = 0, panelport = 0; (i < brdp->nrports); i++) { | 3217 | for (i = 0, panelnr = 0, panelport = 0; (i < brdp->nrports); i++) { |
| 3230 | portp = (stliport_t *) stli_memalloc(sizeof(stliport_t)); | 3218 | portp = kzalloc(sizeof(stliport_t), GFP_KERNEL); |
| 3231 | if (portp == (stliport_t *) NULL) { | 3219 | if (!portp) { |
| 3232 | printk("STALLION: failed to allocate port structure\n"); | 3220 | printk("STALLION: failed to allocate port structure\n"); |
| 3233 | continue; | 3221 | continue; |
| 3234 | } | 3222 | } |
| 3235 | 3223 | ||
| 3236 | memset(portp, 0, sizeof(stliport_t)); | ||
| 3237 | portp->magic = STLI_PORTMAGIC; | 3224 | portp->magic = STLI_PORTMAGIC; |
| 3238 | portp->portnr = i; | 3225 | portp->portnr = i; |
| 3239 | portp->brdnr = brdp->brdnr; | 3226 | portp->brdnr = brdp->brdnr; |
| @@ -4610,14 +4597,13 @@ static stlibrd_t *stli_allocbrd(void) | |||
| 4610 | { | 4597 | { |
| 4611 | stlibrd_t *brdp; | 4598 | stlibrd_t *brdp; |
| 4612 | 4599 | ||
| 4613 | brdp = (stlibrd_t *) stli_memalloc(sizeof(stlibrd_t)); | 4600 | brdp = kzalloc(sizeof(stlibrd_t), GFP_KERNEL); |
| 4614 | if (brdp == (stlibrd_t *) NULL) { | 4601 | if (!brdp) { |
| 4615 | printk(KERN_ERR "STALLION: failed to allocate memory " | 4602 | printk(KERN_ERR "STALLION: failed to allocate memory " |
| 4616 | "(size=%d)\n", sizeof(stlibrd_t)); | 4603 | "(size=%d)\n", sizeof(stlibrd_t)); |
| 4617 | return((stlibrd_t *) NULL); | 4604 | return NULL; |
| 4618 | } | 4605 | } |
| 4619 | 4606 | ||
| 4620 | memset(brdp, 0, sizeof(stlibrd_t)); | ||
| 4621 | brdp->magic = STLI_BOARDMAGIC; | 4607 | brdp->magic = STLI_BOARDMAGIC; |
| 4622 | return(brdp); | 4608 | return(brdp); |
| 4623 | } | 4609 | } |
| @@ -5210,12 +5196,12 @@ int __init stli_init(void) | |||
| 5210 | /* | 5196 | /* |
| 5211 | * Allocate a temporary write buffer. | 5197 | * Allocate a temporary write buffer. |
| 5212 | */ | 5198 | */ |
| 5213 | stli_tmpwritebuf = (char *) stli_memalloc(STLI_TXBUFSIZE); | 5199 | stli_tmpwritebuf = kmalloc(STLI_TXBUFSIZE, GFP_KERNEL); |
| 5214 | if (stli_tmpwritebuf == (char *) NULL) | 5200 | if (!stli_tmpwritebuf) |
| 5215 | printk(KERN_ERR "STALLION: failed to allocate memory " | 5201 | printk(KERN_ERR "STALLION: failed to allocate memory " |
| 5216 | "(size=%d)\n", STLI_TXBUFSIZE); | 5202 | "(size=%d)\n", STLI_TXBUFSIZE); |
| 5217 | stli_txcookbuf = stli_memalloc(STLI_TXBUFSIZE); | 5203 | stli_txcookbuf = kmalloc(STLI_TXBUFSIZE, GFP_KERNEL); |
| 5218 | if (stli_txcookbuf == (char *) NULL) | 5204 | if (!stli_txcookbuf) |
| 5219 | printk(KERN_ERR "STALLION: failed to allocate memory " | 5205 | printk(KERN_ERR "STALLION: failed to allocate memory " |
| 5220 | "(size=%d)\n", STLI_TXBUFSIZE); | 5206 | "(size=%d)\n", STLI_TXBUFSIZE); |
| 5221 | 5207 | ||
diff --git a/drivers/char/stallion.c b/drivers/char/stallion.c index 3f5d6077f39c..a9c5a7230f89 100644 --- a/drivers/char/stallion.c +++ b/drivers/char/stallion.c | |||
| @@ -504,7 +504,6 @@ static int stl_echmcaintr(stlbrd_t *brdp); | |||
| 504 | static int stl_echpciintr(stlbrd_t *brdp); | 504 | static int stl_echpciintr(stlbrd_t *brdp); |
| 505 | static int stl_echpci64intr(stlbrd_t *brdp); | 505 | static int stl_echpci64intr(stlbrd_t *brdp); |
| 506 | static void stl_offintr(void *private); | 506 | static void stl_offintr(void *private); |
| 507 | static void *stl_memalloc(int len); | ||
| 508 | static stlbrd_t *stl_allocbrd(void); | 507 | static stlbrd_t *stl_allocbrd(void); |
| 509 | static stlport_t *stl_getport(int brdnr, int panelnr, int portnr); | 508 | static stlport_t *stl_getport(int brdnr, int panelnr, int portnr); |
| 510 | 509 | ||
| @@ -940,17 +939,6 @@ static int stl_parsebrd(stlconf_t *confp, char **argp) | |||
| 940 | /*****************************************************************************/ | 939 | /*****************************************************************************/ |
| 941 | 940 | ||
| 942 | /* | 941 | /* |
| 943 | * Local driver kernel memory allocation routine. | ||
| 944 | */ | ||
| 945 | |||
| 946 | static void *stl_memalloc(int len) | ||
| 947 | { | ||
| 948 | return (void *) kmalloc(len, GFP_KERNEL); | ||
| 949 | } | ||
| 950 | |||
| 951 | /*****************************************************************************/ | ||
| 952 | |||
| 953 | /* | ||
| 954 | * Allocate a new board structure. Fill out the basic info in it. | 942 | * Allocate a new board structure. Fill out the basic info in it. |
| 955 | */ | 943 | */ |
| 956 | 944 | ||
| @@ -958,14 +946,13 @@ static stlbrd_t *stl_allocbrd(void) | |||
| 958 | { | 946 | { |
| 959 | stlbrd_t *brdp; | 947 | stlbrd_t *brdp; |
| 960 | 948 | ||
| 961 | brdp = (stlbrd_t *) stl_memalloc(sizeof(stlbrd_t)); | 949 | brdp = kzalloc(sizeof(stlbrd_t), GFP_KERNEL); |
| 962 | if (brdp == (stlbrd_t *) NULL) { | 950 | if (!brdp) { |
| 963 | printk("STALLION: failed to allocate memory (size=%d)\n", | 951 | printk("STALLION: failed to allocate memory (size=%d)\n", |
| 964 | sizeof(stlbrd_t)); | 952 | sizeof(stlbrd_t)); |
| 965 | return (stlbrd_t *) NULL; | 953 | return NULL; |
| 966 | } | 954 | } |
| 967 | 955 | ||
| 968 | memset(brdp, 0, sizeof(stlbrd_t)); | ||
| 969 | brdp->magic = STL_BOARDMAGIC; | 956 | brdp->magic = STL_BOARDMAGIC; |
| 970 | return brdp; | 957 | return brdp; |
| 971 | } | 958 | } |
| @@ -1017,9 +1004,9 @@ static int stl_open(struct tty_struct *tty, struct file *filp) | |||
| 1017 | portp->refcount++; | 1004 | portp->refcount++; |
| 1018 | 1005 | ||
| 1019 | if ((portp->flags & ASYNC_INITIALIZED) == 0) { | 1006 | if ((portp->flags & ASYNC_INITIALIZED) == 0) { |
| 1020 | if (portp->tx.buf == (char *) NULL) { | 1007 | if (!portp->tx.buf) { |
| 1021 | portp->tx.buf = (char *) stl_memalloc(STL_TXBUFSIZE); | 1008 | portp->tx.buf = kmalloc(STL_TXBUFSIZE, GFP_KERNEL); |
| 1022 | if (portp->tx.buf == (char *) NULL) | 1009 | if (!portp->tx.buf) |
| 1023 | return -ENOMEM; | 1010 | return -ENOMEM; |
| 1024 | portp->tx.head = portp->tx.buf; | 1011 | portp->tx.head = portp->tx.buf; |
| 1025 | portp->tx.tail = portp->tx.buf; | 1012 | portp->tx.tail = portp->tx.buf; |
| @@ -2178,13 +2165,12 @@ static int __init stl_initports(stlbrd_t *brdp, stlpanel_t *panelp) | |||
| 2178 | * each ports data structures. | 2165 | * each ports data structures. |
| 2179 | */ | 2166 | */ |
| 2180 | for (i = 0; (i < panelp->nrports); i++) { | 2167 | for (i = 0; (i < panelp->nrports); i++) { |
| 2181 | portp = (stlport_t *) stl_memalloc(sizeof(stlport_t)); | 2168 | portp = kzalloc(sizeof(stlport_t), GFP_KERNEL); |
| 2182 | if (portp == (stlport_t *) NULL) { | 2169 | if (!portp) { |
| 2183 | printk("STALLION: failed to allocate memory " | 2170 | printk("STALLION: failed to allocate memory " |
| 2184 | "(size=%d)\n", sizeof(stlport_t)); | 2171 | "(size=%d)\n", sizeof(stlport_t)); |
| 2185 | break; | 2172 | break; |
| 2186 | } | 2173 | } |
| 2187 | memset(portp, 0, sizeof(stlport_t)); | ||
| 2188 | 2174 | ||
| 2189 | portp->magic = STL_PORTMAGIC; | 2175 | portp->magic = STL_PORTMAGIC; |
| 2190 | portp->portnr = i; | 2176 | portp->portnr = i; |
| @@ -2315,13 +2301,12 @@ static inline int stl_initeio(stlbrd_t *brdp) | |||
| 2315 | * can complete the setup. | 2301 | * can complete the setup. |
| 2316 | */ | 2302 | */ |
| 2317 | 2303 | ||
| 2318 | panelp = (stlpanel_t *) stl_memalloc(sizeof(stlpanel_t)); | 2304 | panelp = kzalloc(sizeof(stlpanel_t), GFP_KERNEL); |
| 2319 | if (panelp == (stlpanel_t *) NULL) { | 2305 | if (!panelp) { |
| 2320 | printk(KERN_WARNING "STALLION: failed to allocate memory " | 2306 | printk(KERN_WARNING "STALLION: failed to allocate memory " |
| 2321 | "(size=%d)\n", sizeof(stlpanel_t)); | 2307 | "(size=%d)\n", sizeof(stlpanel_t)); |
| 2322 | return(-ENOMEM); | 2308 | return -ENOMEM; |
| 2323 | } | 2309 | } |
| 2324 | memset(panelp, 0, sizeof(stlpanel_t)); | ||
| 2325 | 2310 | ||
| 2326 | panelp->magic = STL_PANELMAGIC; | 2311 | panelp->magic = STL_PANELMAGIC; |
| 2327 | panelp->brdnr = brdp->brdnr; | 2312 | panelp->brdnr = brdp->brdnr; |
| @@ -2490,13 +2475,12 @@ static inline int stl_initech(stlbrd_t *brdp) | |||
| 2490 | status = inb(ioaddr + ECH_PNLSTATUS); | 2475 | status = inb(ioaddr + ECH_PNLSTATUS); |
| 2491 | if ((status & ECH_PNLIDMASK) != nxtid) | 2476 | if ((status & ECH_PNLIDMASK) != nxtid) |
| 2492 | break; | 2477 | break; |
| 2493 | panelp = (stlpanel_t *) stl_memalloc(sizeof(stlpanel_t)); | 2478 | panelp = kzalloc(sizeof(stlpanel_t), GFP_KERNEL); |
| 2494 | if (panelp == (stlpanel_t *) NULL) { | 2479 | if (!panelp) { |
| 2495 | printk("STALLION: failed to allocate memory " | 2480 | printk("STALLION: failed to allocate memory " |
| 2496 | "(size=%d)\n", sizeof(stlpanel_t)); | 2481 | "(size=%d)\n", sizeof(stlpanel_t)); |
| 2497 | break; | 2482 | break; |
| 2498 | } | 2483 | } |
| 2499 | memset(panelp, 0, sizeof(stlpanel_t)); | ||
| 2500 | panelp->magic = STL_PANELMAGIC; | 2484 | panelp->magic = STL_PANELMAGIC; |
| 2501 | panelp->brdnr = brdp->brdnr; | 2485 | panelp->brdnr = brdp->brdnr; |
| 2502 | panelp->panelnr = panelnr; | 2486 | panelp->panelnr = panelnr; |
| @@ -3074,8 +3058,8 @@ static int __init stl_init(void) | |||
| 3074 | /* | 3058 | /* |
| 3075 | * Allocate a temporary write buffer. | 3059 | * Allocate a temporary write buffer. |
| 3076 | */ | 3060 | */ |
| 3077 | stl_tmpwritebuf = (char *) stl_memalloc(STL_TXBUFSIZE); | 3061 | stl_tmpwritebuf = kmalloc(STL_TXBUFSIZE, GFP_KERNEL); |
| 3078 | if (stl_tmpwritebuf == (char *) NULL) | 3062 | if (!stl_tmpwritebuf) |
| 3079 | printk("STALLION: failed to allocate memory (size=%d)\n", | 3063 | printk("STALLION: failed to allocate memory (size=%d)\n", |
| 3080 | STL_TXBUFSIZE); | 3064 | STL_TXBUFSIZE); |
| 3081 | 3065 | ||
diff --git a/drivers/char/tty_io.c b/drivers/char/tty_io.c index 0bfd1b63662e..98b126c2ded8 100644 --- a/drivers/char/tty_io.c +++ b/drivers/char/tty_io.c | |||
| @@ -376,7 +376,7 @@ int tty_insert_flip_string(struct tty_struct *tty, const unsigned char *chars, s | |||
| 376 | return copied; | 376 | return copied; |
| 377 | } | 377 | } |
| 378 | 378 | ||
| 379 | EXPORT_SYMBOL_GPL(tty_insert_flip_string); | 379 | EXPORT_SYMBOL(tty_insert_flip_string); |
| 380 | 380 | ||
| 381 | int tty_insert_flip_string_flags(struct tty_struct *tty, const unsigned char *chars, const char *flags, size_t size) | 381 | int tty_insert_flip_string_flags(struct tty_struct *tty, const unsigned char *chars, const char *flags, size_t size) |
| 382 | { | 382 | { |
diff --git a/drivers/char/vt.c b/drivers/char/vt.c index ca4844c527da..acc5d47844eb 100644 --- a/drivers/char/vt.c +++ b/drivers/char/vt.c | |||
| @@ -2328,6 +2328,10 @@ int tioclinux(struct tty_struct *tty, unsigned long arg) | |||
| 2328 | case TIOCL_SETVESABLANK: | 2328 | case TIOCL_SETVESABLANK: |
| 2329 | set_vesa_blanking(p); | 2329 | set_vesa_blanking(p); |
| 2330 | break; | 2330 | break; |
| 2331 | case TIOCL_GETKMSGREDIRECT: | ||
| 2332 | data = kmsg_redirect; | ||
| 2333 | ret = __put_user(data, p); | ||
| 2334 | break; | ||
| 2331 | case TIOCL_SETKMSGREDIRECT: | 2335 | case TIOCL_SETKMSGREDIRECT: |
| 2332 | if (!capable(CAP_SYS_ADMIN)) { | 2336 | if (!capable(CAP_SYS_ADMIN)) { |
| 2333 | ret = -EPERM; | 2337 | ret = -EPERM; |
diff --git a/drivers/edac/Kconfig b/drivers/edac/Kconfig index b582d0cdc24f..4f0898400c6d 100644 --- a/drivers/edac/Kconfig +++ b/drivers/edac/Kconfig | |||
| @@ -71,7 +71,7 @@ config EDAC_E7XXX | |||
| 71 | 71 | ||
| 72 | config EDAC_E752X | 72 | config EDAC_E752X |
| 73 | tristate "Intel e752x (e7520, e7525, e7320)" | 73 | tristate "Intel e752x (e7520, e7525, e7320)" |
| 74 | depends on EDAC_MM_EDAC && PCI && X86 | 74 | depends on EDAC_MM_EDAC && PCI && X86 && HOTPLUG |
| 75 | help | 75 | help |
| 76 | Support for error detection and correction on the Intel | 76 | Support for error detection and correction on the Intel |
| 77 | E7520, E7525, E7320 server chipsets. | 77 | E7520, E7525, E7320 server chipsets. |
diff --git a/drivers/ide/ide-disk.c b/drivers/ide/ide-disk.c index ccf528d733bf..a5017de72da5 100644 --- a/drivers/ide/ide-disk.c +++ b/drivers/ide/ide-disk.c | |||
| @@ -61,6 +61,7 @@ | |||
| 61 | #include <linux/slab.h> | 61 | #include <linux/slab.h> |
| 62 | #include <linux/delay.h> | 62 | #include <linux/delay.h> |
| 63 | #include <linux/mutex.h> | 63 | #include <linux/mutex.h> |
| 64 | #include <linux/leds.h> | ||
| 64 | 65 | ||
| 65 | #define _IDE_DISK | 66 | #define _IDE_DISK |
| 66 | 67 | ||
| @@ -317,6 +318,8 @@ static ide_startstop_t ide_do_rw_disk (ide_drive_t *drive, struct request *rq, s | |||
| 317 | return ide_stopped; | 318 | return ide_stopped; |
| 318 | } | 319 | } |
| 319 | 320 | ||
| 321 | ledtrig_ide_activity(); | ||
| 322 | |||
| 320 | pr_debug("%s: %sing: block=%llu, sectors=%lu, buffer=0x%08lx\n", | 323 | pr_debug("%s: %sing: block=%llu, sectors=%lu, buffer=0x%08lx\n", |
| 321 | drive->name, rq_data_dir(rq) == READ ? "read" : "writ", | 324 | drive->name, rq_data_dir(rq) == READ ? "read" : "writ", |
| 322 | (unsigned long long)block, rq->nr_sectors, | 325 | (unsigned long long)block, rq->nr_sectors, |
diff --git a/drivers/ide/ide-taskfile.c b/drivers/ide/ide-taskfile.c index 0606bd2f6020..9233b8109a0f 100644 --- a/drivers/ide/ide-taskfile.c +++ b/drivers/ide/ide-taskfile.c | |||
| @@ -375,7 +375,13 @@ static void task_end_request(ide_drive_t *drive, struct request *rq, u8 stat) | |||
| 375 | } | 375 | } |
| 376 | } | 376 | } |
| 377 | 377 | ||
| 378 | ide_end_request(drive, 1, rq->hard_nr_sectors); | 378 | if (rq->rq_disk) { |
| 379 | ide_driver_t *drv; | ||
| 380 | |||
| 381 | drv = *(ide_driver_t **)rq->rq_disk->private_data;; | ||
| 382 | drv->end_request(drive, 1, rq->hard_nr_sectors); | ||
| 383 | } else | ||
| 384 | ide_end_request(drive, 1, rq->hard_nr_sectors); | ||
| 379 | } | 385 | } |
| 380 | 386 | ||
| 381 | /* | 387 | /* |
diff --git a/drivers/infiniband/core/mad.c b/drivers/infiniband/core/mad.c index f7854b65fd55..ba54c856b0e5 100644 --- a/drivers/infiniband/core/mad.c +++ b/drivers/infiniband/core/mad.c | |||
| @@ -227,6 +227,14 @@ struct ib_mad_agent *ib_register_mad_agent(struct ib_device *device, | |||
| 227 | if (!is_vendor_oui(mad_reg_req->oui)) | 227 | if (!is_vendor_oui(mad_reg_req->oui)) |
| 228 | goto error1; | 228 | goto error1; |
| 229 | } | 229 | } |
| 230 | /* Make sure class supplied is consistent with RMPP */ | ||
| 231 | if (ib_is_mad_class_rmpp(mad_reg_req->mgmt_class)) { | ||
| 232 | if (!rmpp_version) | ||
| 233 | goto error1; | ||
| 234 | } else { | ||
| 235 | if (rmpp_version) | ||
| 236 | goto error1; | ||
| 237 | } | ||
| 230 | /* Make sure class supplied is consistent with QP type */ | 238 | /* Make sure class supplied is consistent with QP type */ |
| 231 | if (qp_type == IB_QPT_SMI) { | 239 | if (qp_type == IB_QPT_SMI) { |
| 232 | if ((mad_reg_req->mgmt_class != | 240 | if ((mad_reg_req->mgmt_class != |
| @@ -890,6 +898,35 @@ struct ib_mad_send_buf * ib_create_send_mad(struct ib_mad_agent *mad_agent, | |||
| 890 | } | 898 | } |
| 891 | EXPORT_SYMBOL(ib_create_send_mad); | 899 | EXPORT_SYMBOL(ib_create_send_mad); |
| 892 | 900 | ||
| 901 | int ib_get_mad_data_offset(u8 mgmt_class) | ||
| 902 | { | ||
| 903 | if (mgmt_class == IB_MGMT_CLASS_SUBN_ADM) | ||
| 904 | return IB_MGMT_SA_HDR; | ||
| 905 | else if ((mgmt_class == IB_MGMT_CLASS_DEVICE_MGMT) || | ||
| 906 | (mgmt_class == IB_MGMT_CLASS_DEVICE_ADM) || | ||
| 907 | (mgmt_class == IB_MGMT_CLASS_BIS)) | ||
| 908 | return IB_MGMT_DEVICE_HDR; | ||
| 909 | else if ((mgmt_class >= IB_MGMT_CLASS_VENDOR_RANGE2_START) && | ||
| 910 | (mgmt_class <= IB_MGMT_CLASS_VENDOR_RANGE2_END)) | ||
| 911 | return IB_MGMT_VENDOR_HDR; | ||
| 912 | else | ||
| 913 | return IB_MGMT_MAD_HDR; | ||
| 914 | } | ||
| 915 | EXPORT_SYMBOL(ib_get_mad_data_offset); | ||
| 916 | |||
| 917 | int ib_is_mad_class_rmpp(u8 mgmt_class) | ||
| 918 | { | ||
| 919 | if ((mgmt_class == IB_MGMT_CLASS_SUBN_ADM) || | ||
| 920 | (mgmt_class == IB_MGMT_CLASS_DEVICE_MGMT) || | ||
| 921 | (mgmt_class == IB_MGMT_CLASS_DEVICE_ADM) || | ||
| 922 | (mgmt_class == IB_MGMT_CLASS_BIS) || | ||
| 923 | ((mgmt_class >= IB_MGMT_CLASS_VENDOR_RANGE2_START) && | ||
| 924 | (mgmt_class <= IB_MGMT_CLASS_VENDOR_RANGE2_END))) | ||
| 925 | return 1; | ||
| 926 | return 0; | ||
| 927 | } | ||
| 928 | EXPORT_SYMBOL(ib_is_mad_class_rmpp); | ||
| 929 | |||
| 893 | void *ib_get_rmpp_segment(struct ib_mad_send_buf *send_buf, int seg_num) | 930 | void *ib_get_rmpp_segment(struct ib_mad_send_buf *send_buf, int seg_num) |
| 894 | { | 931 | { |
| 895 | struct ib_mad_send_wr_private *mad_send_wr; | 932 | struct ib_mad_send_wr_private *mad_send_wr; |
| @@ -1022,6 +1059,13 @@ int ib_post_send_mad(struct ib_mad_send_buf *send_buf, | |||
| 1022 | goto error; | 1059 | goto error; |
| 1023 | } | 1060 | } |
| 1024 | 1061 | ||
| 1062 | if (!ib_is_mad_class_rmpp(((struct ib_mad_hdr *) send_buf->mad)->mgmt_class)) { | ||
| 1063 | if (mad_agent_priv->agent.rmpp_version) { | ||
| 1064 | ret = -EINVAL; | ||
| 1065 | goto error; | ||
| 1066 | } | ||
| 1067 | } | ||
| 1068 | |||
| 1025 | /* | 1069 | /* |
| 1026 | * Save pointer to next work request to post in case the | 1070 | * Save pointer to next work request to post in case the |
| 1027 | * current one completes, and the user modifies the work | 1071 | * current one completes, and the user modifies the work |
| @@ -1618,14 +1662,59 @@ static int is_data_mad(struct ib_mad_agent_private *mad_agent_priv, | |||
| 1618 | (rmpp_mad->rmpp_hdr.rmpp_type == IB_MGMT_RMPP_TYPE_DATA); | 1662 | (rmpp_mad->rmpp_hdr.rmpp_type == IB_MGMT_RMPP_TYPE_DATA); |
| 1619 | } | 1663 | } |
| 1620 | 1664 | ||
| 1665 | static inline int rcv_has_same_class(struct ib_mad_send_wr_private *wr, | ||
| 1666 | struct ib_mad_recv_wc *rwc) | ||
| 1667 | { | ||
| 1668 | return ((struct ib_mad *)(wr->send_buf.mad))->mad_hdr.mgmt_class == | ||
| 1669 | rwc->recv_buf.mad->mad_hdr.mgmt_class; | ||
| 1670 | } | ||
| 1671 | |||
| 1672 | static inline int rcv_has_same_gid(struct ib_mad_send_wr_private *wr, | ||
| 1673 | struct ib_mad_recv_wc *rwc ) | ||
| 1674 | { | ||
| 1675 | struct ib_ah_attr attr; | ||
| 1676 | u8 send_resp, rcv_resp; | ||
| 1677 | |||
| 1678 | send_resp = ((struct ib_mad *)(wr->send_buf.mad))-> | ||
| 1679 | mad_hdr.method & IB_MGMT_METHOD_RESP; | ||
| 1680 | rcv_resp = rwc->recv_buf.mad->mad_hdr.method & IB_MGMT_METHOD_RESP; | ||
| 1681 | |||
| 1682 | if (!send_resp && rcv_resp) | ||
| 1683 | /* is request/response. GID/LIDs are both local (same). */ | ||
| 1684 | return 1; | ||
| 1685 | |||
| 1686 | if (send_resp == rcv_resp) | ||
| 1687 | /* both requests, or both responses. GIDs different */ | ||
| 1688 | return 0; | ||
| 1689 | |||
| 1690 | if (ib_query_ah(wr->send_buf.ah, &attr)) | ||
| 1691 | /* Assume not equal, to avoid false positives. */ | ||
| 1692 | return 0; | ||
| 1693 | |||
| 1694 | if (!(attr.ah_flags & IB_AH_GRH) && !(rwc->wc->wc_flags & IB_WC_GRH)) | ||
| 1695 | return attr.dlid == rwc->wc->slid; | ||
| 1696 | else if ((attr.ah_flags & IB_AH_GRH) && | ||
| 1697 | (rwc->wc->wc_flags & IB_WC_GRH)) | ||
| 1698 | return memcmp(attr.grh.dgid.raw, | ||
| 1699 | rwc->recv_buf.grh->sgid.raw, 16) == 0; | ||
| 1700 | else | ||
| 1701 | /* one has GID, other does not. Assume different */ | ||
| 1702 | return 0; | ||
| 1703 | } | ||
| 1621 | struct ib_mad_send_wr_private* | 1704 | struct ib_mad_send_wr_private* |
| 1622 | ib_find_send_mad(struct ib_mad_agent_private *mad_agent_priv, __be64 tid) | 1705 | ib_find_send_mad(struct ib_mad_agent_private *mad_agent_priv, |
| 1706 | struct ib_mad_recv_wc *mad_recv_wc) | ||
| 1623 | { | 1707 | { |
| 1624 | struct ib_mad_send_wr_private *mad_send_wr; | 1708 | struct ib_mad_send_wr_private *mad_send_wr; |
| 1709 | struct ib_mad *mad; | ||
| 1710 | |||
| 1711 | mad = (struct ib_mad *)mad_recv_wc->recv_buf.mad; | ||
| 1625 | 1712 | ||
| 1626 | list_for_each_entry(mad_send_wr, &mad_agent_priv->wait_list, | 1713 | list_for_each_entry(mad_send_wr, &mad_agent_priv->wait_list, |
| 1627 | agent_list) { | 1714 | agent_list) { |
| 1628 | if (mad_send_wr->tid == tid) | 1715 | if ((mad_send_wr->tid == mad->mad_hdr.tid) && |
| 1716 | rcv_has_same_class(mad_send_wr, mad_recv_wc) && | ||
| 1717 | rcv_has_same_gid(mad_send_wr, mad_recv_wc)) | ||
| 1629 | return mad_send_wr; | 1718 | return mad_send_wr; |
| 1630 | } | 1719 | } |
| 1631 | 1720 | ||
| @@ -1636,7 +1725,10 @@ ib_find_send_mad(struct ib_mad_agent_private *mad_agent_priv, __be64 tid) | |||
| 1636 | list_for_each_entry(mad_send_wr, &mad_agent_priv->send_list, | 1725 | list_for_each_entry(mad_send_wr, &mad_agent_priv->send_list, |
| 1637 | agent_list) { | 1726 | agent_list) { |
| 1638 | if (is_data_mad(mad_agent_priv, mad_send_wr->send_buf.mad) && | 1727 | if (is_data_mad(mad_agent_priv, mad_send_wr->send_buf.mad) && |
| 1639 | mad_send_wr->tid == tid && mad_send_wr->timeout) { | 1728 | mad_send_wr->tid == mad->mad_hdr.tid && |
| 1729 | mad_send_wr->timeout && | ||
| 1730 | rcv_has_same_class(mad_send_wr, mad_recv_wc) && | ||
| 1731 | rcv_has_same_gid(mad_send_wr, mad_recv_wc)) { | ||
| 1640 | /* Verify request has not been canceled */ | 1732 | /* Verify request has not been canceled */ |
| 1641 | return (mad_send_wr->status == IB_WC_SUCCESS) ? | 1733 | return (mad_send_wr->status == IB_WC_SUCCESS) ? |
| 1642 | mad_send_wr : NULL; | 1734 | mad_send_wr : NULL; |
| @@ -1661,7 +1753,6 @@ static void ib_mad_complete_recv(struct ib_mad_agent_private *mad_agent_priv, | |||
| 1661 | struct ib_mad_send_wr_private *mad_send_wr; | 1753 | struct ib_mad_send_wr_private *mad_send_wr; |
| 1662 | struct ib_mad_send_wc mad_send_wc; | 1754 | struct ib_mad_send_wc mad_send_wc; |
| 1663 | unsigned long flags; | 1755 | unsigned long flags; |
| 1664 | __be64 tid; | ||
| 1665 | 1756 | ||
| 1666 | INIT_LIST_HEAD(&mad_recv_wc->rmpp_list); | 1757 | INIT_LIST_HEAD(&mad_recv_wc->rmpp_list); |
| 1667 | list_add(&mad_recv_wc->recv_buf.list, &mad_recv_wc->rmpp_list); | 1758 | list_add(&mad_recv_wc->recv_buf.list, &mad_recv_wc->rmpp_list); |
| @@ -1677,9 +1768,8 @@ static void ib_mad_complete_recv(struct ib_mad_agent_private *mad_agent_priv, | |||
| 1677 | 1768 | ||
| 1678 | /* Complete corresponding request */ | 1769 | /* Complete corresponding request */ |
| 1679 | if (response_mad(mad_recv_wc->recv_buf.mad)) { | 1770 | if (response_mad(mad_recv_wc->recv_buf.mad)) { |
| 1680 | tid = mad_recv_wc->recv_buf.mad->mad_hdr.tid; | ||
| 1681 | spin_lock_irqsave(&mad_agent_priv->lock, flags); | 1771 | spin_lock_irqsave(&mad_agent_priv->lock, flags); |
| 1682 | mad_send_wr = ib_find_send_mad(mad_agent_priv, tid); | 1772 | mad_send_wr = ib_find_send_mad(mad_agent_priv, mad_recv_wc); |
| 1683 | if (!mad_send_wr) { | 1773 | if (!mad_send_wr) { |
| 1684 | spin_unlock_irqrestore(&mad_agent_priv->lock, flags); | 1774 | spin_unlock_irqrestore(&mad_agent_priv->lock, flags); |
| 1685 | ib_free_recv_mad(mad_recv_wc); | 1775 | ib_free_recv_mad(mad_recv_wc); |
| @@ -2408,11 +2498,11 @@ static int ib_mad_post_receive_mads(struct ib_mad_qp_info *qp_info, | |||
| 2408 | } | 2498 | } |
| 2409 | } | 2499 | } |
| 2410 | sg_list.addr = dma_map_single(qp_info->port_priv-> | 2500 | sg_list.addr = dma_map_single(qp_info->port_priv-> |
| 2411 | device->dma_device, | 2501 | device->dma_device, |
| 2412 | &mad_priv->grh, | 2502 | &mad_priv->grh, |
| 2413 | sizeof *mad_priv - | 2503 | sizeof *mad_priv - |
| 2414 | sizeof mad_priv->header, | 2504 | sizeof mad_priv->header, |
| 2415 | DMA_FROM_DEVICE); | 2505 | DMA_FROM_DEVICE); |
| 2416 | pci_unmap_addr_set(&mad_priv->header, mapping, sg_list.addr); | 2506 | pci_unmap_addr_set(&mad_priv->header, mapping, sg_list.addr); |
| 2417 | recv_wr.wr_id = (unsigned long)&mad_priv->header.mad_list; | 2507 | recv_wr.wr_id = (unsigned long)&mad_priv->header.mad_list; |
| 2418 | mad_priv->header.mad_list.mad_queue = recv_queue; | 2508 | mad_priv->header.mad_list.mad_queue = recv_queue; |
diff --git a/drivers/infiniband/core/mad_priv.h b/drivers/infiniband/core/mad_priv.h index a7125d4b5ccf..6c9c133d71ef 100644 --- a/drivers/infiniband/core/mad_priv.h +++ b/drivers/infiniband/core/mad_priv.h | |||
| @@ -216,7 +216,8 @@ extern kmem_cache_t *ib_mad_cache; | |||
| 216 | int ib_send_mad(struct ib_mad_send_wr_private *mad_send_wr); | 216 | int ib_send_mad(struct ib_mad_send_wr_private *mad_send_wr); |
| 217 | 217 | ||
| 218 | struct ib_mad_send_wr_private * | 218 | struct ib_mad_send_wr_private * |
| 219 | ib_find_send_mad(struct ib_mad_agent_private *mad_agent_priv, __be64 tid); | 219 | ib_find_send_mad(struct ib_mad_agent_private *mad_agent_priv, |
| 220 | struct ib_mad_recv_wc *mad_recv_wc); | ||
| 220 | 221 | ||
| 221 | void ib_mad_complete_send_wr(struct ib_mad_send_wr_private *mad_send_wr, | 222 | void ib_mad_complete_send_wr(struct ib_mad_send_wr_private *mad_send_wr, |
| 222 | struct ib_mad_send_wc *mad_send_wc); | 223 | struct ib_mad_send_wc *mad_send_wc); |
diff --git a/drivers/infiniband/core/mad_rmpp.c b/drivers/infiniband/core/mad_rmpp.c index bacfdd5bddad..dfd4e588ce03 100644 --- a/drivers/infiniband/core/mad_rmpp.c +++ b/drivers/infiniband/core/mad_rmpp.c | |||
| @@ -1,6 +1,6 @@ | |||
| 1 | /* | 1 | /* |
| 2 | * Copyright (c) 2005 Intel Inc. All rights reserved. | 2 | * Copyright (c) 2005 Intel Inc. All rights reserved. |
| 3 | * Copyright (c) 2005 Voltaire, Inc. All rights reserved. | 3 | * Copyright (c) 2005-2006 Voltaire, Inc. All rights reserved. |
| 4 | * | 4 | * |
| 5 | * This software is available to you under a choice of one of two | 5 | * This software is available to you under a choice of one of two |
| 6 | * licenses. You may choose to be licensed under the terms of the GNU | 6 | * licenses. You may choose to be licensed under the terms of the GNU |
| @@ -100,17 +100,6 @@ void ib_cancel_rmpp_recvs(struct ib_mad_agent_private *agent) | |||
| 100 | } | 100 | } |
| 101 | } | 101 | } |
| 102 | 102 | ||
| 103 | static int data_offset(u8 mgmt_class) | ||
| 104 | { | ||
| 105 | if (mgmt_class == IB_MGMT_CLASS_SUBN_ADM) | ||
| 106 | return IB_MGMT_SA_HDR; | ||
| 107 | else if ((mgmt_class >= IB_MGMT_CLASS_VENDOR_RANGE2_START) && | ||
| 108 | (mgmt_class <= IB_MGMT_CLASS_VENDOR_RANGE2_END)) | ||
| 109 | return IB_MGMT_VENDOR_HDR; | ||
| 110 | else | ||
| 111 | return IB_MGMT_RMPP_HDR; | ||
| 112 | } | ||
| 113 | |||
| 114 | static void format_ack(struct ib_mad_send_buf *msg, | 103 | static void format_ack(struct ib_mad_send_buf *msg, |
| 115 | struct ib_rmpp_mad *data, | 104 | struct ib_rmpp_mad *data, |
| 116 | struct mad_rmpp_recv *rmpp_recv) | 105 | struct mad_rmpp_recv *rmpp_recv) |
| @@ -137,7 +126,7 @@ static void ack_recv(struct mad_rmpp_recv *rmpp_recv, | |||
| 137 | struct ib_mad_send_buf *msg; | 126 | struct ib_mad_send_buf *msg; |
| 138 | int ret, hdr_len; | 127 | int ret, hdr_len; |
| 139 | 128 | ||
| 140 | hdr_len = data_offset(recv_wc->recv_buf.mad->mad_hdr.mgmt_class); | 129 | hdr_len = ib_get_mad_data_offset(recv_wc->recv_buf.mad->mad_hdr.mgmt_class); |
| 141 | msg = ib_create_send_mad(&rmpp_recv->agent->agent, recv_wc->wc->src_qp, | 130 | msg = ib_create_send_mad(&rmpp_recv->agent->agent, recv_wc->wc->src_qp, |
| 142 | recv_wc->wc->pkey_index, 1, hdr_len, | 131 | recv_wc->wc->pkey_index, 1, hdr_len, |
| 143 | 0, GFP_KERNEL); | 132 | 0, GFP_KERNEL); |
| @@ -163,7 +152,7 @@ static struct ib_mad_send_buf *alloc_response_msg(struct ib_mad_agent *agent, | |||
| 163 | if (IS_ERR(ah)) | 152 | if (IS_ERR(ah)) |
| 164 | return (void *) ah; | 153 | return (void *) ah; |
| 165 | 154 | ||
| 166 | hdr_len = data_offset(recv_wc->recv_buf.mad->mad_hdr.mgmt_class); | 155 | hdr_len = ib_get_mad_data_offset(recv_wc->recv_buf.mad->mad_hdr.mgmt_class); |
| 167 | msg = ib_create_send_mad(agent, recv_wc->wc->src_qp, | 156 | msg = ib_create_send_mad(agent, recv_wc->wc->src_qp, |
| 168 | recv_wc->wc->pkey_index, 1, | 157 | recv_wc->wc->pkey_index, 1, |
| 169 | hdr_len, 0, GFP_KERNEL); | 158 | hdr_len, 0, GFP_KERNEL); |
| @@ -408,7 +397,7 @@ static inline int get_mad_len(struct mad_rmpp_recv *rmpp_recv) | |||
| 408 | 397 | ||
| 409 | rmpp_mad = (struct ib_rmpp_mad *)rmpp_recv->cur_seg_buf->mad; | 398 | rmpp_mad = (struct ib_rmpp_mad *)rmpp_recv->cur_seg_buf->mad; |
| 410 | 399 | ||
| 411 | hdr_size = data_offset(rmpp_mad->mad_hdr.mgmt_class); | 400 | hdr_size = ib_get_mad_data_offset(rmpp_mad->mad_hdr.mgmt_class); |
| 412 | data_size = sizeof(struct ib_rmpp_mad) - hdr_size; | 401 | data_size = sizeof(struct ib_rmpp_mad) - hdr_size; |
| 413 | pad = IB_MGMT_RMPP_DATA - be32_to_cpu(rmpp_mad->rmpp_hdr.paylen_newwin); | 402 | pad = IB_MGMT_RMPP_DATA - be32_to_cpu(rmpp_mad->rmpp_hdr.paylen_newwin); |
| 414 | if (pad > IB_MGMT_RMPP_DATA || pad < 0) | 403 | if (pad > IB_MGMT_RMPP_DATA || pad < 0) |
| @@ -562,15 +551,15 @@ static int send_next_seg(struct ib_mad_send_wr_private *mad_send_wr) | |||
| 562 | return ib_send_mad(mad_send_wr); | 551 | return ib_send_mad(mad_send_wr); |
| 563 | } | 552 | } |
| 564 | 553 | ||
| 565 | static void abort_send(struct ib_mad_agent_private *agent, __be64 tid, | 554 | static void abort_send(struct ib_mad_agent_private *agent, |
| 566 | u8 rmpp_status) | 555 | struct ib_mad_recv_wc *mad_recv_wc, u8 rmpp_status) |
| 567 | { | 556 | { |
| 568 | struct ib_mad_send_wr_private *mad_send_wr; | 557 | struct ib_mad_send_wr_private *mad_send_wr; |
| 569 | struct ib_mad_send_wc wc; | 558 | struct ib_mad_send_wc wc; |
| 570 | unsigned long flags; | 559 | unsigned long flags; |
| 571 | 560 | ||
| 572 | spin_lock_irqsave(&agent->lock, flags); | 561 | spin_lock_irqsave(&agent->lock, flags); |
| 573 | mad_send_wr = ib_find_send_mad(agent, tid); | 562 | mad_send_wr = ib_find_send_mad(agent, mad_recv_wc); |
| 574 | if (!mad_send_wr) | 563 | if (!mad_send_wr) |
| 575 | goto out; /* Unmatched send */ | 564 | goto out; /* Unmatched send */ |
| 576 | 565 | ||
| @@ -612,8 +601,7 @@ static void process_rmpp_ack(struct ib_mad_agent_private *agent, | |||
| 612 | 601 | ||
| 613 | rmpp_mad = (struct ib_rmpp_mad *)mad_recv_wc->recv_buf.mad; | 602 | rmpp_mad = (struct ib_rmpp_mad *)mad_recv_wc->recv_buf.mad; |
| 614 | if (rmpp_mad->rmpp_hdr.rmpp_status) { | 603 | if (rmpp_mad->rmpp_hdr.rmpp_status) { |
| 615 | abort_send(agent, rmpp_mad->mad_hdr.tid, | 604 | abort_send(agent, mad_recv_wc, IB_MGMT_RMPP_STATUS_BAD_STATUS); |
| 616 | IB_MGMT_RMPP_STATUS_BAD_STATUS); | ||
| 617 | nack_recv(agent, mad_recv_wc, IB_MGMT_RMPP_STATUS_BAD_STATUS); | 605 | nack_recv(agent, mad_recv_wc, IB_MGMT_RMPP_STATUS_BAD_STATUS); |
| 618 | return; | 606 | return; |
| 619 | } | 607 | } |
| @@ -621,14 +609,13 @@ static void process_rmpp_ack(struct ib_mad_agent_private *agent, | |||
| 621 | seg_num = be32_to_cpu(rmpp_mad->rmpp_hdr.seg_num); | 609 | seg_num = be32_to_cpu(rmpp_mad->rmpp_hdr.seg_num); |
| 622 | newwin = be32_to_cpu(rmpp_mad->rmpp_hdr.paylen_newwin); | 610 | newwin = be32_to_cpu(rmpp_mad->rmpp_hdr.paylen_newwin); |
| 623 | if (newwin < seg_num) { | 611 | if (newwin < seg_num) { |
| 624 | abort_send(agent, rmpp_mad->mad_hdr.tid, | 612 | abort_send(agent, mad_recv_wc, IB_MGMT_RMPP_STATUS_W2S); |
| 625 | IB_MGMT_RMPP_STATUS_W2S); | ||
| 626 | nack_recv(agent, mad_recv_wc, IB_MGMT_RMPP_STATUS_W2S); | 613 | nack_recv(agent, mad_recv_wc, IB_MGMT_RMPP_STATUS_W2S); |
| 627 | return; | 614 | return; |
| 628 | } | 615 | } |
| 629 | 616 | ||
| 630 | spin_lock_irqsave(&agent->lock, flags); | 617 | spin_lock_irqsave(&agent->lock, flags); |
| 631 | mad_send_wr = ib_find_send_mad(agent, rmpp_mad->mad_hdr.tid); | 618 | mad_send_wr = ib_find_send_mad(agent, mad_recv_wc); |
| 632 | if (!mad_send_wr) | 619 | if (!mad_send_wr) |
| 633 | goto out; /* Unmatched ACK */ | 620 | goto out; /* Unmatched ACK */ |
| 634 | 621 | ||
| @@ -639,8 +626,7 @@ static void process_rmpp_ack(struct ib_mad_agent_private *agent, | |||
| 639 | if (seg_num > mad_send_wr->send_buf.seg_count || | 626 | if (seg_num > mad_send_wr->send_buf.seg_count || |
| 640 | seg_num > mad_send_wr->newwin) { | 627 | seg_num > mad_send_wr->newwin) { |
| 641 | spin_unlock_irqrestore(&agent->lock, flags); | 628 | spin_unlock_irqrestore(&agent->lock, flags); |
| 642 | abort_send(agent, rmpp_mad->mad_hdr.tid, | 629 | abort_send(agent, mad_recv_wc, IB_MGMT_RMPP_STATUS_S2B); |
| 643 | IB_MGMT_RMPP_STATUS_S2B); | ||
| 644 | nack_recv(agent, mad_recv_wc, IB_MGMT_RMPP_STATUS_S2B); | 630 | nack_recv(agent, mad_recv_wc, IB_MGMT_RMPP_STATUS_S2B); |
| 645 | return; | 631 | return; |
| 646 | } | 632 | } |
| @@ -728,12 +714,10 @@ static void process_rmpp_stop(struct ib_mad_agent_private *agent, | |||
| 728 | rmpp_mad = (struct ib_rmpp_mad *)mad_recv_wc->recv_buf.mad; | 714 | rmpp_mad = (struct ib_rmpp_mad *)mad_recv_wc->recv_buf.mad; |
| 729 | 715 | ||
| 730 | if (rmpp_mad->rmpp_hdr.rmpp_status != IB_MGMT_RMPP_STATUS_RESX) { | 716 | if (rmpp_mad->rmpp_hdr.rmpp_status != IB_MGMT_RMPP_STATUS_RESX) { |
| 731 | abort_send(agent, rmpp_mad->mad_hdr.tid, | 717 | abort_send(agent, mad_recv_wc, IB_MGMT_RMPP_STATUS_BAD_STATUS); |
| 732 | IB_MGMT_RMPP_STATUS_BAD_STATUS); | ||
| 733 | nack_recv(agent, mad_recv_wc, IB_MGMT_RMPP_STATUS_BAD_STATUS); | 718 | nack_recv(agent, mad_recv_wc, IB_MGMT_RMPP_STATUS_BAD_STATUS); |
| 734 | } else | 719 | } else |
| 735 | abort_send(agent, rmpp_mad->mad_hdr.tid, | 720 | abort_send(agent, mad_recv_wc, rmpp_mad->rmpp_hdr.rmpp_status); |
| 736 | rmpp_mad->rmpp_hdr.rmpp_status); | ||
| 737 | } | 721 | } |
| 738 | 722 | ||
| 739 | static void process_rmpp_abort(struct ib_mad_agent_private *agent, | 723 | static void process_rmpp_abort(struct ib_mad_agent_private *agent, |
| @@ -745,12 +729,10 @@ static void process_rmpp_abort(struct ib_mad_agent_private *agent, | |||
| 745 | 729 | ||
| 746 | if (rmpp_mad->rmpp_hdr.rmpp_status < IB_MGMT_RMPP_STATUS_ABORT_MIN || | 730 | if (rmpp_mad->rmpp_hdr.rmpp_status < IB_MGMT_RMPP_STATUS_ABORT_MIN || |
| 747 | rmpp_mad->rmpp_hdr.rmpp_status > IB_MGMT_RMPP_STATUS_ABORT_MAX) { | 731 | rmpp_mad->rmpp_hdr.rmpp_status > IB_MGMT_RMPP_STATUS_ABORT_MAX) { |
| 748 | abort_send(agent, rmpp_mad->mad_hdr.tid, | 732 | abort_send(agent, mad_recv_wc, IB_MGMT_RMPP_STATUS_BAD_STATUS); |
| 749 | IB_MGMT_RMPP_STATUS_BAD_STATUS); | ||
| 750 | nack_recv(agent, mad_recv_wc, IB_MGMT_RMPP_STATUS_BAD_STATUS); | 733 | nack_recv(agent, mad_recv_wc, IB_MGMT_RMPP_STATUS_BAD_STATUS); |
| 751 | } else | 734 | } else |
| 752 | abort_send(agent, rmpp_mad->mad_hdr.tid, | 735 | abort_send(agent, mad_recv_wc, rmpp_mad->rmpp_hdr.rmpp_status); |
| 753 | rmpp_mad->rmpp_hdr.rmpp_status); | ||
| 754 | } | 736 | } |
| 755 | 737 | ||
| 756 | struct ib_mad_recv_wc * | 738 | struct ib_mad_recv_wc * |
| @@ -764,8 +746,7 @@ ib_process_rmpp_recv_wc(struct ib_mad_agent_private *agent, | |||
| 764 | return mad_recv_wc; | 746 | return mad_recv_wc; |
| 765 | 747 | ||
| 766 | if (rmpp_mad->rmpp_hdr.rmpp_version != IB_MGMT_RMPP_VERSION) { | 748 | if (rmpp_mad->rmpp_hdr.rmpp_version != IB_MGMT_RMPP_VERSION) { |
| 767 | abort_send(agent, rmpp_mad->mad_hdr.tid, | 749 | abort_send(agent, mad_recv_wc, IB_MGMT_RMPP_STATUS_UNV); |
| 768 | IB_MGMT_RMPP_STATUS_UNV); | ||
| 769 | nack_recv(agent, mad_recv_wc, IB_MGMT_RMPP_STATUS_UNV); | 750 | nack_recv(agent, mad_recv_wc, IB_MGMT_RMPP_STATUS_UNV); |
| 770 | goto out; | 751 | goto out; |
| 771 | } | 752 | } |
| @@ -783,8 +764,7 @@ ib_process_rmpp_recv_wc(struct ib_mad_agent_private *agent, | |||
| 783 | process_rmpp_abort(agent, mad_recv_wc); | 764 | process_rmpp_abort(agent, mad_recv_wc); |
| 784 | break; | 765 | break; |
| 785 | default: | 766 | default: |
| 786 | abort_send(agent, rmpp_mad->mad_hdr.tid, | 767 | abort_send(agent, mad_recv_wc, IB_MGMT_RMPP_STATUS_BADT); |
| 787 | IB_MGMT_RMPP_STATUS_BADT); | ||
| 788 | nack_recv(agent, mad_recv_wc, IB_MGMT_RMPP_STATUS_BADT); | 768 | nack_recv(agent, mad_recv_wc, IB_MGMT_RMPP_STATUS_BADT); |
| 789 | break; | 769 | break; |
| 790 | } | 770 | } |
diff --git a/drivers/infiniband/core/user_mad.c b/drivers/infiniband/core/user_mad.c index fb6cd42601f9..afe70a549c2f 100644 --- a/drivers/infiniband/core/user_mad.c +++ b/drivers/infiniband/core/user_mad.c | |||
| @@ -177,17 +177,6 @@ static int queue_packet(struct ib_umad_file *file, | |||
| 177 | return ret; | 177 | return ret; |
| 178 | } | 178 | } |
| 179 | 179 | ||
| 180 | static int data_offset(u8 mgmt_class) | ||
| 181 | { | ||
| 182 | if (mgmt_class == IB_MGMT_CLASS_SUBN_ADM) | ||
| 183 | return IB_MGMT_SA_HDR; | ||
| 184 | else if ((mgmt_class >= IB_MGMT_CLASS_VENDOR_RANGE2_START) && | ||
| 185 | (mgmt_class <= IB_MGMT_CLASS_VENDOR_RANGE2_END)) | ||
| 186 | return IB_MGMT_VENDOR_HDR; | ||
| 187 | else | ||
| 188 | return IB_MGMT_RMPP_HDR; | ||
| 189 | } | ||
| 190 | |||
| 191 | static void send_handler(struct ib_mad_agent *agent, | 180 | static void send_handler(struct ib_mad_agent *agent, |
| 192 | struct ib_mad_send_wc *send_wc) | 181 | struct ib_mad_send_wc *send_wc) |
| 193 | { | 182 | { |
| @@ -283,7 +272,7 @@ static ssize_t copy_recv_mad(char __user *buf, struct ib_umad_packet *packet, | |||
| 283 | */ | 272 | */ |
| 284 | return -ENOSPC; | 273 | return -ENOSPC; |
| 285 | } | 274 | } |
| 286 | offset = data_offset(recv_buf->mad->mad_hdr.mgmt_class); | 275 | offset = ib_get_mad_data_offset(recv_buf->mad->mad_hdr.mgmt_class); |
| 287 | max_seg_payload = sizeof (struct ib_mad) - offset; | 276 | max_seg_payload = sizeof (struct ib_mad) - offset; |
| 288 | 277 | ||
| 289 | for (left = packet->length - seg_payload, buf += seg_payload; | 278 | for (left = packet->length - seg_payload, buf += seg_payload; |
| @@ -441,21 +430,14 @@ static ssize_t ib_umad_write(struct file *filp, const char __user *buf, | |||
| 441 | } | 430 | } |
| 442 | 431 | ||
| 443 | rmpp_mad = (struct ib_rmpp_mad *) packet->mad.data; | 432 | rmpp_mad = (struct ib_rmpp_mad *) packet->mad.data; |
| 444 | if (rmpp_mad->mad_hdr.mgmt_class == IB_MGMT_CLASS_SUBN_ADM) { | 433 | hdr_len = ib_get_mad_data_offset(rmpp_mad->mad_hdr.mgmt_class); |
| 445 | hdr_len = IB_MGMT_SA_HDR; | 434 | if (!ib_is_mad_class_rmpp(rmpp_mad->mad_hdr.mgmt_class)) { |
| 446 | copy_offset = IB_MGMT_RMPP_HDR; | 435 | copy_offset = IB_MGMT_MAD_HDR; |
| 447 | rmpp_active = ib_get_rmpp_flags(&rmpp_mad->rmpp_hdr) & | 436 | rmpp_active = 0; |
| 448 | IB_MGMT_RMPP_FLAG_ACTIVE; | 437 | } else { |
| 449 | } else if (rmpp_mad->mad_hdr.mgmt_class >= IB_MGMT_CLASS_VENDOR_RANGE2_START && | ||
| 450 | rmpp_mad->mad_hdr.mgmt_class <= IB_MGMT_CLASS_VENDOR_RANGE2_END) { | ||
| 451 | hdr_len = IB_MGMT_VENDOR_HDR; | ||
| 452 | copy_offset = IB_MGMT_RMPP_HDR; | 438 | copy_offset = IB_MGMT_RMPP_HDR; |
| 453 | rmpp_active = ib_get_rmpp_flags(&rmpp_mad->rmpp_hdr) & | 439 | rmpp_active = ib_get_rmpp_flags(&rmpp_mad->rmpp_hdr) & |
| 454 | IB_MGMT_RMPP_FLAG_ACTIVE; | 440 | IB_MGMT_RMPP_FLAG_ACTIVE; |
| 455 | } else { | ||
| 456 | hdr_len = IB_MGMT_MAD_HDR; | ||
| 457 | copy_offset = IB_MGMT_MAD_HDR; | ||
| 458 | rmpp_active = 0; | ||
| 459 | } | 441 | } |
| 460 | 442 | ||
| 461 | data_len = count - sizeof (struct ib_user_mad) - hdr_len; | 443 | data_len = count - sizeof (struct ib_user_mad) - hdr_len; |
diff --git a/drivers/infiniband/hw/mthca/mthca_av.c b/drivers/infiniband/hw/mthca/mthca_av.c index f023d3936518..bc5bdcbe51b5 100644 --- a/drivers/infiniband/hw/mthca/mthca_av.c +++ b/drivers/infiniband/hw/mthca/mthca_av.c | |||
| @@ -265,7 +265,7 @@ int __devinit mthca_init_av_table(struct mthca_dev *dev) | |||
| 265 | return -ENOMEM; | 265 | return -ENOMEM; |
| 266 | } | 266 | } |
| 267 | 267 | ||
| 268 | void __devexit mthca_cleanup_av_table(struct mthca_dev *dev) | 268 | void mthca_cleanup_av_table(struct mthca_dev *dev) |
| 269 | { | 269 | { |
| 270 | if (mthca_is_memfree(dev)) | 270 | if (mthca_is_memfree(dev)) |
| 271 | return; | 271 | return; |
diff --git a/drivers/infiniband/hw/mthca/mthca_cq.c b/drivers/infiniband/hw/mthca/mthca_cq.c index 76aabc5bf371..312cf90731ea 100644 --- a/drivers/infiniband/hw/mthca/mthca_cq.c +++ b/drivers/infiniband/hw/mthca/mthca_cq.c | |||
| @@ -973,7 +973,7 @@ int __devinit mthca_init_cq_table(struct mthca_dev *dev) | |||
| 973 | return err; | 973 | return err; |
| 974 | } | 974 | } |
| 975 | 975 | ||
| 976 | void __devexit mthca_cleanup_cq_table(struct mthca_dev *dev) | 976 | void mthca_cleanup_cq_table(struct mthca_dev *dev) |
| 977 | { | 977 | { |
| 978 | mthca_array_cleanup(&dev->cq_table.cq, dev->limits.num_cqs); | 978 | mthca_array_cleanup(&dev->cq_table.cq, dev->limits.num_cqs); |
| 979 | mthca_alloc_cleanup(&dev->cq_table.alloc); | 979 | mthca_alloc_cleanup(&dev->cq_table.alloc); |
diff --git a/drivers/infiniband/hw/mthca/mthca_eq.c b/drivers/infiniband/hw/mthca/mthca_eq.c index cbdc348fb689..99f109c3815d 100644 --- a/drivers/infiniband/hw/mthca/mthca_eq.c +++ b/drivers/infiniband/hw/mthca/mthca_eq.c | |||
| @@ -765,7 +765,7 @@ static int __devinit mthca_map_eq_regs(struct mthca_dev *dev) | |||
| 765 | 765 | ||
| 766 | } | 766 | } |
| 767 | 767 | ||
| 768 | static void __devexit mthca_unmap_eq_regs(struct mthca_dev *dev) | 768 | static void mthca_unmap_eq_regs(struct mthca_dev *dev) |
| 769 | { | 769 | { |
| 770 | if (mthca_is_memfree(dev)) { | 770 | if (mthca_is_memfree(dev)) { |
| 771 | mthca_unmap_reg(dev, (pci_resource_len(dev->pdev, 0) - 1) & | 771 | mthca_unmap_reg(dev, (pci_resource_len(dev->pdev, 0) - 1) & |
| @@ -821,7 +821,7 @@ int __devinit mthca_map_eq_icm(struct mthca_dev *dev, u64 icm_virt) | |||
| 821 | return ret; | 821 | return ret; |
| 822 | } | 822 | } |
| 823 | 823 | ||
| 824 | void __devexit mthca_unmap_eq_icm(struct mthca_dev *dev) | 824 | void mthca_unmap_eq_icm(struct mthca_dev *dev) |
| 825 | { | 825 | { |
| 826 | u8 status; | 826 | u8 status; |
| 827 | 827 | ||
| @@ -954,7 +954,7 @@ err_out_free: | |||
| 954 | return err; | 954 | return err; |
| 955 | } | 955 | } |
| 956 | 956 | ||
| 957 | void __devexit mthca_cleanup_eq_table(struct mthca_dev *dev) | 957 | void mthca_cleanup_eq_table(struct mthca_dev *dev) |
| 958 | { | 958 | { |
| 959 | u8 status; | 959 | u8 status; |
| 960 | int i; | 960 | int i; |
diff --git a/drivers/infiniband/hw/mthca/mthca_mad.c b/drivers/infiniband/hw/mthca/mthca_mad.c index 4ace6a392f41..dfb482eac9a2 100644 --- a/drivers/infiniband/hw/mthca/mthca_mad.c +++ b/drivers/infiniband/hw/mthca/mthca_mad.c | |||
| @@ -271,7 +271,7 @@ err: | |||
| 271 | return PTR_ERR(agent); | 271 | return PTR_ERR(agent); |
| 272 | } | 272 | } |
| 273 | 273 | ||
| 274 | void mthca_free_agents(struct mthca_dev *dev) | 274 | void __devexit mthca_free_agents(struct mthca_dev *dev) |
| 275 | { | 275 | { |
| 276 | struct ib_mad_agent *agent; | 276 | struct ib_mad_agent *agent; |
| 277 | int p, q; | 277 | int p, q; |
diff --git a/drivers/infiniband/hw/mthca/mthca_mcg.c b/drivers/infiniband/hw/mthca/mthca_mcg.c index 9965bda9afed..47ca8a9b7247 100644 --- a/drivers/infiniband/hw/mthca/mthca_mcg.c +++ b/drivers/infiniband/hw/mthca/mthca_mcg.c | |||
| @@ -388,7 +388,7 @@ int __devinit mthca_init_mcg_table(struct mthca_dev *dev) | |||
| 388 | return 0; | 388 | return 0; |
| 389 | } | 389 | } |
| 390 | 390 | ||
| 391 | void __devexit mthca_cleanup_mcg_table(struct mthca_dev *dev) | 391 | void mthca_cleanup_mcg_table(struct mthca_dev *dev) |
| 392 | { | 392 | { |
| 393 | mthca_alloc_cleanup(&dev->mcg_table.alloc); | 393 | mthca_alloc_cleanup(&dev->mcg_table.alloc); |
| 394 | } | 394 | } |
diff --git a/drivers/infiniband/hw/mthca/mthca_mr.c b/drivers/infiniband/hw/mthca/mthca_mr.c index 698b62125765..25e1c1db9a40 100644 --- a/drivers/infiniband/hw/mthca/mthca_mr.c +++ b/drivers/infiniband/hw/mthca/mthca_mr.c | |||
| @@ -170,7 +170,7 @@ err_out: | |||
| 170 | return -ENOMEM; | 170 | return -ENOMEM; |
| 171 | } | 171 | } |
| 172 | 172 | ||
| 173 | static void __devexit mthca_buddy_cleanup(struct mthca_buddy *buddy) | 173 | static void mthca_buddy_cleanup(struct mthca_buddy *buddy) |
| 174 | { | 174 | { |
| 175 | int i; | 175 | int i; |
| 176 | 176 | ||
| @@ -866,7 +866,7 @@ err_mtt_buddy: | |||
| 866 | return err; | 866 | return err; |
| 867 | } | 867 | } |
| 868 | 868 | ||
| 869 | void __devexit mthca_cleanup_mr_table(struct mthca_dev *dev) | 869 | void mthca_cleanup_mr_table(struct mthca_dev *dev) |
| 870 | { | 870 | { |
| 871 | /* XXX check if any MRs are still allocated? */ | 871 | /* XXX check if any MRs are still allocated? */ |
| 872 | if (dev->limits.fmr_reserved_mtts) | 872 | if (dev->limits.fmr_reserved_mtts) |
diff --git a/drivers/infiniband/hw/mthca/mthca_pd.c b/drivers/infiniband/hw/mthca/mthca_pd.c index 105fc5faaddf..59df51614c85 100644 --- a/drivers/infiniband/hw/mthca/mthca_pd.c +++ b/drivers/infiniband/hw/mthca/mthca_pd.c | |||
| @@ -77,7 +77,7 @@ int __devinit mthca_init_pd_table(struct mthca_dev *dev) | |||
| 77 | dev->limits.reserved_pds); | 77 | dev->limits.reserved_pds); |
| 78 | } | 78 | } |
| 79 | 79 | ||
| 80 | void __devexit mthca_cleanup_pd_table(struct mthca_dev *dev) | 80 | void mthca_cleanup_pd_table(struct mthca_dev *dev) |
| 81 | { | 81 | { |
| 82 | /* XXX check if any PDs are still allocated? */ | 82 | /* XXX check if any PDs are still allocated? */ |
| 83 | mthca_alloc_cleanup(&dev->pd_table.alloc); | 83 | mthca_alloc_cleanup(&dev->pd_table.alloc); |
diff --git a/drivers/infiniband/hw/mthca/mthca_qp.c b/drivers/infiniband/hw/mthca/mthca_qp.c index 1bc2678c2fae..057c8e6af87b 100644 --- a/drivers/infiniband/hw/mthca/mthca_qp.c +++ b/drivers/infiniband/hw/mthca/mthca_qp.c | |||
| @@ -2204,7 +2204,7 @@ int __devinit mthca_init_qp_table(struct mthca_dev *dev) | |||
| 2204 | return err; | 2204 | return err; |
| 2205 | } | 2205 | } |
| 2206 | 2206 | ||
| 2207 | void __devexit mthca_cleanup_qp_table(struct mthca_dev *dev) | 2207 | void mthca_cleanup_qp_table(struct mthca_dev *dev) |
| 2208 | { | 2208 | { |
| 2209 | int i; | 2209 | int i; |
| 2210 | u8 status; | 2210 | u8 status; |
diff --git a/drivers/infiniband/hw/mthca/mthca_srq.c b/drivers/infiniband/hw/mthca/mthca_srq.c index 0cfd15802217..2dd3aea05341 100644 --- a/drivers/infiniband/hw/mthca/mthca_srq.c +++ b/drivers/infiniband/hw/mthca/mthca_srq.c | |||
| @@ -206,7 +206,7 @@ int mthca_alloc_srq(struct mthca_dev *dev, struct mthca_pd *pd, | |||
| 206 | roundup_pow_of_two(sizeof (struct mthca_next_seg) + | 206 | roundup_pow_of_two(sizeof (struct mthca_next_seg) + |
| 207 | srq->max_gs * sizeof (struct mthca_data_seg))); | 207 | srq->max_gs * sizeof (struct mthca_data_seg))); |
| 208 | 208 | ||
| 209 | if (ds > dev->limits.max_desc_sz) | 209 | if (!mthca_is_memfree(dev) && (ds > dev->limits.max_desc_sz)) |
| 210 | return -EINVAL; | 210 | return -EINVAL; |
| 211 | 211 | ||
| 212 | srq->wqe_shift = long_log2(ds); | 212 | srq->wqe_shift = long_log2(ds); |
| @@ -684,7 +684,7 @@ int __devinit mthca_init_srq_table(struct mthca_dev *dev) | |||
| 684 | return err; | 684 | return err; |
| 685 | } | 685 | } |
| 686 | 686 | ||
| 687 | void __devexit mthca_cleanup_srq_table(struct mthca_dev *dev) | 687 | void mthca_cleanup_srq_table(struct mthca_dev *dev) |
| 688 | { | 688 | { |
| 689 | if (!(dev->mthca_flags & MTHCA_FLAG_SRQ)) | 689 | if (!(dev->mthca_flags & MTHCA_FLAG_SRQ)) |
| 690 | return; | 690 | return; |
diff --git a/drivers/infiniband/ulp/ipoib/ipoib_main.c b/drivers/infiniband/ulp/ipoib/ipoib_main.c index 53a32f65788d..9b0bd7c746ca 100644 --- a/drivers/infiniband/ulp/ipoib/ipoib_main.c +++ b/drivers/infiniband/ulp/ipoib/ipoib_main.c | |||
| @@ -723,7 +723,7 @@ static int ipoib_hard_header(struct sk_buff *skb, | |||
| 723 | * destination address onto the front of the skb so we can | 723 | * destination address onto the front of the skb so we can |
| 724 | * figure out where to send the packet later. | 724 | * figure out where to send the packet later. |
| 725 | */ | 725 | */ |
| 726 | if (!skb->dst || !skb->dst->neighbour) { | 726 | if ((!skb->dst || !skb->dst->neighbour) && daddr) { |
| 727 | struct ipoib_pseudoheader *phdr = | 727 | struct ipoib_pseudoheader *phdr = |
| 728 | (struct ipoib_pseudoheader *) skb_push(skb, sizeof *phdr); | 728 | (struct ipoib_pseudoheader *) skb_push(skb, sizeof *phdr); |
| 729 | memcpy(phdr->hwaddr, daddr, INFINIBAND_ALEN); | 729 | memcpy(phdr->hwaddr, daddr, INFINIBAND_ALEN); |
diff --git a/drivers/infiniband/ulp/srp/ib_srp.c b/drivers/infiniband/ulp/srp/ib_srp.c index 61924cc30e55..fd8a95a9c5d3 100644 --- a/drivers/infiniband/ulp/srp/ib_srp.c +++ b/drivers/infiniband/ulp/srp/ib_srp.c | |||
| @@ -607,10 +607,10 @@ static void srp_unmap_data(struct scsi_cmnd *scmnd, | |||
| 607 | */ | 607 | */ |
| 608 | if (likely(scmnd->use_sg)) { | 608 | if (likely(scmnd->use_sg)) { |
| 609 | nents = scmnd->use_sg; | 609 | nents = scmnd->use_sg; |
| 610 | scat = (struct scatterlist *) scmnd->request_buffer; | 610 | scat = scmnd->request_buffer; |
| 611 | } else { | 611 | } else { |
| 612 | nents = 1; | 612 | nents = 1; |
| 613 | scat = (struct scatterlist *) scmnd->request_buffer; | 613 | scat = &req->fake_sg; |
| 614 | } | 614 | } |
| 615 | 615 | ||
| 616 | dma_unmap_sg(target->srp_host->dev->dma_device, scat, nents, | 616 | dma_unmap_sg(target->srp_host->dev->dma_device, scat, nents, |
diff --git a/drivers/input/keyboard/hil_kbd.c b/drivers/input/keyboard/hil_kbd.c index 0a90962c38e7..63f387e4b783 100644 --- a/drivers/input/keyboard/hil_kbd.c +++ b/drivers/input/keyboard/hil_kbd.c | |||
| @@ -66,7 +66,7 @@ static unsigned int hil_kbd_set3[HIL_KEYCODES_SET3_TBLSIZE] = | |||
| 66 | static char hil_language[][16] = { HIL_LOCALE_MAP }; | 66 | static char hil_language[][16] = { HIL_LOCALE_MAP }; |
| 67 | 67 | ||
| 68 | struct hil_kbd { | 68 | struct hil_kbd { |
| 69 | struct input_dev dev; | 69 | struct input_dev *dev; |
| 70 | struct serio *serio; | 70 | struct serio *serio; |
| 71 | 71 | ||
| 72 | /* Input buffer and index for packets from HIL bus. */ | 72 | /* Input buffer and index for packets from HIL bus. */ |
| @@ -86,7 +86,7 @@ struct hil_kbd { | |||
| 86 | /* Process a complete packet after transfer from the HIL */ | 86 | /* Process a complete packet after transfer from the HIL */ |
| 87 | static void hil_kbd_process_record(struct hil_kbd *kbd) | 87 | static void hil_kbd_process_record(struct hil_kbd *kbd) |
| 88 | { | 88 | { |
| 89 | struct input_dev *dev = &kbd->dev; | 89 | struct input_dev *dev = kbd->dev; |
| 90 | hil_packet *data = kbd->data; | 90 | hil_packet *data = kbd->data; |
| 91 | hil_packet p; | 91 | hil_packet p; |
| 92 | int idx, i, cnt; | 92 | int idx, i, cnt; |
| @@ -240,8 +240,8 @@ static void hil_kbd_disconnect(struct serio *serio) | |||
| 240 | return; | 240 | return; |
| 241 | } | 241 | } |
| 242 | 242 | ||
| 243 | input_unregister_device(&kbd->dev); | ||
| 244 | serio_close(serio); | 243 | serio_close(serio); |
| 244 | input_unregister_device(kbd->dev); | ||
| 245 | kfree(kbd); | 245 | kfree(kbd); |
| 246 | } | 246 | } |
| 247 | 247 | ||
| @@ -251,16 +251,18 @@ static int hil_kbd_connect(struct serio *serio, struct serio_driver *drv) | |||
| 251 | uint8_t did, *idd; | 251 | uint8_t did, *idd; |
| 252 | int i; | 252 | int i; |
| 253 | 253 | ||
| 254 | kbd = kmalloc(sizeof(*kbd), GFP_KERNEL); | 254 | kbd = kzalloc(sizeof(*kbd), GFP_KERNEL); |
| 255 | if (!kbd) | 255 | if (!kbd) |
| 256 | return -ENOMEM; | 256 | return -ENOMEM; |
| 257 | memset(kbd, 0, sizeof(struct hil_kbd)); | 257 | |
| 258 | kbd->dev = input_allocate_device(); | ||
| 259 | if (!kbd->dev) goto bail1; | ||
| 260 | kbd->dev->private = kbd; | ||
| 258 | 261 | ||
| 259 | if (serio_open(serio, drv)) goto bail0; | 262 | if (serio_open(serio, drv)) goto bail0; |
| 260 | 263 | ||
| 261 | serio_set_drvdata(serio, kbd); | 264 | serio_set_drvdata(serio, kbd); |
| 262 | kbd->serio = serio; | 265 | kbd->serio = serio; |
| 263 | kbd->dev.private = kbd; | ||
| 264 | 266 | ||
| 265 | init_MUTEX_LOCKED(&(kbd->sem)); | 267 | init_MUTEX_LOCKED(&(kbd->sem)); |
| 266 | 268 | ||
| @@ -302,38 +304,38 @@ static int hil_kbd_connect(struct serio *serio, struct serio_driver *drv) | |||
| 302 | did, hil_language[did & HIL_IDD_DID_TYPE_KB_LANG_MASK]); | 304 | did, hil_language[did & HIL_IDD_DID_TYPE_KB_LANG_MASK]); |
| 303 | break; | 305 | break; |
| 304 | default: | 306 | default: |
| 305 | goto bail1; | 307 | goto bail2; |
| 306 | } | 308 | } |
| 307 | 309 | ||
| 308 | if(HIL_IDD_NUM_BUTTONS(idd) || HIL_IDD_NUM_AXES_PER_SET(*idd)) { | 310 | if(HIL_IDD_NUM_BUTTONS(idd) || HIL_IDD_NUM_AXES_PER_SET(*idd)) { |
| 309 | printk(KERN_INFO PREFIX "keyboards only, no combo devices supported.\n"); | 311 | printk(KERN_INFO PREFIX "keyboards only, no combo devices supported.\n"); |
| 310 | goto bail1; | 312 | goto bail2; |
| 311 | } | 313 | } |
| 312 | 314 | ||
| 313 | 315 | ||
| 314 | kbd->dev.evbit[0] = BIT(EV_KEY) | BIT(EV_REP); | 316 | kbd->dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP); |
| 315 | kbd->dev.ledbit[0] = BIT(LED_NUML) | BIT(LED_CAPSL) | BIT(LED_SCROLLL); | 317 | kbd->dev->ledbit[0] = BIT(LED_NUML) | BIT(LED_CAPSL) | BIT(LED_SCROLLL); |
| 316 | kbd->dev.keycodemax = HIL_KEYCODES_SET1_TBLSIZE; | 318 | kbd->dev->keycodemax = HIL_KEYCODES_SET1_TBLSIZE; |
| 317 | kbd->dev.keycodesize = sizeof(hil_kbd_set1[0]); | 319 | kbd->dev->keycodesize = sizeof(hil_kbd_set1[0]); |
| 318 | kbd->dev.keycode = hil_kbd_set1; | 320 | kbd->dev->keycode = hil_kbd_set1; |
| 319 | kbd->dev.name = strlen(kbd->rnm) ? kbd->rnm : HIL_GENERIC_NAME; | 321 | kbd->dev->name = strlen(kbd->rnm) ? kbd->rnm : HIL_GENERIC_NAME; |
| 320 | kbd->dev.phys = "hpkbd/input0"; /* XXX */ | 322 | kbd->dev->phys = "hpkbd/input0"; /* XXX */ |
| 321 | 323 | ||
| 322 | kbd->dev.id.bustype = BUS_HIL; | 324 | kbd->dev->id.bustype = BUS_HIL; |
| 323 | kbd->dev.id.vendor = PCI_VENDOR_ID_HP; | 325 | kbd->dev->id.vendor = PCI_VENDOR_ID_HP; |
| 324 | kbd->dev.id.product = 0x0001; /* TODO: get from kbd->rsc */ | 326 | kbd->dev->id.product = 0x0001; /* TODO: get from kbd->rsc */ |
| 325 | kbd->dev.id.version = 0x0100; /* TODO: get from kbd->rsc */ | 327 | kbd->dev->id.version = 0x0100; /* TODO: get from kbd->rsc */ |
| 326 | kbd->dev.dev = &serio->dev; | 328 | kbd->dev->dev = &serio->dev; |
| 327 | 329 | ||
| 328 | for (i = 0; i < 128; i++) { | 330 | for (i = 0; i < 128; i++) { |
| 329 | set_bit(hil_kbd_set1[i], kbd->dev.keybit); | 331 | set_bit(hil_kbd_set1[i], kbd->dev->keybit); |
| 330 | set_bit(hil_kbd_set3[i], kbd->dev.keybit); | 332 | set_bit(hil_kbd_set3[i], kbd->dev->keybit); |
| 331 | } | 333 | } |
| 332 | clear_bit(0, kbd->dev.keybit); | 334 | clear_bit(0, kbd->dev->keybit); |
| 333 | 335 | ||
| 334 | input_register_device(&kbd->dev); | 336 | input_register_device(kbd->dev); |
| 335 | printk(KERN_INFO "input: %s, ID: %d\n", | 337 | printk(KERN_INFO "input: %s, ID: %d\n", |
| 336 | kbd->dev.name, did); | 338 | kbd->dev->name, did); |
| 337 | 339 | ||
| 338 | serio->write(serio, 0); | 340 | serio->write(serio, 0); |
| 339 | serio->write(serio, 0); | 341 | serio->write(serio, 0); |
| @@ -343,8 +345,10 @@ static int hil_kbd_connect(struct serio *serio, struct serio_driver *drv) | |||
| 343 | up(&(kbd->sem)); | 345 | up(&(kbd->sem)); |
| 344 | 346 | ||
| 345 | return 0; | 347 | return 0; |
| 346 | bail1: | 348 | bail2: |
| 347 | serio_close(serio); | 349 | serio_close(serio); |
| 350 | bail1: | ||
| 351 | input_free_device(kbd->dev); | ||
| 348 | bail0: | 352 | bail0: |
| 349 | kfree(kbd); | 353 | kfree(kbd); |
| 350 | serio_set_drvdata(serio, NULL); | 354 | serio_set_drvdata(serio, NULL); |
diff --git a/drivers/input/keyboard/hilkbd.c b/drivers/input/keyboard/hilkbd.c index e95bc052e32a..33edd030aa75 100644 --- a/drivers/input/keyboard/hilkbd.c +++ b/drivers/input/keyboard/hilkbd.c | |||
| @@ -3,7 +3,7 @@ | |||
| 3 | * | 3 | * |
| 4 | * Copyright (C) 1998 Philip Blundell <philb@gnu.org> | 4 | * Copyright (C) 1998 Philip Blundell <philb@gnu.org> |
| 5 | * Copyright (C) 1999 Matthew Wilcox <willy@bofh.ai> | 5 | * Copyright (C) 1999 Matthew Wilcox <willy@bofh.ai> |
| 6 | * Copyright (C) 1999-2003 Helge Deller <deller@gmx.de> | 6 | * Copyright (C) 1999-2006 Helge Deller <deller@gmx.de> |
| 7 | * | 7 | * |
| 8 | * Very basic HP Human Interface Loop (HIL) driver. | 8 | * Very basic HP Human Interface Loop (HIL) driver. |
| 9 | * This driver handles the keyboard on HP300 (m68k) and on some | 9 | * This driver handles the keyboard on HP300 (m68k) and on some |
| @@ -90,7 +90,7 @@ static unsigned int hphilkeyb_keycode[HIL_KEYCODES_SET1_TBLSIZE] = | |||
| 90 | 90 | ||
| 91 | /* HIL structure */ | 91 | /* HIL structure */ |
| 92 | static struct { | 92 | static struct { |
| 93 | struct input_dev dev; | 93 | struct input_dev *dev; |
| 94 | 94 | ||
| 95 | unsigned int curdev; | 95 | unsigned int curdev; |
| 96 | 96 | ||
| @@ -117,7 +117,7 @@ static void poll_finished(void) | |||
| 117 | down = (hil_dev.data[1] & 1) == 0; | 117 | down = (hil_dev.data[1] & 1) == 0; |
| 118 | scode = hil_dev.data[1] >> 1; | 118 | scode = hil_dev.data[1] >> 1; |
| 119 | key = hphilkeyb_keycode[scode]; | 119 | key = hphilkeyb_keycode[scode]; |
| 120 | input_report_key(&hil_dev.dev, key, down); | 120 | input_report_key(hil_dev.dev, key, down); |
| 121 | break; | 121 | break; |
| 122 | } | 122 | } |
| 123 | hil_dev.curdev = 0; | 123 | hil_dev.curdev = 0; |
| @@ -207,9 +207,14 @@ hil_keyb_init(void) | |||
| 207 | unsigned int i, kbid; | 207 | unsigned int i, kbid; |
| 208 | wait_queue_head_t hil_wait; | 208 | wait_queue_head_t hil_wait; |
| 209 | 209 | ||
| 210 | if (hil_dev.dev.id.bustype) { | 210 | if (hil_dev.dev) { |
| 211 | return -ENODEV; /* already initialized */ | 211 | return -ENODEV; /* already initialized */ |
| 212 | } | 212 | } |
| 213 | |||
| 214 | hil_dev.dev = input_allocate_device(); | ||
| 215 | if (!hil_dev.dev) | ||
| 216 | return -ENOMEM; | ||
| 217 | hil_dev.dev->private = &hil_dev; | ||
| 213 | 218 | ||
| 214 | #if defined(CONFIG_HP300) | 219 | #if defined(CONFIG_HP300) |
| 215 | if (!hwreg_present((void *)(HILBASE + HIL_DATA))) | 220 | if (!hwreg_present((void *)(HILBASE + HIL_DATA))) |
| @@ -247,28 +252,26 @@ hil_keyb_init(void) | |||
| 247 | c = 0; | 252 | c = 0; |
| 248 | hil_do(HIL_WRITEKBDSADR, &c, 1); | 253 | hil_do(HIL_WRITEKBDSADR, &c, 1); |
| 249 | 254 | ||
| 250 | init_input_dev(&hil_dev.dev); | ||
| 251 | |||
| 252 | for (i = 0; i < HIL_KEYCODES_SET1_TBLSIZE; i++) | 255 | for (i = 0; i < HIL_KEYCODES_SET1_TBLSIZE; i++) |
| 253 | if (hphilkeyb_keycode[i] != KEY_RESERVED) | 256 | if (hphilkeyb_keycode[i] != KEY_RESERVED) |
| 254 | set_bit(hphilkeyb_keycode[i], hil_dev.dev.keybit); | 257 | set_bit(hphilkeyb_keycode[i], hil_dev.dev->keybit); |
| 255 | 258 | ||
| 256 | hil_dev.dev.evbit[0] = BIT(EV_KEY) | BIT(EV_REP); | 259 | hil_dev.dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP); |
| 257 | hil_dev.dev.ledbit[0] = BIT(LED_NUML) | BIT(LED_CAPSL) | BIT(LED_SCROLLL); | 260 | hil_dev.dev->ledbit[0] = BIT(LED_NUML) | BIT(LED_CAPSL) | BIT(LED_SCROLLL); |
| 258 | hil_dev.dev.keycodemax = HIL_KEYCODES_SET1_TBLSIZE; | 261 | hil_dev.dev->keycodemax = HIL_KEYCODES_SET1_TBLSIZE; |
| 259 | hil_dev.dev.keycodesize = sizeof(hphilkeyb_keycode[0]); | 262 | hil_dev.dev->keycodesize = sizeof(hphilkeyb_keycode[0]); |
| 260 | hil_dev.dev.keycode = hphilkeyb_keycode; | 263 | hil_dev.dev->keycode = hphilkeyb_keycode; |
| 261 | hil_dev.dev.name = "HIL keyboard"; | 264 | hil_dev.dev->name = "HIL keyboard"; |
| 262 | hil_dev.dev.phys = "hpkbd/input0"; | 265 | hil_dev.dev->phys = "hpkbd/input0"; |
| 263 | 266 | ||
| 264 | hil_dev.dev.id.bustype = BUS_HIL; | 267 | hil_dev.dev->id.bustype = BUS_HIL; |
| 265 | hil_dev.dev.id.vendor = PCI_VENDOR_ID_HP; | 268 | hil_dev.dev->id.vendor = PCI_VENDOR_ID_HP; |
| 266 | hil_dev.dev.id.product = 0x0001; | 269 | hil_dev.dev->id.product = 0x0001; |
| 267 | hil_dev.dev.id.version = 0x0010; | 270 | hil_dev.dev->id.version = 0x0010; |
| 268 | 271 | ||
| 269 | input_register_device(&hil_dev.dev); | 272 | input_register_device(hil_dev.dev); |
| 270 | printk(KERN_INFO "input: %s, ID %d at 0x%08lx (irq %d) found and attached\n", | 273 | printk(KERN_INFO "input: %s, ID %d at 0x%08lx (irq %d) found and attached\n", |
| 271 | hil_dev.dev.name, kbid, HILBASE, HIL_IRQ); | 274 | hil_dev.dev->name, kbid, HILBASE, HIL_IRQ); |
| 272 | 275 | ||
| 273 | return 0; | 276 | return 0; |
| 274 | } | 277 | } |
| @@ -329,7 +332,9 @@ static void __exit hil_exit(void) | |||
| 329 | /* Turn off interrupts */ | 332 | /* Turn off interrupts */ |
| 330 | hil_do(HIL_INTOFF, NULL, 0); | 333 | hil_do(HIL_INTOFF, NULL, 0); |
| 331 | 334 | ||
| 332 | input_unregister_device(&hil_dev.dev); | 335 | input_unregister_device(hil_dev.dev); |
| 336 | |||
| 337 | hil_dev.dev = NULL; | ||
| 333 | 338 | ||
| 334 | #if defined(CONFIG_PARISC) | 339 | #if defined(CONFIG_PARISC) |
| 335 | unregister_parisc_driver(&hil_driver); | 340 | unregister_parisc_driver(&hil_driver); |
diff --git a/drivers/input/mouse/hil_ptr.c b/drivers/input/mouse/hil_ptr.c index c2bf2ed07dc6..bfb564fd8fe2 100644 --- a/drivers/input/mouse/hil_ptr.c +++ b/drivers/input/mouse/hil_ptr.c | |||
| @@ -55,7 +55,7 @@ MODULE_LICENSE("Dual BSD/GPL"); | |||
| 55 | #define HIL_PTR_MAX_LENGTH 16 | 55 | #define HIL_PTR_MAX_LENGTH 16 |
| 56 | 56 | ||
| 57 | struct hil_ptr { | 57 | struct hil_ptr { |
| 58 | struct input_dev dev; | 58 | struct input_dev *dev; |
| 59 | struct serio *serio; | 59 | struct serio *serio; |
| 60 | 60 | ||
| 61 | /* Input buffer and index for packets from HIL bus. */ | 61 | /* Input buffer and index for packets from HIL bus. */ |
| @@ -79,7 +79,7 @@ struct hil_ptr { | |||
| 79 | /* Process a complete packet after transfer from the HIL */ | 79 | /* Process a complete packet after transfer from the HIL */ |
| 80 | static void hil_ptr_process_record(struct hil_ptr *ptr) | 80 | static void hil_ptr_process_record(struct hil_ptr *ptr) |
| 81 | { | 81 | { |
| 82 | struct input_dev *dev = &ptr->dev; | 82 | struct input_dev *dev = ptr->dev; |
| 83 | hil_packet *data = ptr->data; | 83 | hil_packet *data = ptr->data; |
| 84 | hil_packet p; | 84 | hil_packet p; |
| 85 | int idx, i, cnt, laxis; | 85 | int idx, i, cnt, laxis; |
| @@ -148,12 +148,12 @@ static void hil_ptr_process_record(struct hil_ptr *ptr) | |||
| 148 | if (absdev) { | 148 | if (absdev) { |
| 149 | val = lo + (hi<<8); | 149 | val = lo + (hi<<8); |
| 150 | #ifdef TABLET_AUTOADJUST | 150 | #ifdef TABLET_AUTOADJUST |
| 151 | if (val < ptr->dev.absmin[ABS_X + i]) | 151 | if (val < dev->absmin[ABS_X + i]) |
| 152 | ptr->dev.absmin[ABS_X + i] = val; | 152 | dev->absmin[ABS_X + i] = val; |
| 153 | if (val > ptr->dev.absmax[ABS_X + i]) | 153 | if (val > dev->absmax[ABS_X + i]) |
| 154 | ptr->dev.absmax[ABS_X + i] = val; | 154 | dev->absmax[ABS_X + i] = val; |
| 155 | #endif | 155 | #endif |
| 156 | if (i%3) val = ptr->dev.absmax[ABS_X + i] - val; | 156 | if (i%3) val = dev->absmax[ABS_X + i] - val; |
| 157 | input_report_abs(dev, ABS_X + i, val); | 157 | input_report_abs(dev, ABS_X + i, val); |
| 158 | } else { | 158 | } else { |
| 159 | val = (int) (((int8_t)lo) | ((int8_t)hi<<8)); | 159 | val = (int) (((int8_t)lo) | ((int8_t)hi<<8)); |
| @@ -233,26 +233,29 @@ static void hil_ptr_disconnect(struct serio *serio) | |||
| 233 | return; | 233 | return; |
| 234 | } | 234 | } |
| 235 | 235 | ||
| 236 | input_unregister_device(&ptr->dev); | ||
| 237 | serio_close(serio); | 236 | serio_close(serio); |
| 237 | input_unregister_device(ptr->dev); | ||
| 238 | kfree(ptr); | 238 | kfree(ptr); |
| 239 | } | 239 | } |
| 240 | 240 | ||
| 241 | static int hil_ptr_connect(struct serio *serio, struct serio_driver *driver) | 241 | static int hil_ptr_connect(struct serio *serio, struct serio_driver *driver) |
| 242 | { | 242 | { |
| 243 | struct hil_ptr *ptr; | 243 | struct hil_ptr *ptr; |
| 244 | char *txt; | 244 | char *txt; |
| 245 | unsigned int i, naxsets, btntype; | 245 | unsigned int i, naxsets, btntype; |
| 246 | uint8_t did, *idd; | 246 | uint8_t did, *idd; |
| 247 | 247 | ||
| 248 | if (!(ptr = kmalloc(sizeof(struct hil_ptr), GFP_KERNEL))) return -ENOMEM; | 248 | if (!(ptr = kzalloc(sizeof(struct hil_ptr), GFP_KERNEL))) |
| 249 | memset(ptr, 0, sizeof(struct hil_ptr)); | 249 | return -ENOMEM; |
| 250 | 250 | ||
| 251 | if (serio_open(serio, driver)) goto bail0; | 251 | ptr->dev = input_allocate_device(); |
| 252 | if (!ptr->dev) goto bail0; | ||
| 253 | ptr->dev->private = ptr; | ||
| 254 | |||
| 255 | if (serio_open(serio, driver)) goto bail1; | ||
| 252 | 256 | ||
| 253 | serio_set_drvdata(serio, ptr); | 257 | serio_set_drvdata(serio, ptr); |
| 254 | ptr->serio = serio; | 258 | ptr->serio = serio; |
| 255 | ptr->dev.private = ptr; | ||
| 256 | 259 | ||
| 257 | init_MUTEX_LOCKED(&(ptr->sem)); | 260 | init_MUTEX_LOCKED(&(ptr->sem)); |
| 258 | 261 | ||
| @@ -283,25 +286,24 @@ static int hil_ptr_connect(struct serio *serio, struct serio_driver *driver) | |||
| 283 | 286 | ||
| 284 | up(&(ptr->sem)); | 287 | up(&(ptr->sem)); |
| 285 | 288 | ||
| 286 | init_input_dev(&ptr->dev); | ||
| 287 | did = ptr->idd[0]; | 289 | did = ptr->idd[0]; |
| 288 | idd = ptr->idd + 1; | 290 | idd = ptr->idd + 1; |
| 289 | txt = "unknown"; | 291 | txt = "unknown"; |
| 290 | if ((did & HIL_IDD_DID_TYPE_MASK) == HIL_IDD_DID_TYPE_REL) { | 292 | if ((did & HIL_IDD_DID_TYPE_MASK) == HIL_IDD_DID_TYPE_REL) { |
| 291 | ptr->dev.evbit[0] = BIT(EV_REL); | 293 | ptr->dev->evbit[0] = BIT(EV_REL); |
| 292 | txt = "relative"; | 294 | txt = "relative"; |
| 293 | } | 295 | } |
| 294 | 296 | ||
| 295 | if ((did & HIL_IDD_DID_TYPE_MASK) == HIL_IDD_DID_TYPE_ABS) { | 297 | if ((did & HIL_IDD_DID_TYPE_MASK) == HIL_IDD_DID_TYPE_ABS) { |
| 296 | ptr->dev.evbit[0] = BIT(EV_ABS); | 298 | ptr->dev->evbit[0] = BIT(EV_ABS); |
| 297 | txt = "absolute"; | 299 | txt = "absolute"; |
| 298 | } | 300 | } |
| 299 | if (!ptr->dev.evbit[0]) { | 301 | if (!ptr->dev->evbit[0]) { |
| 300 | goto bail1; | 302 | goto bail2; |
| 301 | } | 303 | } |
| 302 | 304 | ||
| 303 | ptr->nbtn = HIL_IDD_NUM_BUTTONS(idd); | 305 | ptr->nbtn = HIL_IDD_NUM_BUTTONS(idd); |
| 304 | if (ptr->nbtn) ptr->dev.evbit[0] |= BIT(EV_KEY); | 306 | if (ptr->nbtn) ptr->dev->evbit[0] |= BIT(EV_KEY); |
| 305 | 307 | ||
| 306 | naxsets = HIL_IDD_NUM_AXSETS(*idd); | 308 | naxsets = HIL_IDD_NUM_AXSETS(*idd); |
| 307 | ptr->naxes = HIL_IDD_NUM_AXES_PER_SET(*idd); | 309 | ptr->naxes = HIL_IDD_NUM_AXES_PER_SET(*idd); |
| @@ -325,7 +327,7 @@ static int hil_ptr_connect(struct serio *serio, struct serio_driver *driver) | |||
| 325 | btntype = BTN_MOUSE; | 327 | btntype = BTN_MOUSE; |
| 326 | 328 | ||
| 327 | for (i = 0; i < ptr->nbtn; i++) { | 329 | for (i = 0; i < ptr->nbtn; i++) { |
| 328 | set_bit(btntype | i, ptr->dev.keybit); | 330 | set_bit(btntype | i, ptr->dev->keybit); |
| 329 | ptr->btnmap[i] = btntype | i; | 331 | ptr->btnmap[i] = btntype | i; |
| 330 | } | 332 | } |
| 331 | 333 | ||
| @@ -337,50 +339,52 @@ static int hil_ptr_connect(struct serio *serio, struct serio_driver *driver) | |||
| 337 | 339 | ||
| 338 | if ((did & HIL_IDD_DID_TYPE_MASK) == HIL_IDD_DID_TYPE_REL) { | 340 | if ((did & HIL_IDD_DID_TYPE_MASK) == HIL_IDD_DID_TYPE_REL) { |
| 339 | for (i = 0; i < ptr->naxes; i++) { | 341 | for (i = 0; i < ptr->naxes; i++) { |
| 340 | set_bit(REL_X + i, ptr->dev.relbit); | 342 | set_bit(REL_X + i, ptr->dev->relbit); |
| 341 | } | 343 | } |
| 342 | for (i = 3; (i < ptr->naxes + 3) && (naxsets > 1); i++) { | 344 | for (i = 3; (i < ptr->naxes + 3) && (naxsets > 1); i++) { |
| 343 | set_bit(REL_X + i, ptr->dev.relbit); | 345 | set_bit(REL_X + i, ptr->dev->relbit); |
| 344 | } | 346 | } |
| 345 | } else { | 347 | } else { |
| 346 | for (i = 0; i < ptr->naxes; i++) { | 348 | for (i = 0; i < ptr->naxes; i++) { |
| 347 | set_bit(ABS_X + i, ptr->dev.absbit); | 349 | set_bit(ABS_X + i, ptr->dev->absbit); |
| 348 | ptr->dev.absmin[ABS_X + i] = 0; | 350 | ptr->dev->absmin[ABS_X + i] = 0; |
| 349 | ptr->dev.absmax[ABS_X + i] = | 351 | ptr->dev->absmax[ABS_X + i] = |
| 350 | HIL_IDD_AXIS_MAX((ptr->idd + 1), i); | 352 | HIL_IDD_AXIS_MAX((ptr->idd + 1), i); |
| 351 | } | 353 | } |
| 352 | for (i = 3; (i < ptr->naxes + 3) && (naxsets > 1); i++) { | 354 | for (i = 3; (i < ptr->naxes + 3) && (naxsets > 1); i++) { |
| 353 | set_bit(ABS_X + i, ptr->dev.absbit); | 355 | set_bit(ABS_X + i, ptr->dev->absbit); |
| 354 | ptr->dev.absmin[ABS_X + i] = 0; | 356 | ptr->dev->absmin[ABS_X + i] = 0; |
| 355 | ptr->dev.absmax[ABS_X + i] = | 357 | ptr->dev->absmax[ABS_X + i] = |
| 356 | HIL_IDD_AXIS_MAX((ptr->idd + 1), (i - 3)); | 358 | HIL_IDD_AXIS_MAX((ptr->idd + 1), (i - 3)); |
| 357 | } | 359 | } |
| 358 | #ifdef TABLET_AUTOADJUST | 360 | #ifdef TABLET_AUTOADJUST |
| 359 | for (i = 0; i < ABS_MAX; i++) { | 361 | for (i = 0; i < ABS_MAX; i++) { |
| 360 | int diff = ptr->dev.absmax[ABS_X + i] / 10; | 362 | int diff = ptr->dev->absmax[ABS_X + i] / 10; |
| 361 | ptr->dev.absmin[ABS_X + i] += diff; | 363 | ptr->dev->absmin[ABS_X + i] += diff; |
| 362 | ptr->dev.absmax[ABS_X + i] -= diff; | 364 | ptr->dev->absmax[ABS_X + i] -= diff; |
| 363 | } | 365 | } |
| 364 | #endif | 366 | #endif |
| 365 | } | 367 | } |
| 366 | 368 | ||
| 367 | ptr->dev.name = strlen(ptr->rnm) ? ptr->rnm : HIL_GENERIC_NAME; | 369 | ptr->dev->name = strlen(ptr->rnm) ? ptr->rnm : HIL_GENERIC_NAME; |
| 368 | 370 | ||
| 369 | ptr->dev.id.bustype = BUS_HIL; | 371 | ptr->dev->id.bustype = BUS_HIL; |
| 370 | ptr->dev.id.vendor = PCI_VENDOR_ID_HP; | 372 | ptr->dev->id.vendor = PCI_VENDOR_ID_HP; |
| 371 | ptr->dev.id.product = 0x0001; /* TODO: get from ptr->rsc */ | 373 | ptr->dev->id.product = 0x0001; /* TODO: get from ptr->rsc */ |
| 372 | ptr->dev.id.version = 0x0100; /* TODO: get from ptr->rsc */ | 374 | ptr->dev->id.version = 0x0100; /* TODO: get from ptr->rsc */ |
| 373 | ptr->dev.dev = &serio->dev; | 375 | ptr->dev->dev = &serio->dev; |
| 374 | 376 | ||
| 375 | input_register_device(&ptr->dev); | 377 | input_register_device(ptr->dev); |
| 376 | printk(KERN_INFO "input: %s (%s), ID: %d\n", | 378 | printk(KERN_INFO "input: %s (%s), ID: %d\n", |
| 377 | ptr->dev.name, | 379 | ptr->dev->name, |
| 378 | (btntype == BTN_MOUSE) ? "HIL mouse":"HIL tablet or touchpad", | 380 | (btntype == BTN_MOUSE) ? "HIL mouse":"HIL tablet or touchpad", |
| 379 | did); | 381 | did); |
| 380 | 382 | ||
| 381 | return 0; | 383 | return 0; |
| 382 | bail1: | 384 | bail2: |
| 383 | serio_close(serio); | 385 | serio_close(serio); |
| 386 | bail1: | ||
| 387 | input_free_device(ptr->dev); | ||
| 384 | bail0: | 388 | bail0: |
| 385 | kfree(ptr); | 389 | kfree(ptr); |
| 386 | serio_set_drvdata(serio, NULL); | 390 | serio_set_drvdata(serio, NULL); |
diff --git a/drivers/input/serio/gscps2.c b/drivers/input/serio/gscps2.c index a7b0de0f92b2..c0b1e4becad3 100644 --- a/drivers/input/serio/gscps2.c +++ b/drivers/input/serio/gscps2.c | |||
| @@ -1,7 +1,7 @@ | |||
| 1 | /* | 1 | /* |
| 2 | * drivers/input/serio/gscps2.c | 2 | * drivers/input/serio/gscps2.c |
| 3 | * | 3 | * |
| 4 | * Copyright (c) 2004 Helge Deller <deller@gmx.de> | 4 | * Copyright (c) 2004-2006 Helge Deller <deller@gmx.de> |
| 5 | * Copyright (c) 2002 Laurent Canet <canetl@esiee.fr> | 5 | * Copyright (c) 2002 Laurent Canet <canetl@esiee.fr> |
| 6 | * Copyright (c) 2002 Thibaut Varene <varenet@parisc-linux.org> | 6 | * Copyright (c) 2002 Thibaut Varene <varenet@parisc-linux.org> |
| 7 | * | 7 | * |
| @@ -354,7 +354,7 @@ static int __init gscps2_probe(struct parisc_device *dev) | |||
| 354 | memset(serio, 0, sizeof(struct serio)); | 354 | memset(serio, 0, sizeof(struct serio)); |
| 355 | ps2port->port = serio; | 355 | ps2port->port = serio; |
| 356 | ps2port->padev = dev; | 356 | ps2port->padev = dev; |
| 357 | ps2port->addr = ioremap(hpa, GSC_STATUS + 4); | 357 | ps2port->addr = ioremap_nocache(hpa, GSC_STATUS + 4); |
| 358 | spin_lock_init(&ps2port->lock); | 358 | spin_lock_init(&ps2port->lock); |
| 359 | 359 | ||
| 360 | gscps2_reset(ps2port); | 360 | gscps2_reset(ps2port); |
diff --git a/drivers/isdn/sc/ioctl.c b/drivers/isdn/sc/ioctl.c index 94c9afb7017c..f4f71226a078 100644 --- a/drivers/isdn/sc/ioctl.c +++ b/drivers/isdn/sc/ioctl.c | |||
| @@ -46,7 +46,8 @@ int sc_ioctl(int card, scs_ioctl *data) | |||
| 46 | pr_debug("%s: SCIOCRESET: ioctl received\n", | 46 | pr_debug("%s: SCIOCRESET: ioctl received\n", |
| 47 | sc_adapter[card]->devicename); | 47 | sc_adapter[card]->devicename); |
| 48 | sc_adapter[card]->StartOnReset = 0; | 48 | sc_adapter[card]->StartOnReset = 0; |
| 49 | return (reset(card)); | 49 | kfree(rcvmsg); |
| 50 | return reset(card); | ||
| 50 | } | 51 | } |
| 51 | 52 | ||
| 52 | case SCIOCLOAD: | 53 | case SCIOCLOAD: |
| @@ -183,7 +184,7 @@ int sc_ioctl(int card, scs_ioctl *data) | |||
| 183 | sc_adapter[card]->devicename); | 184 | sc_adapter[card]->devicename); |
| 184 | 185 | ||
| 185 | spid = kmalloc(SCIOC_SPIDSIZE, GFP_KERNEL); | 186 | spid = kmalloc(SCIOC_SPIDSIZE, GFP_KERNEL); |
| 186 | if(!spid) { | 187 | if (!spid) { |
| 187 | kfree(rcvmsg); | 188 | kfree(rcvmsg); |
| 188 | return -ENOMEM; | 189 | return -ENOMEM; |
| 189 | } | 190 | } |
| @@ -195,10 +196,10 @@ int sc_ioctl(int card, scs_ioctl *data) | |||
| 195 | if (!status) { | 196 | if (!status) { |
| 196 | pr_debug("%s: SCIOCGETSPID: command successful\n", | 197 | pr_debug("%s: SCIOCGETSPID: command successful\n", |
| 197 | sc_adapter[card]->devicename); | 198 | sc_adapter[card]->devicename); |
| 198 | } | 199 | } else { |
| 199 | else { | ||
| 200 | pr_debug("%s: SCIOCGETSPID: command failed (status = %d)\n", | 200 | pr_debug("%s: SCIOCGETSPID: command failed (status = %d)\n", |
| 201 | sc_adapter[card]->devicename, status); | 201 | sc_adapter[card]->devicename, status); |
| 202 | kfree(spid); | ||
| 202 | kfree(rcvmsg); | 203 | kfree(rcvmsg); |
| 203 | return status; | 204 | return status; |
| 204 | } | 205 | } |
diff --git a/drivers/leds/Kconfig b/drivers/leds/Kconfig new file mode 100644 index 000000000000..2c4f20b7f021 --- /dev/null +++ b/drivers/leds/Kconfig | |||
| @@ -0,0 +1,77 @@ | |||
| 1 | |||
| 2 | menu "LED devices" | ||
| 3 | |||
| 4 | config NEW_LEDS | ||
| 5 | bool "LED Support" | ||
| 6 | help | ||
| 7 | Say Y to enable Linux LED support. This is not related to standard | ||
| 8 | keyboard LEDs which are controlled via the input system. | ||
| 9 | |||
| 10 | config LEDS_CLASS | ||
| 11 | tristate "LED Class Support" | ||
| 12 | depends NEW_LEDS | ||
| 13 | help | ||
| 14 | This option enables the led sysfs class in /sys/class/leds. You'll | ||
| 15 | need this to do anything useful with LEDs. If unsure, say N. | ||
| 16 | |||
| 17 | config LEDS_TRIGGERS | ||
| 18 | bool "LED Trigger support" | ||
| 19 | depends NEW_LEDS | ||
| 20 | help | ||
| 21 | This option enables trigger support for the leds class. | ||
| 22 | These triggers allow kernel events to drive the LEDs and can | ||
| 23 | be configured via sysfs. If unsure, say Y. | ||
| 24 | |||
| 25 | config LEDS_CORGI | ||
| 26 | tristate "LED Support for the Sharp SL-C7x0 series" | ||
| 27 | depends LEDS_CLASS && PXA_SHARP_C7xx | ||
| 28 | help | ||
| 29 | This option enables support for the LEDs on Sharp Zaurus | ||
| 30 | SL-C7x0 series (C700, C750, C760, C860). | ||
| 31 | |||
| 32 | config LEDS_LOCOMO | ||
| 33 | tristate "LED Support for Locomo device" | ||
| 34 | depends LEDS_CLASS && SHARP_LOCOMO | ||
| 35 | help | ||
| 36 | This option enables support for the LEDs on Sharp Locomo. | ||
| 37 | Zaurus models SL-5500 and SL-5600. | ||
| 38 | |||
| 39 | config LEDS_SPITZ | ||
| 40 | tristate "LED Support for the Sharp SL-Cxx00 series" | ||
| 41 | depends LEDS_CLASS && PXA_SHARP_Cxx00 | ||
| 42 | help | ||
| 43 | This option enables support for the LEDs on Sharp Zaurus | ||
| 44 | SL-Cxx00 series (C1000, C3000, C3100). | ||
| 45 | |||
| 46 | config LEDS_IXP4XX | ||
| 47 | tristate "LED Support for GPIO connected LEDs on IXP4XX processors" | ||
| 48 | depends LEDS_CLASS && ARCH_IXP4XX | ||
| 49 | help | ||
| 50 | This option enables support for the LEDs connected to GPIO | ||
| 51 | outputs of the Intel IXP4XX processors. To be useful the | ||
| 52 | particular board must have LEDs and they must be connected | ||
| 53 | to the GPIO lines. If unsure, say Y. | ||
| 54 | |||
| 55 | config LEDS_TOSA | ||
| 56 | tristate "LED Support for the Sharp SL-6000 series" | ||
| 57 | depends LEDS_CLASS && PXA_SHARPSL | ||
| 58 | help | ||
| 59 | This option enables support for the LEDs on Sharp Zaurus | ||
| 60 | SL-6000 series. | ||
| 61 | |||
| 62 | config LEDS_TRIGGER_TIMER | ||
| 63 | tristate "LED Timer Trigger" | ||
| 64 | depends LEDS_TRIGGERS | ||
| 65 | help | ||
| 66 | This allows LEDs to be controlled by a programmable timer | ||
| 67 | via sysfs. If unsure, say Y. | ||
| 68 | |||
| 69 | config LEDS_TRIGGER_IDE_DISK | ||
| 70 | bool "LED Timer Trigger" | ||
| 71 | depends LEDS_TRIGGERS && BLK_DEV_IDEDISK | ||
| 72 | help | ||
| 73 | This allows LEDs to be controlled by IDE disk activity. | ||
| 74 | If unsure, say Y. | ||
| 75 | |||
| 76 | endmenu | ||
| 77 | |||
diff --git a/drivers/leds/Makefile b/drivers/leds/Makefile new file mode 100644 index 000000000000..40699d3cabbf --- /dev/null +++ b/drivers/leds/Makefile | |||
| @@ -0,0 +1,16 @@ | |||
| 1 | |||
| 2 | # LED Core | ||
| 3 | obj-$(CONFIG_NEW_LEDS) += led-core.o | ||
| 4 | obj-$(CONFIG_LEDS_CLASS) += led-class.o | ||
| 5 | obj-$(CONFIG_LEDS_TRIGGERS) += led-triggers.o | ||
| 6 | |||
| 7 | # LED Platform Drivers | ||
| 8 | obj-$(CONFIG_LEDS_CORGI) += leds-corgi.o | ||
| 9 | obj-$(CONFIG_LEDS_LOCOMO) += leds-locomo.o | ||
| 10 | obj-$(CONFIG_LEDS_SPITZ) += leds-spitz.o | ||
| 11 | obj-$(CONFIG_LEDS_IXP4XX) += leds-ixp4xx-gpio.o | ||
| 12 | obj-$(CONFIG_LEDS_TOSA) += leds-tosa.o | ||
| 13 | |||
| 14 | # LED Triggers | ||
| 15 | obj-$(CONFIG_LEDS_TRIGGER_TIMER) += ledtrig-timer.o | ||
| 16 | obj-$(CONFIG_LEDS_TRIGGER_IDE_DISK) += ledtrig-ide-disk.o | ||
diff --git a/drivers/leds/led-class.c b/drivers/leds/led-class.c new file mode 100644 index 000000000000..b0b5d05fadd6 --- /dev/null +++ b/drivers/leds/led-class.c | |||
| @@ -0,0 +1,167 @@ | |||
| 1 | /* | ||
| 2 | * LED Class Core | ||
| 3 | * | ||
| 4 | * Copyright (C) 2005 John Lenz <lenz@cs.wisc.edu> | ||
| 5 | * Copyright (C) 2005-2006 Richard Purdie <rpurdie@openedhand.com> | ||
| 6 | * | ||
| 7 | * This program is free software; you can redistribute it and/or modify | ||
| 8 | * it under the terms of the GNU General Public License version 2 as | ||
| 9 | * published by the Free Software Foundation. | ||
| 10 | */ | ||
| 11 | |||
| 12 | #include <linux/config.h> | ||
| 13 | #include <linux/module.h> | ||
| 14 | #include <linux/kernel.h> | ||
| 15 | #include <linux/init.h> | ||
| 16 | #include <linux/list.h> | ||
| 17 | #include <linux/spinlock.h> | ||
| 18 | #include <linux/device.h> | ||
| 19 | #include <linux/sysdev.h> | ||
| 20 | #include <linux/timer.h> | ||
| 21 | #include <linux/err.h> | ||
| 22 | #include <linux/leds.h> | ||
| 23 | #include "leds.h" | ||
| 24 | |||
| 25 | static struct class *leds_class; | ||
| 26 | |||
| 27 | static ssize_t led_brightness_show(struct class_device *dev, char *buf) | ||
| 28 | { | ||
| 29 | struct led_classdev *led_cdev = class_get_devdata(dev); | ||
| 30 | ssize_t ret = 0; | ||
| 31 | |||
| 32 | /* no lock needed for this */ | ||
| 33 | sprintf(buf, "%u\n", led_cdev->brightness); | ||
| 34 | ret = strlen(buf) + 1; | ||
| 35 | |||
| 36 | return ret; | ||
| 37 | } | ||
| 38 | |||
| 39 | static ssize_t led_brightness_store(struct class_device *dev, | ||
| 40 | const char *buf, size_t size) | ||
| 41 | { | ||
| 42 | struct led_classdev *led_cdev = class_get_devdata(dev); | ||
| 43 | ssize_t ret = -EINVAL; | ||
| 44 | char *after; | ||
| 45 | unsigned long state = simple_strtoul(buf, &after, 10); | ||
| 46 | |||
| 47 | if (after - buf > 0) { | ||
| 48 | ret = after - buf; | ||
| 49 | led_set_brightness(led_cdev, state); | ||
| 50 | } | ||
| 51 | |||
| 52 | return ret; | ||
| 53 | } | ||
| 54 | |||
| 55 | static CLASS_DEVICE_ATTR(brightness, 0644, led_brightness_show, | ||
| 56 | led_brightness_store); | ||
| 57 | #ifdef CONFIG_LEDS_TRIGGERS | ||
| 58 | static CLASS_DEVICE_ATTR(trigger, 0644, led_trigger_show, led_trigger_store); | ||
| 59 | #endif | ||
| 60 | |||
| 61 | /** | ||
| 62 | * led_classdev_suspend - suspend an led_classdev. | ||
| 63 | * @led_cdev: the led_classdev to suspend. | ||
| 64 | */ | ||
| 65 | void led_classdev_suspend(struct led_classdev *led_cdev) | ||
| 66 | { | ||
| 67 | led_cdev->flags |= LED_SUSPENDED; | ||
| 68 | led_cdev->brightness_set(led_cdev, 0); | ||
| 69 | } | ||
| 70 | EXPORT_SYMBOL_GPL(led_classdev_suspend); | ||
| 71 | |||
| 72 | /** | ||
| 73 | * led_classdev_resume - resume an led_classdev. | ||
| 74 | * @led_cdev: the led_classdev to resume. | ||
| 75 | */ | ||
| 76 | void led_classdev_resume(struct led_classdev *led_cdev) | ||
| 77 | { | ||
| 78 | led_cdev->brightness_set(led_cdev, led_cdev->brightness); | ||
| 79 | led_cdev->flags &= ~LED_SUSPENDED; | ||
| 80 | } | ||
| 81 | EXPORT_SYMBOL_GPL(led_classdev_resume); | ||
| 82 | |||
| 83 | /** | ||
| 84 | * led_classdev_register - register a new object of led_classdev class. | ||
| 85 | * @dev: The device to register. | ||
| 86 | * @led_cdev: the led_classdev structure for this device. | ||
| 87 | */ | ||
| 88 | int led_classdev_register(struct device *parent, struct led_classdev *led_cdev) | ||
| 89 | { | ||
| 90 | led_cdev->class_dev = class_device_create(leds_class, NULL, 0, | ||
| 91 | parent, "%s", led_cdev->name); | ||
| 92 | if (unlikely(IS_ERR(led_cdev->class_dev))) | ||
| 93 | return PTR_ERR(led_cdev->class_dev); | ||
| 94 | |||
| 95 | class_set_devdata(led_cdev->class_dev, led_cdev); | ||
| 96 | |||
| 97 | /* register the attributes */ | ||
| 98 | class_device_create_file(led_cdev->class_dev, | ||
| 99 | &class_device_attr_brightness); | ||
| 100 | |||
| 101 | /* add to the list of leds */ | ||
| 102 | write_lock(&leds_list_lock); | ||
| 103 | list_add_tail(&led_cdev->node, &leds_list); | ||
| 104 | write_unlock(&leds_list_lock); | ||
| 105 | |||
| 106 | #ifdef CONFIG_LEDS_TRIGGERS | ||
| 107 | rwlock_init(&led_cdev->trigger_lock); | ||
| 108 | |||
| 109 | led_trigger_set_default(led_cdev); | ||
| 110 | |||
| 111 | class_device_create_file(led_cdev->class_dev, | ||
| 112 | &class_device_attr_trigger); | ||
| 113 | #endif | ||
| 114 | |||
| 115 | printk(KERN_INFO "Registered led device: %s\n", | ||
| 116 | led_cdev->class_dev->class_id); | ||
| 117 | |||
| 118 | return 0; | ||
| 119 | } | ||
| 120 | EXPORT_SYMBOL_GPL(led_classdev_register); | ||
| 121 | |||
| 122 | /** | ||
| 123 | * led_classdev_unregister - unregisters a object of led_properties class. | ||
| 124 | * @led_cdev: the led device to unreigister | ||
| 125 | * | ||
| 126 | * Unregisters a previously registered via led_classdev_register object. | ||
| 127 | */ | ||
| 128 | void led_classdev_unregister(struct led_classdev *led_cdev) | ||
| 129 | { | ||
| 130 | class_device_remove_file(led_cdev->class_dev, | ||
| 131 | &class_device_attr_brightness); | ||
| 132 | #ifdef CONFIG_LEDS_TRIGGERS | ||
| 133 | class_device_remove_file(led_cdev->class_dev, | ||
| 134 | &class_device_attr_trigger); | ||
| 135 | write_lock(&led_cdev->trigger_lock); | ||
| 136 | if (led_cdev->trigger) | ||
| 137 | led_trigger_set(led_cdev, NULL); | ||
| 138 | write_unlock(&led_cdev->trigger_lock); | ||
| 139 | #endif | ||
| 140 | |||
| 141 | class_device_unregister(led_cdev->class_dev); | ||
| 142 | |||
| 143 | write_lock(&leds_list_lock); | ||
| 144 | list_del(&led_cdev->node); | ||
| 145 | write_unlock(&leds_list_lock); | ||
| 146 | } | ||
| 147 | EXPORT_SYMBOL_GPL(led_classdev_unregister); | ||
| 148 | |||
| 149 | static int __init leds_init(void) | ||
| 150 | { | ||
| 151 | leds_class = class_create(THIS_MODULE, "leds"); | ||
| 152 | if (IS_ERR(leds_class)) | ||
| 153 | return PTR_ERR(leds_class); | ||
| 154 | return 0; | ||
| 155 | } | ||
| 156 | |||
| 157 | static void __exit leds_exit(void) | ||
| 158 | { | ||
| 159 | class_destroy(leds_class); | ||
| 160 | } | ||
| 161 | |||
| 162 | subsys_initcall(leds_init); | ||
| 163 | module_exit(leds_exit); | ||
| 164 | |||
| 165 | MODULE_AUTHOR("John Lenz, Richard Purdie"); | ||
| 166 | MODULE_LICENSE("GPL"); | ||
| 167 | MODULE_DESCRIPTION("LED Class Interface"); | ||
diff --git a/drivers/leds/led-core.c b/drivers/leds/led-core.c new file mode 100644 index 000000000000..fe6541326c71 --- /dev/null +++ b/drivers/leds/led-core.c | |||
| @@ -0,0 +1,25 @@ | |||
| 1 | /* | ||
| 2 | * LED Class Core | ||
| 3 | * | ||
| 4 | * Copyright 2005-2006 Openedhand Ltd. | ||
| 5 | * | ||
| 6 | * Author: Richard Purdie <rpurdie@openedhand.com> | ||
| 7 | * | ||
| 8 | * This program is free software; you can redistribute it and/or modify | ||
| 9 | * it under the terms of the GNU General Public License version 2 as | ||
| 10 | * published by the Free Software Foundation. | ||
| 11 | * | ||
| 12 | */ | ||
| 13 | |||
| 14 | #include <linux/kernel.h> | ||
| 15 | #include <linux/list.h> | ||
| 16 | #include <linux/module.h> | ||
| 17 | #include <linux/spinlock.h> | ||
| 18 | #include <linux/leds.h> | ||
| 19 | #include "leds.h" | ||
| 20 | |||
| 21 | rwlock_t leds_list_lock = RW_LOCK_UNLOCKED; | ||
| 22 | LIST_HEAD(leds_list); | ||
| 23 | |||
| 24 | EXPORT_SYMBOL_GPL(leds_list); | ||
| 25 | EXPORT_SYMBOL_GPL(leds_list_lock); | ||
diff --git a/drivers/leds/led-triggers.c b/drivers/leds/led-triggers.c new file mode 100644 index 000000000000..5e2cd8be1191 --- /dev/null +++ b/drivers/leds/led-triggers.c | |||
| @@ -0,0 +1,239 @@ | |||
| 1 | /* | ||
| 2 | * LED Triggers Core | ||
| 3 | * | ||
| 4 | * Copyright 2005-2006 Openedhand Ltd. | ||
| 5 | * | ||
| 6 | * Author: Richard Purdie <rpurdie@openedhand.com> | ||
| 7 | * | ||
| 8 | * This program is free software; you can redistribute it and/or modify | ||
| 9 | * it under the terms of the GNU General Public License version 2 as | ||
| 10 | * published by the Free Software Foundation. | ||
| 11 | * | ||
| 12 | */ | ||
| 13 | |||
| 14 | #include <linux/config.h> | ||
| 15 | #include <linux/module.h> | ||
| 16 | #include <linux/kernel.h> | ||
| 17 | #include <linux/init.h> | ||
| 18 | #include <linux/list.h> | ||
| 19 | #include <linux/spinlock.h> | ||
| 20 | #include <linux/device.h> | ||
| 21 | #include <linux/sysdev.h> | ||
| 22 | #include <linux/timer.h> | ||
| 23 | #include <linux/leds.h> | ||
| 24 | #include "leds.h" | ||
| 25 | |||
| 26 | /* | ||
| 27 | * Nests outside led_cdev->trigger_lock | ||
| 28 | */ | ||
| 29 | static rwlock_t triggers_list_lock = RW_LOCK_UNLOCKED; | ||
| 30 | static LIST_HEAD(trigger_list); | ||
| 31 | |||
| 32 | ssize_t led_trigger_store(struct class_device *dev, const char *buf, | ||
| 33 | size_t count) | ||
| 34 | { | ||
| 35 | struct led_classdev *led_cdev = class_get_devdata(dev); | ||
| 36 | char trigger_name[TRIG_NAME_MAX]; | ||
| 37 | struct led_trigger *trig; | ||
| 38 | size_t len; | ||
| 39 | |||
| 40 | trigger_name[sizeof(trigger_name) - 1] = '\0'; | ||
| 41 | strncpy(trigger_name, buf, sizeof(trigger_name) - 1); | ||
| 42 | len = strlen(trigger_name); | ||
| 43 | |||
| 44 | if (len && trigger_name[len - 1] == '\n') | ||
| 45 | trigger_name[len - 1] = '\0'; | ||
| 46 | |||
| 47 | if (!strcmp(trigger_name, "none")) { | ||
| 48 | write_lock(&led_cdev->trigger_lock); | ||
| 49 | led_trigger_set(led_cdev, NULL); | ||
| 50 | write_unlock(&led_cdev->trigger_lock); | ||
| 51 | return count; | ||
| 52 | } | ||
| 53 | |||
| 54 | read_lock(&triggers_list_lock); | ||
| 55 | list_for_each_entry(trig, &trigger_list, next_trig) { | ||
| 56 | if (!strcmp(trigger_name, trig->name)) { | ||
| 57 | write_lock(&led_cdev->trigger_lock); | ||
| 58 | led_trigger_set(led_cdev, trig); | ||
| 59 | write_unlock(&led_cdev->trigger_lock); | ||
| 60 | |||
| 61 | read_unlock(&triggers_list_lock); | ||
| 62 | return count; | ||
| 63 | } | ||
| 64 | } | ||
| 65 | read_unlock(&triggers_list_lock); | ||
| 66 | |||
| 67 | return -EINVAL; | ||
| 68 | } | ||
| 69 | |||
| 70 | |||
| 71 | ssize_t led_trigger_show(struct class_device *dev, char *buf) | ||
| 72 | { | ||
| 73 | struct led_classdev *led_cdev = class_get_devdata(dev); | ||
| 74 | struct led_trigger *trig; | ||
| 75 | int len = 0; | ||
| 76 | |||
| 77 | read_lock(&triggers_list_lock); | ||
| 78 | read_lock(&led_cdev->trigger_lock); | ||
| 79 | |||
| 80 | if (!led_cdev->trigger) | ||
| 81 | len += sprintf(buf+len, "[none] "); | ||
| 82 | else | ||
| 83 | len += sprintf(buf+len, "none "); | ||
| 84 | |||
| 85 | list_for_each_entry(trig, &trigger_list, next_trig) { | ||
| 86 | if (led_cdev->trigger && !strcmp(led_cdev->trigger->name, | ||
| 87 | trig->name)) | ||
| 88 | len += sprintf(buf+len, "[%s] ", trig->name); | ||
| 89 | else | ||
| 90 | len += sprintf(buf+len, "%s ", trig->name); | ||
| 91 | } | ||
| 92 | read_unlock(&led_cdev->trigger_lock); | ||
| 93 | read_unlock(&triggers_list_lock); | ||
| 94 | |||
| 95 | len += sprintf(len+buf, "\n"); | ||
| 96 | return len; | ||
| 97 | } | ||
| 98 | |||
| 99 | void led_trigger_event(struct led_trigger *trigger, | ||
| 100 | enum led_brightness brightness) | ||
| 101 | { | ||
| 102 | struct list_head *entry; | ||
| 103 | |||
| 104 | if (!trigger) | ||
| 105 | return; | ||
| 106 | |||
| 107 | read_lock(&trigger->leddev_list_lock); | ||
| 108 | list_for_each(entry, &trigger->led_cdevs) { | ||
| 109 | struct led_classdev *led_cdev; | ||
| 110 | |||
| 111 | led_cdev = list_entry(entry, struct led_classdev, trig_list); | ||
| 112 | led_set_brightness(led_cdev, brightness); | ||
| 113 | } | ||
| 114 | read_unlock(&trigger->leddev_list_lock); | ||
| 115 | } | ||
| 116 | |||
| 117 | /* Caller must ensure led_cdev->trigger_lock held */ | ||
| 118 | void led_trigger_set(struct led_classdev *led_cdev, struct led_trigger *trigger) | ||
| 119 | { | ||
| 120 | unsigned long flags; | ||
| 121 | |||
| 122 | /* Remove any existing trigger */ | ||
| 123 | if (led_cdev->trigger) { | ||
| 124 | write_lock_irqsave(&led_cdev->trigger->leddev_list_lock, flags); | ||
| 125 | list_del(&led_cdev->trig_list); | ||
| 126 | write_unlock_irqrestore(&led_cdev->trigger->leddev_list_lock, flags); | ||
| 127 | if (led_cdev->trigger->deactivate) | ||
| 128 | led_cdev->trigger->deactivate(led_cdev); | ||
| 129 | } | ||
| 130 | if (trigger) { | ||
| 131 | write_lock_irqsave(&trigger->leddev_list_lock, flags); | ||
| 132 | list_add_tail(&led_cdev->trig_list, &trigger->led_cdevs); | ||
| 133 | write_unlock_irqrestore(&trigger->leddev_list_lock, flags); | ||
| 134 | if (trigger->activate) | ||
| 135 | trigger->activate(led_cdev); | ||
| 136 | } | ||
| 137 | led_cdev->trigger = trigger; | ||
| 138 | } | ||
| 139 | |||
| 140 | void led_trigger_set_default(struct led_classdev *led_cdev) | ||
| 141 | { | ||
| 142 | struct led_trigger *trig; | ||
| 143 | |||
| 144 | if (!led_cdev->default_trigger) | ||
| 145 | return; | ||
| 146 | |||
| 147 | read_lock(&triggers_list_lock); | ||
| 148 | write_lock(&led_cdev->trigger_lock); | ||
| 149 | list_for_each_entry(trig, &trigger_list, next_trig) { | ||
| 150 | if (!strcmp(led_cdev->default_trigger, trig->name)) | ||
| 151 | led_trigger_set(led_cdev, trig); | ||
| 152 | } | ||
| 153 | write_unlock(&led_cdev->trigger_lock); | ||
| 154 | read_unlock(&triggers_list_lock); | ||
| 155 | } | ||
| 156 | |||
| 157 | int led_trigger_register(struct led_trigger *trigger) | ||
| 158 | { | ||
| 159 | struct led_classdev *led_cdev; | ||
| 160 | |||
| 161 | rwlock_init(&trigger->leddev_list_lock); | ||
| 162 | INIT_LIST_HEAD(&trigger->led_cdevs); | ||
| 163 | |||
| 164 | /* Add to the list of led triggers */ | ||
| 165 | write_lock(&triggers_list_lock); | ||
| 166 | list_add_tail(&trigger->next_trig, &trigger_list); | ||
| 167 | write_unlock(&triggers_list_lock); | ||
| 168 | |||
| 169 | /* Register with any LEDs that have this as a default trigger */ | ||
| 170 | read_lock(&leds_list_lock); | ||
| 171 | list_for_each_entry(led_cdev, &leds_list, node) { | ||
| 172 | write_lock(&led_cdev->trigger_lock); | ||
| 173 | if (!led_cdev->trigger && led_cdev->default_trigger && | ||
| 174 | !strcmp(led_cdev->default_trigger, trigger->name)) | ||
| 175 | led_trigger_set(led_cdev, trigger); | ||
| 176 | write_unlock(&led_cdev->trigger_lock); | ||
| 177 | } | ||
| 178 | read_unlock(&leds_list_lock); | ||
| 179 | |||
| 180 | return 0; | ||
| 181 | } | ||
| 182 | |||
| 183 | void led_trigger_register_simple(const char *name, struct led_trigger **tp) | ||
| 184 | { | ||
| 185 | struct led_trigger *trigger; | ||
| 186 | |||
| 187 | trigger = kzalloc(sizeof(struct led_trigger), GFP_KERNEL); | ||
| 188 | |||
| 189 | if (trigger) { | ||
| 190 | trigger->name = name; | ||
| 191 | led_trigger_register(trigger); | ||
| 192 | } | ||
| 193 | *tp = trigger; | ||
| 194 | } | ||
| 195 | |||
| 196 | void led_trigger_unregister(struct led_trigger *trigger) | ||
| 197 | { | ||
| 198 | struct led_classdev *led_cdev; | ||
| 199 | |||
| 200 | /* Remove from the list of led triggers */ | ||
| 201 | write_lock(&triggers_list_lock); | ||
| 202 | list_del(&trigger->next_trig); | ||
| 203 | write_unlock(&triggers_list_lock); | ||
| 204 | |||
| 205 | /* Remove anyone actively using this trigger */ | ||
| 206 | read_lock(&leds_list_lock); | ||
| 207 | list_for_each_entry(led_cdev, &leds_list, node) { | ||
| 208 | write_lock(&led_cdev->trigger_lock); | ||
| 209 | if (led_cdev->trigger == trigger) | ||
| 210 | led_trigger_set(led_cdev, NULL); | ||
| 211 | write_unlock(&led_cdev->trigger_lock); | ||
| 212 | } | ||
| 213 | read_unlock(&leds_list_lock); | ||
| 214 | } | ||
| 215 | |||
| 216 | void led_trigger_unregister_simple(struct led_trigger *trigger) | ||
| 217 | { | ||
| 218 | led_trigger_unregister(trigger); | ||
| 219 | kfree(trigger); | ||
| 220 | } | ||
| 221 | |||
| 222 | /* Used by LED Class */ | ||
| 223 | EXPORT_SYMBOL_GPL(led_trigger_set); | ||
| 224 | EXPORT_SYMBOL_GPL(led_trigger_set_default); | ||
| 225 | EXPORT_SYMBOL_GPL(led_trigger_show); | ||
| 226 | EXPORT_SYMBOL_GPL(led_trigger_store); | ||
| 227 | |||
| 228 | /* LED Trigger Interface */ | ||
| 229 | EXPORT_SYMBOL_GPL(led_trigger_register); | ||
| 230 | EXPORT_SYMBOL_GPL(led_trigger_unregister); | ||
| 231 | |||
| 232 | /* Simple LED Tigger Interface */ | ||
| 233 | EXPORT_SYMBOL_GPL(led_trigger_register_simple); | ||
| 234 | EXPORT_SYMBOL_GPL(led_trigger_unregister_simple); | ||
| 235 | EXPORT_SYMBOL_GPL(led_trigger_event); | ||
| 236 | |||
| 237 | MODULE_AUTHOR("Richard Purdie"); | ||
| 238 | MODULE_LICENSE("GPL"); | ||
| 239 | MODULE_DESCRIPTION("LED Triggers Core"); | ||
diff --git a/drivers/leds/leds-corgi.c b/drivers/leds/leds-corgi.c new file mode 100644 index 000000000000..bb7d84df0121 --- /dev/null +++ b/drivers/leds/leds-corgi.c | |||
| @@ -0,0 +1,121 @@ | |||
| 1 | /* | ||
| 2 | * LED Triggers Core | ||
| 3 | * | ||
| 4 | * Copyright 2005-2006 Openedhand Ltd. | ||
| 5 | * | ||
| 6 | * Author: Richard Purdie <rpurdie@openedhand.com> | ||
| 7 | * | ||
| 8 | * This program is free software; you can redistribute it and/or modify | ||
| 9 | * it under the terms of the GNU General Public License version 2 as | ||
| 10 | * published by the Free Software Foundation. | ||
| 11 | * | ||
| 12 | */ | ||
| 13 | |||
| 14 | #include <linux/config.h> | ||
| 15 | #include <linux/kernel.h> | ||
| 16 | #include <linux/init.h> | ||
| 17 | #include <linux/platform_device.h> | ||
| 18 | #include <linux/leds.h> | ||
| 19 | #include <asm/mach-types.h> | ||
| 20 | #include <asm/arch/corgi.h> | ||
| 21 | #include <asm/arch/hardware.h> | ||
| 22 | #include <asm/arch/pxa-regs.h> | ||
| 23 | #include <asm/hardware/scoop.h> | ||
| 24 | |||
| 25 | static void corgiled_amber_set(struct led_classdev *led_cdev, enum led_brightness value) | ||
| 26 | { | ||
| 27 | if (value) | ||
| 28 | GPSR0 = GPIO_bit(CORGI_GPIO_LED_ORANGE); | ||
| 29 | else | ||
| 30 | GPCR0 = GPIO_bit(CORGI_GPIO_LED_ORANGE); | ||
| 31 | } | ||
| 32 | |||
| 33 | static void corgiled_green_set(struct led_classdev *led_cdev, enum led_brightness value) | ||
| 34 | { | ||
| 35 | if (value) | ||
| 36 | set_scoop_gpio(&corgiscoop_device.dev, CORGI_SCP_LED_GREEN); | ||
| 37 | else | ||
| 38 | reset_scoop_gpio(&corgiscoop_device.dev, CORGI_SCP_LED_GREEN); | ||
| 39 | } | ||
| 40 | |||
| 41 | static struct led_classdev corgi_amber_led = { | ||
| 42 | .name = "corgi:amber", | ||
| 43 | .default_trigger = "sharpsl-charge", | ||
| 44 | .brightness_set = corgiled_amber_set, | ||
| 45 | }; | ||
| 46 | |||
| 47 | static struct led_classdev corgi_green_led = { | ||
| 48 | .name = "corgi:green", | ||
| 49 | .default_trigger = "nand-disk", | ||
| 50 | .brightness_set = corgiled_green_set, | ||
| 51 | }; | ||
| 52 | |||
| 53 | #ifdef CONFIG_PM | ||
| 54 | static int corgiled_suspend(struct platform_device *dev, pm_message_t state) | ||
| 55 | { | ||
| 56 | #ifdef CONFIG_LEDS_TRIGGERS | ||
| 57 | if (corgi_amber_led.trigger && strcmp(corgi_amber_led.trigger->name, "sharpsl-charge")) | ||
| 58 | #endif | ||
| 59 | led_classdev_suspend(&corgi_amber_led); | ||
| 60 | led_classdev_suspend(&corgi_green_led); | ||
| 61 | return 0; | ||
| 62 | } | ||
| 63 | |||
| 64 | static int corgiled_resume(struct platform_device *dev) | ||
| 65 | { | ||
| 66 | led_classdev_resume(&corgi_amber_led); | ||
| 67 | led_classdev_resume(&corgi_green_led); | ||
| 68 | return 0; | ||
| 69 | } | ||
| 70 | #endif | ||
| 71 | |||
| 72 | static int corgiled_probe(struct platform_device *pdev) | ||
| 73 | { | ||
| 74 | int ret; | ||
| 75 | |||
| 76 | ret = led_classdev_register(&pdev->dev, &corgi_amber_led); | ||
| 77 | if (ret < 0) | ||
| 78 | return ret; | ||
| 79 | |||
| 80 | ret = led_classdev_register(&pdev->dev, &corgi_green_led); | ||
| 81 | if (ret < 0) | ||
| 82 | led_classdev_unregister(&corgi_amber_led); | ||
| 83 | |||
| 84 | return ret; | ||
| 85 | } | ||
| 86 | |||
| 87 | static int corgiled_remove(struct platform_device *pdev) | ||
| 88 | { | ||
| 89 | led_classdev_unregister(&corgi_amber_led); | ||
| 90 | led_classdev_unregister(&corgi_green_led); | ||
| 91 | return 0; | ||
| 92 | } | ||
| 93 | |||
| 94 | static struct platform_driver corgiled_driver = { | ||
| 95 | .probe = corgiled_probe, | ||
| 96 | .remove = corgiled_remove, | ||
| 97 | #ifdef CONFIG_PM | ||
| 98 | .suspend = corgiled_suspend, | ||
| 99 | .resume = corgiled_resume, | ||
| 100 | #endif | ||
| 101 | .driver = { | ||
| 102 | .name = "corgi-led", | ||
| 103 | }, | ||
| 104 | }; | ||
| 105 | |||
| 106 | static int __init corgiled_init(void) | ||
| 107 | { | ||
| 108 | return platform_driver_register(&corgiled_driver); | ||
| 109 | } | ||
| 110 | |||
| 111 | static void __exit corgiled_exit(void) | ||
| 112 | { | ||
| 113 | platform_driver_unregister(&corgiled_driver); | ||
| 114 | } | ||
| 115 | |||
| 116 | module_init(corgiled_init); | ||
| 117 | module_exit(corgiled_exit); | ||
| 118 | |||
| 119 | MODULE_AUTHOR("Richard Purdie <rpurdie@openedhand.com>"); | ||
| 120 | MODULE_DESCRIPTION("Corgi LED driver"); | ||
| 121 | MODULE_LICENSE("GPL"); | ||
diff --git a/drivers/leds/leds-ixp4xx-gpio.c b/drivers/leds/leds-ixp4xx-gpio.c new file mode 100644 index 000000000000..30ced150e4cf --- /dev/null +++ b/drivers/leds/leds-ixp4xx-gpio.c | |||
| @@ -0,0 +1,215 @@ | |||
| 1 | /* | ||
| 2 | * IXP4XX GPIO driver LED driver | ||
| 3 | * | ||
| 4 | * Author: John Bowler <jbowler@acm.org> | ||
| 5 | * | ||
| 6 | * Copyright (c) 2006 John Bowler | ||
| 7 | * | ||
| 8 | * Permission is hereby granted, free of charge, to any | ||
| 9 | * person obtaining a copy of this software and associated | ||
| 10 | * documentation files (the "Software"), to deal in the | ||
| 11 | * Software without restriction, including without | ||
| 12 | * limitation the rights to use, copy, modify, merge, | ||
| 13 | * publish, distribute, sublicense, and/or sell copies of | ||
| 14 | * the Software, and to permit persons to whom the | ||
| 15 | * Software is furnished to do so, subject to the | ||
| 16 | * following conditions: | ||
| 17 | * | ||
| 18 | * The above copyright notice and this permission notice | ||
| 19 | * shall be included in all copies or substantial portions | ||
| 20 | * of the Software. | ||
| 21 | * | ||
| 22 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF | ||
| 23 | * ANY KIND, EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED | ||
| 24 | * TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A | ||
| 25 | * PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT | ||
| 26 | * SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR | ||
| 27 | * ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN | ||
| 28 | * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, | ||
| 29 | * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR | ||
| 30 | * OTHER DEALINGS IN THE SOFTWARE. | ||
| 31 | * | ||
| 32 | */ | ||
| 33 | |||
| 34 | #include <linux/config.h> | ||
| 35 | #include <linux/kernel.h> | ||
| 36 | #include <linux/init.h> | ||
| 37 | #include <linux/platform_device.h> | ||
| 38 | #include <linux/spinlock.h> | ||
| 39 | #include <linux/leds.h> | ||
| 40 | #include <asm/arch/hardware.h> | ||
| 41 | |||
| 42 | extern spinlock_t gpio_lock; | ||
| 43 | |||
| 44 | /* Up to 16 gpio lines are possible. */ | ||
| 45 | #define GPIO_MAX 16 | ||
| 46 | static struct ixp4xxgpioled_device { | ||
| 47 | struct led_classdev ancestor; | ||
| 48 | int flags; | ||
| 49 | } ixp4xxgpioled_devices[GPIO_MAX]; | ||
| 50 | |||
| 51 | void ixp4xxgpioled_brightness_set(struct led_classdev *pled, | ||
| 52 | enum led_brightness value) | ||
| 53 | { | ||
| 54 | const struct ixp4xxgpioled_device *const ixp4xx_dev = | ||
| 55 | container_of(pled, struct ixp4xxgpioled_device, ancestor); | ||
| 56 | const u32 gpio_pin = ixp4xx_dev - ixp4xxgpioled_devices; | ||
| 57 | |||
| 58 | if (gpio_pin < GPIO_MAX && ixp4xx_dev->ancestor.name != 0) { | ||
| 59 | /* Set or clear the 'gpio_pin' bit according to the style | ||
| 60 | * and the required setting (value > 0 == on) | ||
| 61 | */ | ||
| 62 | const int gpio_value = | ||
| 63 | (value > 0) == (ixp4xx_dev->flags != IXP4XX_GPIO_LOW) ? | ||
| 64 | IXP4XX_GPIO_HIGH : IXP4XX_GPIO_LOW; | ||
| 65 | |||
| 66 | { | ||
| 67 | unsigned long flags; | ||
| 68 | spin_lock_irqsave(&gpio_lock, flags); | ||
| 69 | gpio_line_set(gpio_pin, gpio_value); | ||
| 70 | spin_unlock_irqrestore(&gpio_lock, flags); | ||
| 71 | } | ||
| 72 | } | ||
| 73 | } | ||
| 74 | |||
| 75 | /* LEDs are described in resources, the following iterates over the valid | ||
| 76 | * LED resources. | ||
| 77 | */ | ||
| 78 | #define for_all_leds(i, pdev) \ | ||
| 79 | for (i=0; i<pdev->num_resources; ++i) \ | ||
| 80 | if (pdev->resource[i].start < GPIO_MAX && \ | ||
| 81 | pdev->resource[i].name != 0) | ||
| 82 | |||
| 83 | /* The following applies 'operation' to each LED from the given platform, | ||
| 84 | * the function always returns 0 to allow tail call elimination. | ||
| 85 | */ | ||
| 86 | static int apply_to_all_leds(struct platform_device *pdev, | ||
| 87 | void (*operation)(struct led_classdev *pled)) | ||
| 88 | { | ||
| 89 | int i; | ||
| 90 | |||
| 91 | for_all_leds(i, pdev) | ||
| 92 | operation(&ixp4xxgpioled_devices[pdev->resource[i].start].ancestor); | ||
| 93 | return 0; | ||
| 94 | } | ||
| 95 | |||
| 96 | #ifdef CONFIG_PM | ||
| 97 | static int ixp4xxgpioled_suspend(struct platform_device *pdev, | ||
| 98 | pm_message_t state) | ||
| 99 | { | ||
| 100 | return apply_to_all_leds(pdev, led_classdev_suspend); | ||
| 101 | } | ||
| 102 | |||
| 103 | static int ixp4xxgpioled_resume(struct platform_device *pdev) | ||
| 104 | { | ||
| 105 | return apply_to_all_leds(pdev, led_classdev_resume); | ||
| 106 | } | ||
| 107 | #endif | ||
| 108 | |||
| 109 | static void ixp4xxgpioled_remove_one_led(struct led_classdev *pled) | ||
| 110 | { | ||
| 111 | led_classdev_unregister(pled); | ||
| 112 | pled->name = 0; | ||
| 113 | } | ||
| 114 | |||
| 115 | static int ixp4xxgpioled_remove(struct platform_device *pdev) | ||
| 116 | { | ||
| 117 | return apply_to_all_leds(pdev, ixp4xxgpioled_remove_one_led); | ||
| 118 | } | ||
| 119 | |||
| 120 | static int ixp4xxgpioled_probe(struct platform_device *pdev) | ||
| 121 | { | ||
| 122 | /* The board level has to tell the driver where the | ||
| 123 | * LEDs are connected - there is no way to find out | ||
| 124 | * electrically. It must also say whether the GPIO | ||
| 125 | * lines are active high or active low. | ||
| 126 | * | ||
| 127 | * To do this read the num_resources (the number of | ||
| 128 | * LEDs) and the struct resource (the data for each | ||
| 129 | * LED). The name comes from the resource, and it | ||
| 130 | * isn't copied. | ||
| 131 | */ | ||
| 132 | int i; | ||
| 133 | |||
| 134 | for_all_leds(i, pdev) { | ||
| 135 | const u8 gpio_pin = pdev->resource[i].start; | ||
| 136 | int rc; | ||
| 137 | |||
| 138 | if (ixp4xxgpioled_devices[gpio_pin].ancestor.name == 0) { | ||
| 139 | unsigned long flags; | ||
| 140 | |||
| 141 | spin_lock_irqsave(&gpio_lock, flags); | ||
| 142 | gpio_line_config(gpio_pin, IXP4XX_GPIO_OUT); | ||
| 143 | /* The config can, apparently, reset the state, | ||
| 144 | * I suspect the gpio line may be an input and | ||
| 145 | * the config may cause the line to be latched, | ||
| 146 | * so the setting depends on how the LED is | ||
| 147 | * connected to the line (which affects how it | ||
| 148 | * floats if not driven). | ||
| 149 | */ | ||
| 150 | gpio_line_set(gpio_pin, IXP4XX_GPIO_HIGH); | ||
| 151 | spin_unlock_irqrestore(&gpio_lock, flags); | ||
| 152 | |||
| 153 | ixp4xxgpioled_devices[gpio_pin].flags = | ||
| 154 | pdev->resource[i].flags & IORESOURCE_BITS; | ||
| 155 | |||
| 156 | ixp4xxgpioled_devices[gpio_pin].ancestor.name = | ||
| 157 | pdev->resource[i].name; | ||
| 158 | |||
| 159 | /* This is how a board manufacturer makes the LED | ||
| 160 | * come on on reset - the GPIO line will be high, so | ||
| 161 | * make the LED light when the line is low... | ||
| 162 | */ | ||
| 163 | if (ixp4xxgpioled_devices[gpio_pin].flags != IXP4XX_GPIO_LOW) | ||
| 164 | ixp4xxgpioled_devices[gpio_pin].ancestor.brightness = 100; | ||
| 165 | else | ||
| 166 | ixp4xxgpioled_devices[gpio_pin].ancestor.brightness = 0; | ||
| 167 | |||
| 168 | ixp4xxgpioled_devices[gpio_pin].ancestor.flags = 0; | ||
| 169 | |||
| 170 | ixp4xxgpioled_devices[gpio_pin].ancestor.brightness_set = | ||
| 171 | ixp4xxgpioled_brightness_set; | ||
| 172 | |||
| 173 | ixp4xxgpioled_devices[gpio_pin].ancestor.default_trigger = 0; | ||
| 174 | } | ||
| 175 | |||
| 176 | rc = led_classdev_register(&pdev->dev, | ||
| 177 | &ixp4xxgpioled_devices[gpio_pin].ancestor); | ||
| 178 | if (rc < 0) { | ||
| 179 | ixp4xxgpioled_devices[gpio_pin].ancestor.name = 0; | ||
| 180 | ixp4xxgpioled_remove(pdev); | ||
| 181 | return rc; | ||
| 182 | } | ||
| 183 | } | ||
| 184 | |||
| 185 | return 0; | ||
| 186 | } | ||
| 187 | |||
| 188 | static struct platform_driver ixp4xxgpioled_driver = { | ||
| 189 | .probe = ixp4xxgpioled_probe, | ||
| 190 | .remove = ixp4xxgpioled_remove, | ||
| 191 | #ifdef CONFIG_PM | ||
| 192 | .suspend = ixp4xxgpioled_suspend, | ||
| 193 | .resume = ixp4xxgpioled_resume, | ||
| 194 | #endif | ||
| 195 | .driver = { | ||
| 196 | .name = "IXP4XX-GPIO-LED", | ||
| 197 | }, | ||
| 198 | }; | ||
| 199 | |||
| 200 | static int __init ixp4xxgpioled_init(void) | ||
| 201 | { | ||
| 202 | return platform_driver_register(&ixp4xxgpioled_driver); | ||
| 203 | } | ||
| 204 | |||
| 205 | static void __exit ixp4xxgpioled_exit(void) | ||
| 206 | { | ||
| 207 | platform_driver_unregister(&ixp4xxgpioled_driver); | ||
| 208 | } | ||
| 209 | |||
| 210 | module_init(ixp4xxgpioled_init); | ||
| 211 | module_exit(ixp4xxgpioled_exit); | ||
| 212 | |||
| 213 | MODULE_AUTHOR("John Bowler <jbowler@acm.org>"); | ||
| 214 | MODULE_DESCRIPTION("IXP4XX GPIO LED driver"); | ||
| 215 | MODULE_LICENSE("Dual MIT/GPL"); | ||
diff --git a/drivers/leds/leds-locomo.c b/drivers/leds/leds-locomo.c new file mode 100644 index 000000000000..749a86c2adb6 --- /dev/null +++ b/drivers/leds/leds-locomo.c | |||
| @@ -0,0 +1,95 @@ | |||
| 1 | /* | ||
| 2 | * linux/drivers/leds/locomo.c | ||
| 3 | * | ||
| 4 | * Copyright (C) 2005 John Lenz <lenz@cs.wisc.edu> | ||
| 5 | * | ||
| 6 | * This program is free software; you can redistribute it and/or modify | ||
| 7 | * it under the terms of the GNU General Public License version 2 as | ||
| 8 | * published by the Free Software Foundation. | ||
| 9 | */ | ||
| 10 | |||
| 11 | #include <linux/config.h> | ||
| 12 | #include <linux/kernel.h> | ||
| 13 | #include <linux/init.h> | ||
| 14 | #include <linux/device.h> | ||
| 15 | #include <linux/leds.h> | ||
| 16 | |||
| 17 | #include <asm/hardware.h> | ||
| 18 | #include <asm/hardware/locomo.h> | ||
| 19 | |||
| 20 | static void locomoled_brightness_set(struct led_classdev *led_cdev, | ||
| 21 | enum led_brightness value, int offset) | ||
| 22 | { | ||
| 23 | struct locomo_dev *locomo_dev = LOCOMO_DEV(led_cdev->class_dev->dev); | ||
| 24 | unsigned long flags; | ||
| 25 | |||
| 26 | local_irq_save(flags); | ||
| 27 | if (value) | ||
| 28 | locomo_writel(LOCOMO_LPT_TOFH, locomo_dev->mapbase + offset); | ||
| 29 | else | ||
| 30 | locomo_writel(LOCOMO_LPT_TOFL, locomo_dev->mapbase + offset); | ||
| 31 | local_irq_restore(flags); | ||
| 32 | } | ||
| 33 | |||
| 34 | static void locomoled_brightness_set0(struct led_classdev *led_cdev, | ||
| 35 | enum led_brightness value) | ||
| 36 | { | ||
| 37 | locomoled_brightness_set(led_cdev, value, LOCOMO_LPT0); | ||
| 38 | } | ||
| 39 | |||
| 40 | static void locomoled_brightness_set1(struct led_classdev *led_cdev, | ||
| 41 | enum led_brightness value) | ||
| 42 | { | ||
| 43 | locomoled_brightness_set(led_cdev, value, LOCOMO_LPT1); | ||
| 44 | } | ||
| 45 | |||
| 46 | static struct led_classdev locomo_led0 = { | ||
| 47 | .name = "locomo:amber", | ||
| 48 | .brightness_set = locomoled_brightness_set0, | ||
| 49 | }; | ||
| 50 | |||
| 51 | static struct led_classdev locomo_led1 = { | ||
| 52 | .name = "locomo:green", | ||
| 53 | .brightness_set = locomoled_brightness_set1, | ||
| 54 | }; | ||
| 55 | |||
| 56 | static int locomoled_probe(struct locomo_dev *ldev) | ||
| 57 | { | ||
| 58 | int ret; | ||
| 59 | |||
| 60 | ret = led_classdev_register(&ldev->dev, &locomo_led0); | ||
| 61 | if (ret < 0) | ||
| 62 | return ret; | ||
| 63 | |||
| 64 | ret = led_classdev_register(&ldev->dev, &locomo_led1); | ||
| 65 | if (ret < 0) | ||
| 66 | led_classdev_unregister(&locomo_led0); | ||
| 67 | |||
| 68 | return ret; | ||
| 69 | } | ||
| 70 | |||
| 71 | static int locomoled_remove(struct locomo_dev *dev) | ||
| 72 | { | ||
| 73 | led_classdev_unregister(&locomo_led0); | ||
| 74 | led_classdev_unregister(&locomo_led1); | ||
| 75 | return 0; | ||
| 76 | } | ||
| 77 | |||
| 78 | static struct locomo_driver locomoled_driver = { | ||
| 79 | .drv = { | ||
| 80 | .name = "locomoled" | ||
| 81 | }, | ||
| 82 | .devid = LOCOMO_DEVID_LED, | ||
| 83 | .probe = locomoled_probe, | ||
| 84 | .remove = locomoled_remove, | ||
| 85 | }; | ||
| 86 | |||
| 87 | static int __init locomoled_init(void) | ||
| 88 | { | ||
| 89 | return locomo_driver_register(&locomoled_driver); | ||
| 90 | } | ||
| 91 | module_init(locomoled_init); | ||
| 92 | |||
| 93 | MODULE_AUTHOR("John Lenz <lenz@cs.wisc.edu>"); | ||
| 94 | MODULE_DESCRIPTION("Locomo LED driver"); | ||
| 95 | MODULE_LICENSE("GPL"); | ||
diff --git a/drivers/leds/leds-spitz.c b/drivers/leds/leds-spitz.c new file mode 100644 index 000000000000..65bbef4a5e09 --- /dev/null +++ b/drivers/leds/leds-spitz.c | |||
| @@ -0,0 +1,125 @@ | |||
| 1 | /* | ||
| 2 | * LED Triggers Core | ||
| 3 | * | ||
| 4 | * Copyright 2005-2006 Openedhand Ltd. | ||
| 5 | * | ||
| 6 | * Author: Richard Purdie <rpurdie@openedhand.com> | ||
| 7 | * | ||
| 8 | * This program is free software; you can redistribute it and/or modify | ||
| 9 | * it under the terms of the GNU General Public License version 2 as | ||
| 10 | * published by the Free Software Foundation. | ||
| 11 | * | ||
| 12 | */ | ||
| 13 | |||
| 14 | #include <linux/config.h> | ||
| 15 | #include <linux/kernel.h> | ||
| 16 | #include <linux/init.h> | ||
| 17 | #include <linux/platform_device.h> | ||
| 18 | #include <linux/leds.h> | ||
| 19 | #include <asm/hardware/scoop.h> | ||
| 20 | #include <asm/mach-types.h> | ||
| 21 | #include <asm/arch/hardware.h> | ||
| 22 | #include <asm/arch/pxa-regs.h> | ||
| 23 | #include <asm/arch/spitz.h> | ||
| 24 | |||
| 25 | static void spitzled_amber_set(struct led_classdev *led_cdev, enum led_brightness value) | ||
| 26 | { | ||
| 27 | if (value) | ||
| 28 | set_scoop_gpio(&spitzscoop_device.dev, SPITZ_SCP_LED_ORANGE); | ||
| 29 | else | ||
| 30 | reset_scoop_gpio(&spitzscoop_device.dev, SPITZ_SCP_LED_ORANGE); | ||
| 31 | } | ||
| 32 | |||
| 33 | static void spitzled_green_set(struct led_classdev *led_cdev, enum led_brightness value) | ||
| 34 | { | ||
| 35 | if (value) | ||
| 36 | set_scoop_gpio(&spitzscoop_device.dev, SPITZ_SCP_LED_GREEN); | ||
| 37 | else | ||
| 38 | reset_scoop_gpio(&spitzscoop_device.dev, SPITZ_SCP_LED_GREEN); | ||
| 39 | } | ||
| 40 | |||
| 41 | static struct led_classdev spitz_amber_led = { | ||
| 42 | .name = "spitz:amber", | ||
| 43 | .default_trigger = "sharpsl-charge", | ||
| 44 | .brightness_set = spitzled_amber_set, | ||
| 45 | }; | ||
| 46 | |||
| 47 | static struct led_classdev spitz_green_led = { | ||
| 48 | .name = "spitz:green", | ||
| 49 | .default_trigger = "ide-disk", | ||
| 50 | .brightness_set = spitzled_green_set, | ||
| 51 | }; | ||
| 52 | |||
| 53 | #ifdef CONFIG_PM | ||
| 54 | static int spitzled_suspend(struct platform_device *dev, pm_message_t state) | ||
| 55 | { | ||
| 56 | #ifdef CONFIG_LEDS_TRIGGERS | ||
| 57 | if (spitz_amber_led.trigger && strcmp(spitz_amber_led.trigger->name, "sharpsl-charge")) | ||
| 58 | #endif | ||
| 59 | led_classdev_suspend(&spitz_amber_led); | ||
| 60 | led_classdev_suspend(&spitz_green_led); | ||
| 61 | return 0; | ||
| 62 | } | ||
| 63 | |||
| 64 | static int spitzled_resume(struct platform_device *dev) | ||
| 65 | { | ||
| 66 | led_classdev_resume(&spitz_amber_led); | ||
| 67 | led_classdev_resume(&spitz_green_led); | ||
| 68 | return 0; | ||
| 69 | } | ||
| 70 | #endif | ||
| 71 | |||
| 72 | static int spitzled_probe(struct platform_device *pdev) | ||
| 73 | { | ||
| 74 | int ret; | ||
| 75 | |||
| 76 | if (machine_is_akita()) | ||
| 77 | spitz_green_led.default_trigger = "nand-disk"; | ||
| 78 | |||
| 79 | ret = led_classdev_register(&pdev->dev, &spitz_amber_led); | ||
| 80 | if (ret < 0) | ||
| 81 | return ret; | ||
| 82 | |||
| 83 | ret = led_classdev_register(&pdev->dev, &spitz_green_led); | ||
| 84 | if (ret < 0) | ||
| 85 | led_classdev_unregister(&spitz_amber_led); | ||
| 86 | |||
| 87 | return ret; | ||
| 88 | } | ||
| 89 | |||
| 90 | static int spitzled_remove(struct platform_device *pdev) | ||
| 91 | { | ||
| 92 | led_classdev_unregister(&spitz_amber_led); | ||
| 93 | led_classdev_unregister(&spitz_green_led); | ||
| 94 | |||
| 95 | return 0; | ||
| 96 | } | ||
| 97 | |||
| 98 | static struct platform_driver spitzled_driver = { | ||
| 99 | .probe = spitzled_probe, | ||
| 100 | .remove = spitzled_remove, | ||
| 101 | #ifdef CONFIG_PM | ||
| 102 | .suspend = spitzled_suspend, | ||
| 103 | .resume = spitzled_resume, | ||
| 104 | #endif | ||
| 105 | .driver = { | ||
| 106 | .name = "spitz-led", | ||
| 107 | }, | ||
| 108 | }; | ||
| 109 | |||
| 110 | static int __init spitzled_init(void) | ||
| 111 | { | ||
| 112 | return platform_driver_register(&spitzled_driver); | ||
| 113 | } | ||
| 114 | |||
| 115 | static void __exit spitzled_exit(void) | ||
| 116 | { | ||
| 117 | platform_driver_unregister(&spitzled_driver); | ||
| 118 | } | ||
| 119 | |||
| 120 | module_init(spitzled_init); | ||
| 121 | module_exit(spitzled_exit); | ||
| 122 | |||
| 123 | MODULE_AUTHOR("Richard Purdie <rpurdie@openedhand.com>"); | ||
| 124 | MODULE_DESCRIPTION("Spitz LED driver"); | ||
| 125 | MODULE_LICENSE("GPL"); | ||
diff --git a/drivers/leds/leds-tosa.c b/drivers/leds/leds-tosa.c new file mode 100644 index 000000000000..c9e8cc1ec481 --- /dev/null +++ b/drivers/leds/leds-tosa.c | |||
| @@ -0,0 +1,131 @@ | |||
| 1 | /* | ||
| 2 | * LED Triggers Core | ||
| 3 | * | ||
| 4 | * Copyright 2005 Dirk Opfer | ||
| 5 | * | ||
| 6 | * Author: Dirk Opfer <Dirk@Opfer-Online.de> | ||
| 7 | * based on spitz.c | ||
| 8 | * | ||
| 9 | * This program is free software; you can redistribute it and/or modify | ||
| 10 | * it under the terms of the GNU General Public License version 2 as | ||
| 11 | * published by the Free Software Foundation. | ||
| 12 | * | ||
| 13 | */ | ||
| 14 | |||
| 15 | #include <linux/config.h> | ||
| 16 | #include <linux/kernel.h> | ||
| 17 | #include <linux/init.h> | ||
| 18 | #include <linux/platform_device.h> | ||
| 19 | #include <linux/leds.h> | ||
| 20 | #include <asm/hardware/scoop.h> | ||
| 21 | #include <asm/mach-types.h> | ||
| 22 | #include <asm/arch/hardware.h> | ||
| 23 | #include <asm/arch/pxa-regs.h> | ||
| 24 | #include <asm/arch/tosa.h> | ||
| 25 | |||
| 26 | static void tosaled_amber_set(struct led_classdev *led_cdev, | ||
| 27 | enum led_brightness value) | ||
| 28 | { | ||
| 29 | if (value) | ||
| 30 | set_scoop_gpio(&tosascoop_jc_device.dev, | ||
| 31 | TOSA_SCOOP_JC_CHRG_ERR_LED); | ||
| 32 | else | ||
| 33 | reset_scoop_gpio(&tosascoop_jc_device.dev, | ||
| 34 | TOSA_SCOOP_JC_CHRG_ERR_LED); | ||
| 35 | } | ||
| 36 | |||
| 37 | static void tosaled_green_set(struct led_classdev *led_cdev, | ||
| 38 | enum led_brightness value) | ||
| 39 | { | ||
| 40 | if (value) | ||
| 41 | set_scoop_gpio(&tosascoop_jc_device.dev, | ||
| 42 | TOSA_SCOOP_JC_NOTE_LED); | ||
| 43 | else | ||
| 44 | reset_scoop_gpio(&tosascoop_jc_device.dev, | ||
| 45 | TOSA_SCOOP_JC_NOTE_LED); | ||
| 46 | } | ||
| 47 | |||
| 48 | static struct led_classdev tosa_amber_led = { | ||
| 49 | .name = "tosa:amber", | ||
| 50 | .default_trigger = "sharpsl-charge", | ||
| 51 | .brightness_set = tosaled_amber_set, | ||
| 52 | }; | ||
| 53 | |||
| 54 | static struct led_classdev tosa_green_led = { | ||
| 55 | .name = "tosa:green", | ||
| 56 | .default_trigger = "nand-disk", | ||
| 57 | .brightness_set = tosaled_green_set, | ||
| 58 | }; | ||
| 59 | |||
| 60 | #ifdef CONFIG_PM | ||
| 61 | static int tosaled_suspend(struct platform_device *dev, pm_message_t state) | ||
| 62 | { | ||
| 63 | #ifdef CONFIG_LEDS_TRIGGERS | ||
| 64 | if (tosa_amber_led.trigger && strcmp(tosa_amber_led.trigger->name, | ||
| 65 | "sharpsl-charge")) | ||
| 66 | #endif | ||
| 67 | led_classdev_suspend(&tosa_amber_led); | ||
| 68 | led_classdev_suspend(&tosa_green_led); | ||
| 69 | return 0; | ||
| 70 | } | ||
| 71 | |||
| 72 | static int tosaled_resume(struct platform_device *dev) | ||
| 73 | { | ||
| 74 | led_classdev_resume(&tosa_amber_led); | ||
| 75 | led_classdev_resume(&tosa_green_led); | ||
| 76 | return 0; | ||
| 77 | } | ||
| 78 | #else | ||
| 79 | #define tosaled_suspend NULL | ||
| 80 | #define tosaled_resume NULL | ||
| 81 | #endif | ||
| 82 | |||
| 83 | static int tosaled_probe(struct platform_device *pdev) | ||
| 84 | { | ||
| 85 | int ret; | ||
| 86 | |||
| 87 | ret = led_classdev_register(&pdev->dev, &tosa_amber_led); | ||
| 88 | if (ret < 0) | ||
| 89 | return ret; | ||
| 90 | |||
| 91 | ret = led_classdev_register(&pdev->dev, &tosa_green_led); | ||
| 92 | if (ret < 0) | ||
| 93 | led_classdev_unregister(&tosa_amber_led); | ||
| 94 | |||
| 95 | return ret; | ||
| 96 | } | ||
| 97 | |||
| 98 | static int tosaled_remove(struct platform_device *pdev) | ||
| 99 | { | ||
| 100 | led_classdev_unregister(&tosa_amber_led); | ||
| 101 | led_classdev_unregister(&tosa_green_led); | ||
| 102 | |||
| 103 | return 0; | ||
| 104 | } | ||
| 105 | |||
| 106 | static struct platform_driver tosaled_driver = { | ||
| 107 | .probe = tosaled_probe, | ||
| 108 | .remove = tosaled_remove, | ||
| 109 | .suspend = tosaled_suspend, | ||
| 110 | .resume = tosaled_resume, | ||
| 111 | .driver = { | ||
| 112 | .name = "tosa-led", | ||
| 113 | }, | ||
| 114 | }; | ||
| 115 | |||
| 116 | static int __init tosaled_init(void) | ||
| 117 | { | ||
| 118 | return platform_driver_register(&tosaled_driver); | ||
| 119 | } | ||
| 120 | |||
| 121 | static void __exit tosaled_exit(void) | ||
| 122 | { | ||
| 123 | platform_driver_unregister(&tosaled_driver); | ||
| 124 | } | ||
| 125 | |||
| 126 | module_init(tosaled_init); | ||
| 127 | module_exit(tosaled_exit); | ||
| 128 | |||
| 129 | MODULE_AUTHOR("Dirk Opfer <Dirk@Opfer-Online.de>"); | ||
| 130 | MODULE_DESCRIPTION("Tosa LED driver"); | ||
| 131 | MODULE_LICENSE("GPL"); | ||
diff --git a/drivers/leds/leds.h b/drivers/leds/leds.h new file mode 100644 index 000000000000..a715c4ed93ff --- /dev/null +++ b/drivers/leds/leds.h | |||
| @@ -0,0 +1,44 @@ | |||
| 1 | /* | ||
| 2 | * LED Core | ||
| 3 | * | ||
| 4 | * Copyright 2005 Openedhand Ltd. | ||
| 5 | * | ||
| 6 | * Author: Richard Purdie <rpurdie@openedhand.com> | ||
| 7 | * | ||
| 8 | * This program is free software; you can redistribute it and/or modify | ||
| 9 | * it under the terms of the GNU General Public License version 2 as | ||
| 10 | * published by the Free Software Foundation. | ||
| 11 | * | ||
| 12 | */ | ||
| 13 | #ifndef __LEDS_H_INCLUDED | ||
| 14 | #define __LEDS_H_INCLUDED | ||
| 15 | |||
| 16 | #include <linux/leds.h> | ||
| 17 | |||
| 18 | static inline void led_set_brightness(struct led_classdev *led_cdev, | ||
| 19 | enum led_brightness value) | ||
| 20 | { | ||
| 21 | if (value > LED_FULL) | ||
| 22 | value = LED_FULL; | ||
| 23 | led_cdev->brightness = value; | ||
| 24 | if (!(led_cdev->flags & LED_SUSPENDED)) | ||
| 25 | led_cdev->brightness_set(led_cdev, value); | ||
| 26 | } | ||
| 27 | |||
| 28 | extern rwlock_t leds_list_lock; | ||
| 29 | extern struct list_head leds_list; | ||
| 30 | |||
| 31 | #ifdef CONFIG_LEDS_TRIGGERS | ||
| 32 | void led_trigger_set_default(struct led_classdev *led_cdev); | ||
| 33 | void led_trigger_set(struct led_classdev *led_cdev, | ||
| 34 | struct led_trigger *trigger); | ||
| 35 | #else | ||
| 36 | #define led_trigger_set_default(x) do {} while(0) | ||
| 37 | #define led_trigger_set(x, y) do {} while(0) | ||
| 38 | #endif | ||
| 39 | |||
| 40 | ssize_t led_trigger_store(struct class_device *dev, const char *buf, | ||
| 41 | size_t count); | ||
| 42 | ssize_t led_trigger_show(struct class_device *dev, char *buf); | ||
| 43 | |||
| 44 | #endif /* __LEDS_H_INCLUDED */ | ||
diff --git a/drivers/leds/ledtrig-ide-disk.c b/drivers/leds/ledtrig-ide-disk.c new file mode 100644 index 000000000000..fa651886ab4f --- /dev/null +++ b/drivers/leds/ledtrig-ide-disk.c | |||
| @@ -0,0 +1,62 @@ | |||
| 1 | /* | ||
| 2 | * LED IDE-Disk Activity Trigger | ||
| 3 | * | ||
| 4 | * Copyright 2006 Openedhand Ltd. | ||
| 5 | * | ||
| 6 | * Author: Richard Purdie <rpurdie@openedhand.com> | ||
| 7 | * | ||
| 8 | * This program is free software; you can redistribute it and/or modify | ||
| 9 | * it under the terms of the GNU General Public License version 2 as | ||
| 10 | * published by the Free Software Foundation. | ||
| 11 | * | ||
| 12 | */ | ||
| 13 | |||
| 14 | #include <linux/module.h> | ||
| 15 | #include <linux/kernel.h> | ||
| 16 | #include <linux/init.h> | ||
| 17 | #include <linux/timer.h> | ||
| 18 | #include <linux/leds.h> | ||
| 19 | |||
| 20 | static void ledtrig_ide_timerfunc(unsigned long data); | ||
| 21 | |||
| 22 | DEFINE_LED_TRIGGER(ledtrig_ide); | ||
| 23 | static DEFINE_TIMER(ledtrig_ide_timer, ledtrig_ide_timerfunc, 0, 0); | ||
| 24 | static int ide_activity; | ||
| 25 | static int ide_lastactivity; | ||
| 26 | |||
| 27 | void ledtrig_ide_activity(void) | ||
| 28 | { | ||
| 29 | ide_activity++; | ||
| 30 | if (!timer_pending(&ledtrig_ide_timer)) | ||
| 31 | mod_timer(&ledtrig_ide_timer, jiffies + msecs_to_jiffies(10)); | ||
| 32 | } | ||
| 33 | EXPORT_SYMBOL(ledtrig_ide_activity); | ||
| 34 | |||
| 35 | static void ledtrig_ide_timerfunc(unsigned long data) | ||
| 36 | { | ||
| 37 | if (ide_lastactivity != ide_activity) { | ||
| 38 | ide_lastactivity = ide_activity; | ||
| 39 | led_trigger_event(ledtrig_ide, LED_FULL); | ||
| 40 | mod_timer(&ledtrig_ide_timer, jiffies + msecs_to_jiffies(10)); | ||
| 41 | } else { | ||
| 42 | led_trigger_event(ledtrig_ide, LED_OFF); | ||
| 43 | } | ||
| 44 | } | ||
| 45 | |||
| 46 | static int __init ledtrig_ide_init(void) | ||
| 47 | { | ||
| 48 | led_trigger_register_simple("ide-disk", &ledtrig_ide); | ||
| 49 | return 0; | ||
| 50 | } | ||
| 51 | |||
| 52 | static void __exit ledtrig_ide_exit(void) | ||
| 53 | { | ||
| 54 | led_trigger_unregister_simple(ledtrig_ide); | ||
| 55 | } | ||
| 56 | |||
| 57 | module_init(ledtrig_ide_init); | ||
| 58 | module_exit(ledtrig_ide_exit); | ||
| 59 | |||
| 60 | MODULE_AUTHOR("Richard Purdie <rpurdie@openedhand.com>"); | ||
| 61 | MODULE_DESCRIPTION("LED IDE Disk Activity Trigger"); | ||
| 62 | MODULE_LICENSE("GPL"); | ||
diff --git a/drivers/leds/ledtrig-timer.c b/drivers/leds/ledtrig-timer.c new file mode 100644 index 000000000000..f484b5d6dbf8 --- /dev/null +++ b/drivers/leds/ledtrig-timer.c | |||
| @@ -0,0 +1,170 @@ | |||
| 1 | /* | ||
| 2 | * LED Kernel Timer Trigger | ||
| 3 | * | ||
| 4 | * Copyright 2005-2006 Openedhand Ltd. | ||
| 5 | * | ||
| 6 | * Author: Richard Purdie <rpurdie@openedhand.com> | ||
| 7 | * | ||
| 8 | * This program is free software; you can redistribute it and/or modify | ||
| 9 | * it under the terms of the GNU General Public License version 2 as | ||
| 10 | * published by the Free Software Foundation. | ||
| 11 | * | ||
| 12 | */ | ||
| 13 | |||
| 14 | #include <linux/config.h> | ||
| 15 | #include <linux/module.h> | ||
| 16 | #include <linux/kernel.h> | ||
| 17 | #include <linux/init.h> | ||
| 18 | #include <linux/list.h> | ||
| 19 | #include <linux/spinlock.h> | ||
| 20 | #include <linux/device.h> | ||
| 21 | #include <linux/sysdev.h> | ||
| 22 | #include <linux/timer.h> | ||
| 23 | #include <linux/leds.h> | ||
| 24 | #include "leds.h" | ||
| 25 | |||
| 26 | struct timer_trig_data { | ||
| 27 | unsigned long delay_on; /* milliseconds on */ | ||
| 28 | unsigned long delay_off; /* milliseconds off */ | ||
| 29 | struct timer_list timer; | ||
| 30 | }; | ||
| 31 | |||
| 32 | static void led_timer_function(unsigned long data) | ||
| 33 | { | ||
| 34 | struct led_classdev *led_cdev = (struct led_classdev *) data; | ||
| 35 | struct timer_trig_data *timer_data = led_cdev->trigger_data; | ||
| 36 | unsigned long brightness = LED_OFF; | ||
| 37 | unsigned long delay = timer_data->delay_off; | ||
| 38 | |||
| 39 | if (!timer_data->delay_on || !timer_data->delay_off) { | ||
| 40 | led_set_brightness(led_cdev, LED_OFF); | ||
| 41 | return; | ||
| 42 | } | ||
| 43 | |||
| 44 | if (!led_cdev->brightness) { | ||
| 45 | brightness = LED_FULL; | ||
| 46 | delay = timer_data->delay_on; | ||
| 47 | } | ||
| 48 | |||
| 49 | led_set_brightness(led_cdev, brightness); | ||
| 50 | |||
| 51 | mod_timer(&timer_data->timer, jiffies + msecs_to_jiffies(delay)); | ||
| 52 | } | ||
| 53 | |||
| 54 | static ssize_t led_delay_on_show(struct class_device *dev, char *buf) | ||
| 55 | { | ||
| 56 | struct led_classdev *led_cdev = class_get_devdata(dev); | ||
| 57 | struct timer_trig_data *timer_data = led_cdev->trigger_data; | ||
| 58 | |||
| 59 | sprintf(buf, "%lu\n", timer_data->delay_on); | ||
| 60 | |||
| 61 | return strlen(buf) + 1; | ||
| 62 | } | ||
| 63 | |||
| 64 | static ssize_t led_delay_on_store(struct class_device *dev, const char *buf, | ||
| 65 | size_t size) | ||
| 66 | { | ||
| 67 | struct led_classdev *led_cdev = class_get_devdata(dev); | ||
| 68 | struct timer_trig_data *timer_data = led_cdev->trigger_data; | ||
| 69 | int ret = -EINVAL; | ||
| 70 | char *after; | ||
| 71 | unsigned long state = simple_strtoul(buf, &after, 10); | ||
| 72 | |||
| 73 | if (after - buf > 0) { | ||
| 74 | timer_data->delay_on = state; | ||
| 75 | mod_timer(&timer_data->timer, jiffies + 1); | ||
| 76 | ret = after - buf; | ||
| 77 | } | ||
| 78 | |||
| 79 | return ret; | ||
| 80 | } | ||
| 81 | |||
| 82 | static ssize_t led_delay_off_show(struct class_device *dev, char *buf) | ||
| 83 | { | ||
| 84 | struct led_classdev *led_cdev = class_get_devdata(dev); | ||
| 85 | struct timer_trig_data *timer_data = led_cdev->trigger_data; | ||
| 86 | |||
| 87 | sprintf(buf, "%lu\n", timer_data->delay_off); | ||
| 88 | |||
| 89 | return strlen(buf) + 1; | ||
| 90 | } | ||
| 91 | |||
| 92 | static ssize_t led_delay_off_store(struct class_device *dev, const char *buf, | ||
| 93 | size_t size) | ||
| 94 | { | ||
| 95 | struct led_classdev *led_cdev = class_get_devdata(dev); | ||
| 96 | struct timer_trig_data *timer_data = led_cdev->trigger_data; | ||
| 97 | int ret = -EINVAL; | ||
| 98 | char *after; | ||
| 99 | unsigned long state = simple_strtoul(buf, &after, 10); | ||
| 100 | |||
| 101 | if (after - buf > 0) { | ||
| 102 | timer_data->delay_off = state; | ||
| 103 | mod_timer(&timer_data->timer, jiffies + 1); | ||
| 104 | ret = after - buf; | ||
| 105 | } | ||
| 106 | |||
| 107 | return ret; | ||
| 108 | } | ||
| 109 | |||
| 110 | static CLASS_DEVICE_ATTR(delay_on, 0644, led_delay_on_show, | ||
| 111 | led_delay_on_store); | ||
| 112 | static CLASS_DEVICE_ATTR(delay_off, 0644, led_delay_off_show, | ||
| 113 | led_delay_off_store); | ||
| 114 | |||
| 115 | static void timer_trig_activate(struct led_classdev *led_cdev) | ||
| 116 | { | ||
| 117 | struct timer_trig_data *timer_data; | ||
| 118 | |||
| 119 | timer_data = kzalloc(sizeof(struct timer_trig_data), GFP_KERNEL); | ||
| 120 | if (!timer_data) | ||
| 121 | return; | ||
| 122 | |||
| 123 | led_cdev->trigger_data = timer_data; | ||
| 124 | |||
| 125 | init_timer(&timer_data->timer); | ||
| 126 | timer_data->timer.function = led_timer_function; | ||
| 127 | timer_data->timer.data = (unsigned long) led_cdev; | ||
| 128 | |||
| 129 | class_device_create_file(led_cdev->class_dev, | ||
| 130 | &class_device_attr_delay_on); | ||
| 131 | class_device_create_file(led_cdev->class_dev, | ||
| 132 | &class_device_attr_delay_off); | ||
| 133 | } | ||
| 134 | |||
| 135 | static void timer_trig_deactivate(struct led_classdev *led_cdev) | ||
| 136 | { | ||
| 137 | struct timer_trig_data *timer_data = led_cdev->trigger_data; | ||
| 138 | |||
| 139 | if (timer_data) { | ||
| 140 | class_device_remove_file(led_cdev->class_dev, | ||
| 141 | &class_device_attr_delay_on); | ||
| 142 | class_device_remove_file(led_cdev->class_dev, | ||
| 143 | &class_device_attr_delay_off); | ||
| 144 | del_timer_sync(&timer_data->timer); | ||
| 145 | kfree(timer_data); | ||
| 146 | } | ||
| 147 | } | ||
| 148 | |||
| 149 | static struct led_trigger timer_led_trigger = { | ||
| 150 | .name = "timer", | ||
| 151 | .activate = timer_trig_activate, | ||
| 152 | .deactivate = timer_trig_deactivate, | ||
| 153 | }; | ||
| 154 | |||
| 155 | static int __init timer_trig_init(void) | ||
| 156 | { | ||
| 157 | return led_trigger_register(&timer_led_trigger); | ||
| 158 | } | ||
| 159 | |||
| 160 | static void __exit timer_trig_exit(void) | ||
| 161 | { | ||
| 162 | led_trigger_unregister(&timer_led_trigger); | ||
| 163 | } | ||
| 164 | |||
| 165 | module_init(timer_trig_init); | ||
| 166 | module_exit(timer_trig_exit); | ||
| 167 | |||
| 168 | MODULE_AUTHOR("Richard Purdie <rpurdie@openedhand.com>"); | ||
| 169 | MODULE_DESCRIPTION("Timer LED trigger"); | ||
| 170 | MODULE_LICENSE("GPL"); | ||
diff --git a/drivers/md/md.c b/drivers/md/md.c index 039e071c1007..1ed5152db450 100644 --- a/drivers/md/md.c +++ b/drivers/md/md.c | |||
| @@ -215,13 +215,11 @@ static void mddev_put(mddev_t *mddev) | |||
| 215 | return; | 215 | return; |
| 216 | if (!mddev->raid_disks && list_empty(&mddev->disks)) { | 216 | if (!mddev->raid_disks && list_empty(&mddev->disks)) { |
| 217 | list_del(&mddev->all_mddevs); | 217 | list_del(&mddev->all_mddevs); |
| 218 | /* that blocks */ | 218 | spin_unlock(&all_mddevs_lock); |
| 219 | blk_cleanup_queue(mddev->queue); | 219 | blk_cleanup_queue(mddev->queue); |
| 220 | /* that also blocks */ | ||
| 221 | kobject_unregister(&mddev->kobj); | 220 | kobject_unregister(&mddev->kobj); |
| 222 | /* result blows... */ | 221 | } else |
| 223 | } | 222 | spin_unlock(&all_mddevs_lock); |
| 224 | spin_unlock(&all_mddevs_lock); | ||
| 225 | } | 223 | } |
| 226 | 224 | ||
| 227 | static mddev_t * mddev_find(dev_t unit) | 225 | static mddev_t * mddev_find(dev_t unit) |
diff --git a/drivers/md/raid1.c b/drivers/md/raid1.c index 3cb0872a845d..9b374c91db66 100644 --- a/drivers/md/raid1.c +++ b/drivers/md/raid1.c | |||
| @@ -1135,8 +1135,19 @@ static int end_sync_write(struct bio *bio, unsigned int bytes_done, int error) | |||
| 1135 | mirror = i; | 1135 | mirror = i; |
| 1136 | break; | 1136 | break; |
| 1137 | } | 1137 | } |
| 1138 | if (!uptodate) | 1138 | if (!uptodate) { |
| 1139 | int sync_blocks = 0; | ||
| 1140 | sector_t s = r1_bio->sector; | ||
| 1141 | long sectors_to_go = r1_bio->sectors; | ||
| 1142 | /* make sure these bits doesn't get cleared. */ | ||
| 1143 | do { | ||
| 1144 | bitmap_end_sync(mddev->bitmap, r1_bio->sector, | ||
| 1145 | &sync_blocks, 1); | ||
| 1146 | s += sync_blocks; | ||
| 1147 | sectors_to_go -= sync_blocks; | ||
| 1148 | } while (sectors_to_go > 0); | ||
| 1139 | md_error(mddev, conf->mirrors[mirror].rdev); | 1149 | md_error(mddev, conf->mirrors[mirror].rdev); |
| 1150 | } | ||
| 1140 | 1151 | ||
| 1141 | update_head_pos(mirror, r1_bio); | 1152 | update_head_pos(mirror, r1_bio); |
| 1142 | 1153 | ||
diff --git a/drivers/md/raid6main.c b/drivers/md/raid6main.c index 6df4930fddec..ab64b37e4996 100644 --- a/drivers/md/raid6main.c +++ b/drivers/md/raid6main.c | |||
| @@ -2151,6 +2151,8 @@ static int run(mddev_t *mddev) | |||
| 2151 | } | 2151 | } |
| 2152 | 2152 | ||
| 2153 | /* Ok, everything is just fine now */ | 2153 | /* Ok, everything is just fine now */ |
| 2154 | sysfs_create_group(&mddev->kobj, &raid6_attrs_group); | ||
| 2155 | |||
| 2154 | mddev->array_size = mddev->size * (mddev->raid_disks - 2); | 2156 | mddev->array_size = mddev->size * (mddev->raid_disks - 2); |
| 2155 | 2157 | ||
| 2156 | mddev->queue->unplug_fn = raid6_unplug_device; | 2158 | mddev->queue->unplug_fn = raid6_unplug_device; |
diff --git a/drivers/media/video/cpia_pp.c b/drivers/media/video/cpia_pp.c index 3021f21aae36..0b00e6027dfb 100644 --- a/drivers/media/video/cpia_pp.c +++ b/drivers/media/video/cpia_pp.c | |||
| @@ -873,7 +873,7 @@ static int __init cpia_pp_setup(char *str) | |||
| 873 | parport_nr[parport_ptr++] = PPCPIA_PARPORT_NONE; | 873 | parport_nr[parport_ptr++] = PPCPIA_PARPORT_NONE; |
| 874 | } | 874 | } |
| 875 | 875 | ||
| 876 | return 0; | 876 | return 1; |
| 877 | } | 877 | } |
| 878 | 878 | ||
| 879 | __setup("cpia_pp=", cpia_pp_setup); | 879 | __setup("cpia_pp=", cpia_pp_setup); |
diff --git a/drivers/mtd/chips/amd_flash.c b/drivers/mtd/chips/amd_flash.c index fdb91b6f1d97..57115618c496 100644 --- a/drivers/mtd/chips/amd_flash.c +++ b/drivers/mtd/chips/amd_flash.c | |||
| @@ -664,7 +664,7 @@ static struct mtd_info *amd_flash_probe(struct map_info *map) | |||
| 664 | printk("%s: Probing for AMD compatible flash...\n", map->name); | 664 | printk("%s: Probing for AMD compatible flash...\n", map->name); |
| 665 | 665 | ||
| 666 | if ((table_pos[0] = probe_new_chip(mtd, 0, NULL, &temp, table, | 666 | if ((table_pos[0] = probe_new_chip(mtd, 0, NULL, &temp, table, |
| 667 | sizeof(table)/sizeof(table[0]))) | 667 | ARRAY_SIZE(table))) |
| 668 | == -1) { | 668 | == -1) { |
| 669 | printk(KERN_WARNING | 669 | printk(KERN_WARNING |
| 670 | "%s: Found no AMD compatible device at location zero\n", | 670 | "%s: Found no AMD compatible device at location zero\n", |
| @@ -696,7 +696,7 @@ static struct mtd_info *amd_flash_probe(struct map_info *map) | |||
| 696 | base += (1 << temp.chipshift)) { | 696 | base += (1 << temp.chipshift)) { |
| 697 | int numchips = temp.numchips; | 697 | int numchips = temp.numchips; |
| 698 | table_pos[numchips] = probe_new_chip(mtd, base, chips, | 698 | table_pos[numchips] = probe_new_chip(mtd, base, chips, |
| 699 | &temp, table, sizeof(table)/sizeof(table[0])); | 699 | &temp, table, ARRAY_SIZE(table)); |
| 700 | } | 700 | } |
| 701 | 701 | ||
| 702 | mtd->eraseregions = kmalloc(sizeof(struct mtd_erase_region_info) * | 702 | mtd->eraseregions = kmalloc(sizeof(struct mtd_erase_region_info) * |
diff --git a/drivers/mtd/chips/jedec_probe.c b/drivers/mtd/chips/jedec_probe.c index edb306c03c0a..517ea33e7260 100644 --- a/drivers/mtd/chips/jedec_probe.c +++ b/drivers/mtd/chips/jedec_probe.c | |||
| @@ -34,6 +34,7 @@ | |||
| 34 | #define MANUFACTURER_MACRONIX 0x00C2 | 34 | #define MANUFACTURER_MACRONIX 0x00C2 |
| 35 | #define MANUFACTURER_NEC 0x0010 | 35 | #define MANUFACTURER_NEC 0x0010 |
| 36 | #define MANUFACTURER_PMC 0x009D | 36 | #define MANUFACTURER_PMC 0x009D |
| 37 | #define MANUFACTURER_SHARP 0x00b0 | ||
| 37 | #define MANUFACTURER_SST 0x00BF | 38 | #define MANUFACTURER_SST 0x00BF |
| 38 | #define MANUFACTURER_ST 0x0020 | 39 | #define MANUFACTURER_ST 0x0020 |
| 39 | #define MANUFACTURER_TOSHIBA 0x0098 | 40 | #define MANUFACTURER_TOSHIBA 0x0098 |
| @@ -124,6 +125,9 @@ | |||
| 124 | #define PM49FL004 0x006E | 125 | #define PM49FL004 0x006E |
| 125 | #define PM49FL008 0x006A | 126 | #define PM49FL008 0x006A |
| 126 | 127 | ||
| 128 | /* Sharp */ | ||
| 129 | #define LH28F640BF 0x00b0 | ||
| 130 | |||
| 127 | /* ST - www.st.com */ | 131 | /* ST - www.st.com */ |
| 128 | #define M29W800DT 0x00D7 | 132 | #define M29W800DT 0x00D7 |
| 129 | #define M29W800DB 0x005B | 133 | #define M29W800DB 0x005B |
| @@ -1267,6 +1271,19 @@ static const struct amd_flash_info jedec_table[] = { | |||
| 1267 | .regions = { | 1271 | .regions = { |
| 1268 | ERASEINFO( 0x01000, 256 ) | 1272 | ERASEINFO( 0x01000, 256 ) |
| 1269 | } | 1273 | } |
| 1274 | }, { | ||
| 1275 | .mfr_id = MANUFACTURER_SHARP, | ||
| 1276 | .dev_id = LH28F640BF, | ||
| 1277 | .name = "LH28F640BF", | ||
| 1278 | .uaddr = { | ||
| 1279 | [0] = MTD_UADDR_UNNECESSARY, /* x8 */ | ||
| 1280 | }, | ||
| 1281 | .DevSize = SIZE_4MiB, | ||
| 1282 | .CmdSet = P_ID_INTEL_STD, | ||
| 1283 | .NumEraseRegions= 1, | ||
| 1284 | .regions = { | ||
| 1285 | ERASEINFO(0x40000,16), | ||
| 1286 | } | ||
| 1270 | }, { | 1287 | }, { |
| 1271 | .mfr_id = MANUFACTURER_SST, | 1288 | .mfr_id = MANUFACTURER_SST, |
| 1272 | .dev_id = SST39LF512, | 1289 | .dev_id = SST39LF512, |
| @@ -2035,7 +2052,7 @@ static int jedec_probe_chip(struct map_info *map, __u32 base, | |||
| 2035 | DEBUG(MTD_DEBUG_LEVEL3, | 2052 | DEBUG(MTD_DEBUG_LEVEL3, |
| 2036 | "Search for id:(%02x %02x) interleave(%d) type(%d)\n", | 2053 | "Search for id:(%02x %02x) interleave(%d) type(%d)\n", |
| 2037 | cfi->mfr, cfi->id, cfi_interleave(cfi), cfi->device_type); | 2054 | cfi->mfr, cfi->id, cfi_interleave(cfi), cfi->device_type); |
| 2038 | for (i=0; i<sizeof(jedec_table)/sizeof(jedec_table[0]); i++) { | 2055 | for (i = 0; i < ARRAY_SIZE(jedec_table); i++) { |
| 2039 | if ( jedec_match( base, map, cfi, &jedec_table[i] ) ) { | 2056 | if ( jedec_match( base, map, cfi, &jedec_table[i] ) ) { |
| 2040 | DEBUG( MTD_DEBUG_LEVEL3, | 2057 | DEBUG( MTD_DEBUG_LEVEL3, |
| 2041 | "MTD %s(): matched device 0x%x,0x%x unlock_addrs: 0x%.4x 0x%.4x\n", | 2058 | "MTD %s(): matched device 0x%x,0x%x unlock_addrs: 0x%.4x 0x%.4x\n", |
diff --git a/drivers/mtd/chips/sharp.c b/drivers/mtd/chips/sharp.c index 36f61a6a766e..3cc0b23c5865 100644 --- a/drivers/mtd/chips/sharp.c +++ b/drivers/mtd/chips/sharp.c | |||
| @@ -64,7 +64,7 @@ | |||
| 64 | 64 | ||
| 65 | #undef AUTOUNLOCK /* automatically unlocks blocks before erasing */ | 65 | #undef AUTOUNLOCK /* automatically unlocks blocks before erasing */ |
| 66 | 66 | ||
| 67 | struct mtd_info *sharp_probe(struct map_info *); | 67 | static struct mtd_info *sharp_probe(struct map_info *); |
| 68 | 68 | ||
| 69 | static int sharp_probe_map(struct map_info *map,struct mtd_info *mtd); | 69 | static int sharp_probe_map(struct map_info *map,struct mtd_info *mtd); |
| 70 | 70 | ||
| @@ -96,7 +96,6 @@ struct sharp_info{ | |||
| 96 | struct flchip chips[1]; | 96 | struct flchip chips[1]; |
| 97 | }; | 97 | }; |
| 98 | 98 | ||
| 99 | struct mtd_info *sharp_probe(struct map_info *map); | ||
| 100 | static void sharp_destroy(struct mtd_info *mtd); | 99 | static void sharp_destroy(struct mtd_info *mtd); |
| 101 | 100 | ||
| 102 | static struct mtd_chip_driver sharp_chipdrv = { | 101 | static struct mtd_chip_driver sharp_chipdrv = { |
| @@ -107,7 +106,7 @@ static struct mtd_chip_driver sharp_chipdrv = { | |||
| 107 | }; | 106 | }; |
| 108 | 107 | ||
| 109 | 108 | ||
| 110 | struct mtd_info *sharp_probe(struct map_info *map) | 109 | static struct mtd_info *sharp_probe(struct map_info *map) |
| 111 | { | 110 | { |
| 112 | struct mtd_info *mtd = NULL; | 111 | struct mtd_info *mtd = NULL; |
| 113 | struct sharp_info *sharp = NULL; | 112 | struct sharp_info *sharp = NULL; |
| @@ -581,7 +580,7 @@ static void sharp_destroy(struct mtd_info *mtd) | |||
| 581 | 580 | ||
| 582 | } | 581 | } |
| 583 | 582 | ||
| 584 | int __init sharp_probe_init(void) | 583 | static int __init sharp_probe_init(void) |
| 585 | { | 584 | { |
| 586 | printk("MTD Sharp chip driver <ds@lineo.com>\n"); | 585 | printk("MTD Sharp chip driver <ds@lineo.com>\n"); |
| 587 | 586 | ||
diff --git a/drivers/mtd/cmdlinepart.c b/drivers/mtd/cmdlinepart.c index 6b8bb2e4dcfd..a7a7bfe33879 100644 --- a/drivers/mtd/cmdlinepart.c +++ b/drivers/mtd/cmdlinepart.c | |||
| @@ -42,7 +42,8 @@ | |||
| 42 | 42 | ||
| 43 | 43 | ||
| 44 | /* special size referring to all the remaining space in a partition */ | 44 | /* special size referring to all the remaining space in a partition */ |
| 45 | #define SIZE_REMAINING 0xffffffff | 45 | #define SIZE_REMAINING UINT_MAX |
| 46 | #define OFFSET_CONTINUOUS UINT_MAX | ||
| 46 | 47 | ||
| 47 | struct cmdline_mtd_partition { | 48 | struct cmdline_mtd_partition { |
| 48 | struct cmdline_mtd_partition *next; | 49 | struct cmdline_mtd_partition *next; |
| @@ -75,7 +76,7 @@ static struct mtd_partition * newpart(char *s, | |||
| 75 | { | 76 | { |
| 76 | struct mtd_partition *parts; | 77 | struct mtd_partition *parts; |
| 77 | unsigned long size; | 78 | unsigned long size; |
| 78 | unsigned long offset = 0; | 79 | unsigned long offset = OFFSET_CONTINUOUS; |
| 79 | char *name; | 80 | char *name; |
| 80 | int name_len; | 81 | int name_len; |
| 81 | unsigned char *extra_mem; | 82 | unsigned char *extra_mem; |
| @@ -314,7 +315,7 @@ static int parse_cmdline_partitions(struct mtd_info *master, | |||
| 314 | { | 315 | { |
| 315 | for(i = 0, offset = 0; i < part->num_parts; i++) | 316 | for(i = 0, offset = 0; i < part->num_parts; i++) |
| 316 | { | 317 | { |
| 317 | if (!part->parts[i].offset) | 318 | if (part->parts[i].offset == OFFSET_CONTINUOUS) |
| 318 | part->parts[i].offset = offset; | 319 | part->parts[i].offset = offset; |
| 319 | else | 320 | else |
| 320 | offset = part->parts[i].offset; | 321 | offset = part->parts[i].offset; |
diff --git a/drivers/mtd/devices/blkmtd.c b/drivers/mtd/devices/blkmtd.c index 04f864d238db..79f2e1f23ebd 100644 --- a/drivers/mtd/devices/blkmtd.c +++ b/drivers/mtd/devices/blkmtd.c | |||
| @@ -28,8 +28,9 @@ | |||
| 28 | #include <linux/pagemap.h> | 28 | #include <linux/pagemap.h> |
| 29 | #include <linux/list.h> | 29 | #include <linux/list.h> |
| 30 | #include <linux/init.h> | 30 | #include <linux/init.h> |
| 31 | #include <linux/mount.h> | ||
| 31 | #include <linux/mtd/mtd.h> | 32 | #include <linux/mtd/mtd.h> |
| 32 | 33 | #include <linux/mutex.h> | |
| 33 | 34 | ||
| 34 | #define err(format, arg...) printk(KERN_ERR "blkmtd: " format "\n" , ## arg) | 35 | #define err(format, arg...) printk(KERN_ERR "blkmtd: " format "\n" , ## arg) |
| 35 | #define info(format, arg...) printk(KERN_INFO "blkmtd: " format "\n" , ## arg) | 36 | #define info(format, arg...) printk(KERN_INFO "blkmtd: " format "\n" , ## arg) |
| @@ -46,7 +47,7 @@ struct blkmtd_dev { | |||
| 46 | struct list_head list; | 47 | struct list_head list; |
| 47 | struct block_device *blkdev; | 48 | struct block_device *blkdev; |
| 48 | struct mtd_info mtd_info; | 49 | struct mtd_info mtd_info; |
| 49 | struct semaphore wrbuf_mutex; | 50 | struct mutex wrbuf_mutex; |
| 50 | }; | 51 | }; |
| 51 | 52 | ||
| 52 | 53 | ||
| @@ -268,7 +269,7 @@ static int write_pages(struct blkmtd_dev *dev, const u_char *buf, loff_t to, | |||
| 268 | if(end_len) | 269 | if(end_len) |
| 269 | pagecnt++; | 270 | pagecnt++; |
| 270 | 271 | ||
| 271 | down(&dev->wrbuf_mutex); | 272 | mutex_lock(&dev->wrbuf_mutex); |
| 272 | 273 | ||
| 273 | DEBUG(3, "blkmtd: write: start_len = %zd len = %zd end_len = %zd pagecnt = %d\n", | 274 | DEBUG(3, "blkmtd: write: start_len = %zd len = %zd end_len = %zd pagecnt = %d\n", |
| 274 | start_len, len, end_len, pagecnt); | 275 | start_len, len, end_len, pagecnt); |
| @@ -376,7 +377,7 @@ static int write_pages(struct blkmtd_dev *dev, const u_char *buf, loff_t to, | |||
| 376 | blkmtd_write_out(bio); | 377 | blkmtd_write_out(bio); |
| 377 | 378 | ||
| 378 | DEBUG(2, "blkmtd: write: end, retlen = %zd, err = %d\n", *retlen, err); | 379 | DEBUG(2, "blkmtd: write: end, retlen = %zd, err = %d\n", *retlen, err); |
| 379 | up(&dev->wrbuf_mutex); | 380 | mutex_unlock(&dev->wrbuf_mutex); |
| 380 | 381 | ||
| 381 | if(retlen) | 382 | if(retlen) |
| 382 | *retlen = thislen; | 383 | *retlen = thislen; |
| @@ -614,8 +615,6 @@ static struct mtd_erase_region_info *calc_erase_regions( | |||
| 614 | } | 615 | } |
| 615 | 616 | ||
| 616 | 617 | ||
| 617 | extern dev_t __init name_to_dev_t(const char *line); | ||
| 618 | |||
| 619 | static struct blkmtd_dev *add_device(char *devname, int readonly, int erase_size) | 618 | static struct blkmtd_dev *add_device(char *devname, int readonly, int erase_size) |
| 620 | { | 619 | { |
| 621 | struct block_device *bdev; | 620 | struct block_device *bdev; |
| @@ -659,7 +658,7 @@ static struct blkmtd_dev *add_device(char *devname, int readonly, int erase_size | |||
| 659 | memset(dev, 0, sizeof(struct blkmtd_dev)); | 658 | memset(dev, 0, sizeof(struct blkmtd_dev)); |
| 660 | dev->blkdev = bdev; | 659 | dev->blkdev = bdev; |
| 661 | if(!readonly) { | 660 | if(!readonly) { |
| 662 | init_MUTEX(&dev->wrbuf_mutex); | 661 | mutex_init(&dev->wrbuf_mutex); |
| 663 | } | 662 | } |
| 664 | 663 | ||
| 665 | dev->mtd_info.size = dev->blkdev->bd_inode->i_size & PAGE_MASK; | 664 | dev->mtd_info.size = dev->blkdev->bd_inode->i_size & PAGE_MASK; |
diff --git a/drivers/mtd/devices/block2mtd.c b/drivers/mtd/devices/block2mtd.c index 7ff403b2a0a0..4160b8334c53 100644 --- a/drivers/mtd/devices/block2mtd.c +++ b/drivers/mtd/devices/block2mtd.c | |||
| @@ -18,6 +18,7 @@ | |||
| 18 | #include <linux/init.h> | 18 | #include <linux/init.h> |
| 19 | #include <linux/mtd/mtd.h> | 19 | #include <linux/mtd/mtd.h> |
| 20 | #include <linux/buffer_head.h> | 20 | #include <linux/buffer_head.h> |
| 21 | #include <linux/mutex.h> | ||
| 21 | 22 | ||
| 22 | #define VERSION "$Revision: 1.30 $" | 23 | #define VERSION "$Revision: 1.30 $" |
| 23 | 24 | ||
| @@ -31,7 +32,7 @@ struct block2mtd_dev { | |||
| 31 | struct list_head list; | 32 | struct list_head list; |
| 32 | struct block_device *blkdev; | 33 | struct block_device *blkdev; |
| 33 | struct mtd_info mtd; | 34 | struct mtd_info mtd; |
| 34 | struct semaphore write_mutex; | 35 | struct mutex write_mutex; |
| 35 | }; | 36 | }; |
| 36 | 37 | ||
| 37 | 38 | ||
| @@ -134,9 +135,9 @@ static int block2mtd_erase(struct mtd_info *mtd, struct erase_info *instr) | |||
| 134 | int err; | 135 | int err; |
| 135 | 136 | ||
| 136 | instr->state = MTD_ERASING; | 137 | instr->state = MTD_ERASING; |
| 137 | down(&dev->write_mutex); | 138 | mutex_lock(&dev->write_mutex); |
| 138 | err = _block2mtd_erase(dev, from, len); | 139 | err = _block2mtd_erase(dev, from, len); |
| 139 | up(&dev->write_mutex); | 140 | mutex_unlock(&dev->write_mutex); |
| 140 | if (err) { | 141 | if (err) { |
| 141 | ERROR("erase failed err = %d", err); | 142 | ERROR("erase failed err = %d", err); |
| 142 | instr->state = MTD_ERASE_FAILED; | 143 | instr->state = MTD_ERASE_FAILED; |
| @@ -249,9 +250,9 @@ static int block2mtd_write(struct mtd_info *mtd, loff_t to, size_t len, | |||
| 249 | if (to + len > mtd->size) | 250 | if (to + len > mtd->size) |
| 250 | len = mtd->size - to; | 251 | len = mtd->size - to; |
| 251 | 252 | ||
| 252 | down(&dev->write_mutex); | 253 | mutex_lock(&dev->write_mutex); |
| 253 | err = _block2mtd_write(dev, buf, to, len, retlen); | 254 | err = _block2mtd_write(dev, buf, to, len, retlen); |
| 254 | up(&dev->write_mutex); | 255 | mutex_unlock(&dev->write_mutex); |
| 255 | if (err > 0) | 256 | if (err > 0) |
| 256 | err = 0; | 257 | err = 0; |
| 257 | return err; | 258 | return err; |
| @@ -310,7 +311,7 @@ static struct block2mtd_dev *add_device(char *devname, int erase_size) | |||
| 310 | goto devinit_err; | 311 | goto devinit_err; |
| 311 | } | 312 | } |
| 312 | 313 | ||
| 313 | init_MUTEX(&dev->write_mutex); | 314 | mutex_init(&dev->write_mutex); |
| 314 | 315 | ||
| 315 | /* Setup the MTD structure */ | 316 | /* Setup the MTD structure */ |
| 316 | /* make the name contain the block device in */ | 317 | /* make the name contain the block device in */ |
diff --git a/drivers/mtd/devices/doc2000.c b/drivers/mtd/devices/doc2000.c index e4345cf744a2..23e7a5c7d2c1 100644 --- a/drivers/mtd/devices/doc2000.c +++ b/drivers/mtd/devices/doc2000.c | |||
| @@ -20,6 +20,7 @@ | |||
| 20 | #include <linux/init.h> | 20 | #include <linux/init.h> |
| 21 | #include <linux/types.h> | 21 | #include <linux/types.h> |
| 22 | #include <linux/bitops.h> | 22 | #include <linux/bitops.h> |
| 23 | #include <linux/mutex.h> | ||
| 23 | 24 | ||
| 24 | #include <linux/mtd/mtd.h> | 25 | #include <linux/mtd/mtd.h> |
| 25 | #include <linux/mtd/nand.h> | 26 | #include <linux/mtd/nand.h> |
| @@ -605,7 +606,7 @@ static void DoC2k_init(struct mtd_info *mtd) | |||
| 605 | 606 | ||
| 606 | this->curfloor = -1; | 607 | this->curfloor = -1; |
| 607 | this->curchip = -1; | 608 | this->curchip = -1; |
| 608 | init_MUTEX(&this->lock); | 609 | mutex_init(&this->lock); |
| 609 | 610 | ||
| 610 | /* Ident all the chips present. */ | 611 | /* Ident all the chips present. */ |
| 611 | DoC_ScanChips(this, maxchips); | 612 | DoC_ScanChips(this, maxchips); |
| @@ -645,7 +646,7 @@ static int doc_read_ecc(struct mtd_info *mtd, loff_t from, size_t len, | |||
| 645 | if (from >= this->totlen) | 646 | if (from >= this->totlen) |
| 646 | return -EINVAL; | 647 | return -EINVAL; |
| 647 | 648 | ||
| 648 | down(&this->lock); | 649 | mutex_lock(&this->lock); |
| 649 | 650 | ||
| 650 | *retlen = 0; | 651 | *retlen = 0; |
| 651 | while (left) { | 652 | while (left) { |
| @@ -774,7 +775,7 @@ static int doc_read_ecc(struct mtd_info *mtd, loff_t from, size_t len, | |||
| 774 | buf += len; | 775 | buf += len; |
| 775 | } | 776 | } |
| 776 | 777 | ||
| 777 | up(&this->lock); | 778 | mutex_unlock(&this->lock); |
| 778 | 779 | ||
| 779 | return ret; | 780 | return ret; |
| 780 | } | 781 | } |
| @@ -803,7 +804,7 @@ static int doc_write_ecc(struct mtd_info *mtd, loff_t to, size_t len, | |||
| 803 | if (to >= this->totlen) | 804 | if (to >= this->totlen) |
| 804 | return -EINVAL; | 805 | return -EINVAL; |
| 805 | 806 | ||
| 806 | down(&this->lock); | 807 | mutex_lock(&this->lock); |
| 807 | 808 | ||
| 808 | *retlen = 0; | 809 | *retlen = 0; |
| 809 | while (left) { | 810 | while (left) { |
| @@ -873,7 +874,7 @@ static int doc_write_ecc(struct mtd_info *mtd, loff_t to, size_t len, | |||
| 873 | printk(KERN_ERR "Error programming flash\n"); | 874 | printk(KERN_ERR "Error programming flash\n"); |
| 874 | /* Error in programming */ | 875 | /* Error in programming */ |
| 875 | *retlen = 0; | 876 | *retlen = 0; |
| 876 | up(&this->lock); | 877 | mutex_unlock(&this->lock); |
| 877 | return -EIO; | 878 | return -EIO; |
| 878 | } | 879 | } |
| 879 | 880 | ||
| @@ -935,7 +936,7 @@ static int doc_write_ecc(struct mtd_info *mtd, loff_t to, size_t len, | |||
| 935 | printk(KERN_ERR "Error programming flash\n"); | 936 | printk(KERN_ERR "Error programming flash\n"); |
| 936 | /* Error in programming */ | 937 | /* Error in programming */ |
| 937 | *retlen = 0; | 938 | *retlen = 0; |
| 938 | up(&this->lock); | 939 | mutex_unlock(&this->lock); |
| 939 | return -EIO; | 940 | return -EIO; |
| 940 | } | 941 | } |
| 941 | 942 | ||
| @@ -956,7 +957,7 @@ static int doc_write_ecc(struct mtd_info *mtd, loff_t to, size_t len, | |||
| 956 | 957 | ||
| 957 | ret = doc_write_oob_nolock(mtd, to, 8, &dummy, x); | 958 | ret = doc_write_oob_nolock(mtd, to, 8, &dummy, x); |
| 958 | if (ret) { | 959 | if (ret) { |
| 959 | up(&this->lock); | 960 | mutex_unlock(&this->lock); |
| 960 | return ret; | 961 | return ret; |
| 961 | } | 962 | } |
| 962 | } | 963 | } |
| @@ -966,7 +967,7 @@ static int doc_write_ecc(struct mtd_info *mtd, loff_t to, size_t len, | |||
| 966 | buf += len; | 967 | buf += len; |
| 967 | } | 968 | } |
| 968 | 969 | ||
| 969 | up(&this->lock); | 970 | mutex_unlock(&this->lock); |
| 970 | return 0; | 971 | return 0; |
| 971 | } | 972 | } |
| 972 | 973 | ||
| @@ -975,13 +976,13 @@ static int doc_writev_ecc(struct mtd_info *mtd, const struct kvec *vecs, | |||
| 975 | u_char *eccbuf, struct nand_oobinfo *oobsel) | 976 | u_char *eccbuf, struct nand_oobinfo *oobsel) |
| 976 | { | 977 | { |
| 977 | static char static_buf[512]; | 978 | static char static_buf[512]; |
| 978 | static DECLARE_MUTEX(writev_buf_sem); | 979 | static DEFINE_MUTEX(writev_buf_mutex); |
| 979 | 980 | ||
| 980 | size_t totretlen = 0; | 981 | size_t totretlen = 0; |
| 981 | size_t thisvecofs = 0; | 982 | size_t thisvecofs = 0; |
| 982 | int ret= 0; | 983 | int ret= 0; |
| 983 | 984 | ||
| 984 | down(&writev_buf_sem); | 985 | mutex_lock(&writev_buf_mutex); |
| 985 | 986 | ||
| 986 | while(count) { | 987 | while(count) { |
| 987 | size_t thislen, thisretlen; | 988 | size_t thislen, thisretlen; |
| @@ -1024,7 +1025,7 @@ static int doc_writev_ecc(struct mtd_info *mtd, const struct kvec *vecs, | |||
| 1024 | to += thislen; | 1025 | to += thislen; |
| 1025 | } | 1026 | } |
| 1026 | 1027 | ||
| 1027 | up(&writev_buf_sem); | 1028 | mutex_unlock(&writev_buf_mutex); |
| 1028 | *retlen = totretlen; | 1029 | *retlen = totretlen; |
| 1029 | return ret; | 1030 | return ret; |
| 1030 | } | 1031 | } |
| @@ -1037,7 +1038,7 @@ static int doc_read_oob(struct mtd_info *mtd, loff_t ofs, size_t len, | |||
| 1037 | int len256 = 0, ret; | 1038 | int len256 = 0, ret; |
| 1038 | struct Nand *mychip; | 1039 | struct Nand *mychip; |
| 1039 | 1040 | ||
| 1040 | down(&this->lock); | 1041 | mutex_lock(&this->lock); |
| 1041 | 1042 | ||
| 1042 | mychip = &this->chips[ofs >> this->chipshift]; | 1043 | mychip = &this->chips[ofs >> this->chipshift]; |
| 1043 | 1044 | ||
| @@ -1083,7 +1084,7 @@ static int doc_read_oob(struct mtd_info *mtd, loff_t ofs, size_t len, | |||
| 1083 | 1084 | ||
| 1084 | ret = DoC_WaitReady(this); | 1085 | ret = DoC_WaitReady(this); |
| 1085 | 1086 | ||
| 1086 | up(&this->lock); | 1087 | mutex_unlock(&this->lock); |
| 1087 | return ret; | 1088 | return ret; |
| 1088 | 1089 | ||
| 1089 | } | 1090 | } |
| @@ -1197,10 +1198,10 @@ static int doc_write_oob(struct mtd_info *mtd, loff_t ofs, size_t len, | |||
| 1197 | struct DiskOnChip *this = mtd->priv; | 1198 | struct DiskOnChip *this = mtd->priv; |
| 1198 | int ret; | 1199 | int ret; |
| 1199 | 1200 | ||
| 1200 | down(&this->lock); | 1201 | mutex_lock(&this->lock); |
| 1201 | ret = doc_write_oob_nolock(mtd, ofs, len, retlen, buf); | 1202 | ret = doc_write_oob_nolock(mtd, ofs, len, retlen, buf); |
| 1202 | 1203 | ||
| 1203 | up(&this->lock); | 1204 | mutex_unlock(&this->lock); |
| 1204 | return ret; | 1205 | return ret; |
| 1205 | } | 1206 | } |
| 1206 | 1207 | ||
| @@ -1214,10 +1215,10 @@ static int doc_erase(struct mtd_info *mtd, struct erase_info *instr) | |||
| 1214 | struct Nand *mychip; | 1215 | struct Nand *mychip; |
| 1215 | int status; | 1216 | int status; |
| 1216 | 1217 | ||
| 1217 | down(&this->lock); | 1218 | mutex_lock(&this->lock); |
| 1218 | 1219 | ||
| 1219 | if (ofs & (mtd->erasesize-1) || len & (mtd->erasesize-1)) { | 1220 | if (ofs & (mtd->erasesize-1) || len & (mtd->erasesize-1)) { |
| 1220 | up(&this->lock); | 1221 | mutex_unlock(&this->lock); |
| 1221 | return -EINVAL; | 1222 | return -EINVAL; |
| 1222 | } | 1223 | } |
| 1223 | 1224 | ||
| @@ -1265,7 +1266,7 @@ static int doc_erase(struct mtd_info *mtd, struct erase_info *instr) | |||
| 1265 | callback: | 1266 | callback: |
| 1266 | mtd_erase_callback(instr); | 1267 | mtd_erase_callback(instr); |
| 1267 | 1268 | ||
| 1268 | up(&this->lock); | 1269 | mutex_unlock(&this->lock); |
| 1269 | return 0; | 1270 | return 0; |
| 1270 | } | 1271 | } |
| 1271 | 1272 | ||
diff --git a/drivers/mtd/devices/lart.c b/drivers/mtd/devices/lart.c index 1e876fcb0408..29b0ddaa324e 100644 --- a/drivers/mtd/devices/lart.c +++ b/drivers/mtd/devices/lart.c | |||
| @@ -581,8 +581,6 @@ static int flash_write (struct mtd_info *mtd,loff_t to,size_t len,size_t *retlen | |||
| 581 | 581 | ||
| 582 | /***************************************************************************************************/ | 582 | /***************************************************************************************************/ |
| 583 | 583 | ||
| 584 | #define NB_OF(x) (sizeof (x) / sizeof (x[0])) | ||
| 585 | |||
| 586 | static struct mtd_info mtd; | 584 | static struct mtd_info mtd; |
| 587 | 585 | ||
| 588 | static struct mtd_erase_region_info erase_regions[] = { | 586 | static struct mtd_erase_region_info erase_regions[] = { |
| @@ -640,7 +638,7 @@ int __init lart_flash_init (void) | |||
| 640 | mtd.flags = MTD_CAP_NORFLASH; | 638 | mtd.flags = MTD_CAP_NORFLASH; |
| 641 | mtd.size = FLASH_BLOCKSIZE_PARAM * FLASH_NUMBLOCKS_16m_PARAM + FLASH_BLOCKSIZE_MAIN * FLASH_NUMBLOCKS_16m_MAIN; | 639 | mtd.size = FLASH_BLOCKSIZE_PARAM * FLASH_NUMBLOCKS_16m_PARAM + FLASH_BLOCKSIZE_MAIN * FLASH_NUMBLOCKS_16m_MAIN; |
| 642 | mtd.erasesize = FLASH_BLOCKSIZE_MAIN; | 640 | mtd.erasesize = FLASH_BLOCKSIZE_MAIN; |
| 643 | mtd.numeraseregions = NB_OF (erase_regions); | 641 | mtd.numeraseregions = ARRAY_SIZE(erase_regions); |
| 644 | mtd.eraseregions = erase_regions; | 642 | mtd.eraseregions = erase_regions; |
| 645 | mtd.erase = flash_erase; | 643 | mtd.erase = flash_erase; |
| 646 | mtd.read = flash_read; | 644 | mtd.read = flash_read; |
| @@ -670,9 +668,9 @@ int __init lart_flash_init (void) | |||
| 670 | result,mtd.eraseregions[result].numblocks); | 668 | result,mtd.eraseregions[result].numblocks); |
| 671 | 669 | ||
| 672 | #ifdef HAVE_PARTITIONS | 670 | #ifdef HAVE_PARTITIONS |
| 673 | printk ("\npartitions = %d\n",NB_OF (lart_partitions)); | 671 | printk ("\npartitions = %d\n", ARRAY_SIZE(lart_partitions)); |
| 674 | 672 | ||
| 675 | for (result = 0; result < NB_OF (lart_partitions); result++) | 673 | for (result = 0; result < ARRAY_SIZE(lart_partitions); result++) |
| 676 | printk (KERN_DEBUG | 674 | printk (KERN_DEBUG |
| 677 | "\n\n" | 675 | "\n\n" |
| 678 | "lart_partitions[%d].name = %s\n" | 676 | "lart_partitions[%d].name = %s\n" |
| @@ -687,7 +685,7 @@ int __init lart_flash_init (void) | |||
| 687 | #ifndef HAVE_PARTITIONS | 685 | #ifndef HAVE_PARTITIONS |
| 688 | result = add_mtd_device (&mtd); | 686 | result = add_mtd_device (&mtd); |
| 689 | #else | 687 | #else |
| 690 | result = add_mtd_partitions (&mtd,lart_partitions,NB_OF (lart_partitions)); | 688 | result = add_mtd_partitions (&mtd,lart_partitions, ARRAY_SIZE(lart_partitions)); |
| 691 | #endif | 689 | #endif |
| 692 | 690 | ||
| 693 | return (result); | 691 | return (result); |
diff --git a/drivers/mtd/devices/m25p80.c b/drivers/mtd/devices/m25p80.c index d5f24089be71..04e65d5dae00 100644 --- a/drivers/mtd/devices/m25p80.c +++ b/drivers/mtd/devices/m25p80.c | |||
| @@ -186,7 +186,7 @@ static int m25p80_erase(struct mtd_info *mtd, struct erase_info *instr) | |||
| 186 | struct m25p *flash = mtd_to_m25p(mtd); | 186 | struct m25p *flash = mtd_to_m25p(mtd); |
| 187 | u32 addr,len; | 187 | u32 addr,len; |
| 188 | 188 | ||
| 189 | DEBUG(MTD_DEBUG_LEVEL2, "%s: %s %s 0x%08x, len %zd\n", | 189 | DEBUG(MTD_DEBUG_LEVEL2, "%s: %s %s 0x%08x, len %d\n", |
| 190 | flash->spi->dev.bus_id, __FUNCTION__, "at", | 190 | flash->spi->dev.bus_id, __FUNCTION__, "at", |
| 191 | (u32)instr->addr, instr->len); | 191 | (u32)instr->addr, instr->len); |
| 192 | 192 | ||
diff --git a/drivers/mtd/devices/ms02-nv.c b/drivers/mtd/devices/ms02-nv.c index 0ff2e4378244..485f663493d2 100644 --- a/drivers/mtd/devices/ms02-nv.c +++ b/drivers/mtd/devices/ms02-nv.c | |||
| @@ -308,7 +308,7 @@ static int __init ms02nv_init(void) | |||
| 308 | break; | 308 | break; |
| 309 | } | 309 | } |
| 310 | 310 | ||
| 311 | for (i = 0; i < (sizeof(ms02nv_addrs) / sizeof(*ms02nv_addrs)); i++) | 311 | for (i = 0; i < ARRAY_SIZE(ms02nv_addrs); i++) |
| 312 | if (!ms02nv_init_one(ms02nv_addrs[i] << stride)) | 312 | if (!ms02nv_init_one(ms02nv_addrs[i] << stride)) |
| 313 | count++; | 313 | count++; |
| 314 | 314 | ||
diff --git a/drivers/mtd/inftlcore.c b/drivers/mtd/inftlcore.c index 8a544890173d..a3b92479719d 100644 --- a/drivers/mtd/inftlcore.c +++ b/drivers/mtd/inftlcore.c | |||
| @@ -47,9 +47,6 @@ | |||
| 47 | */ | 47 | */ |
| 48 | #define MAX_LOOPS 10000 | 48 | #define MAX_LOOPS 10000 |
| 49 | 49 | ||
| 50 | extern void INFTL_dumptables(struct INFTLrecord *inftl); | ||
| 51 | extern void INFTL_dumpVUchains(struct INFTLrecord *inftl); | ||
| 52 | |||
| 53 | static void inftl_add_mtd(struct mtd_blktrans_ops *tr, struct mtd_info *mtd) | 50 | static void inftl_add_mtd(struct mtd_blktrans_ops *tr, struct mtd_info *mtd) |
| 54 | { | 51 | { |
| 55 | struct INFTLrecord *inftl; | 52 | struct INFTLrecord *inftl; |
| @@ -132,7 +129,7 @@ static void inftl_add_mtd(struct mtd_blktrans_ops *tr, struct mtd_info *mtd) | |||
| 132 | return; | 129 | return; |
| 133 | } | 130 | } |
| 134 | #ifdef PSYCHO_DEBUG | 131 | #ifdef PSYCHO_DEBUG |
| 135 | printk(KERN_INFO "INFTL: Found new nftl%c\n", nftl->mbd.devnum + 'a'); | 132 | printk(KERN_INFO "INFTL: Found new inftl%c\n", inftl->mbd.devnum + 'a'); |
| 136 | #endif | 133 | #endif |
| 137 | return; | 134 | return; |
| 138 | } | 135 | } |
| @@ -885,8 +882,6 @@ static struct mtd_blktrans_ops inftl_tr = { | |||
| 885 | .owner = THIS_MODULE, | 882 | .owner = THIS_MODULE, |
| 886 | }; | 883 | }; |
| 887 | 884 | ||
| 888 | extern char inftlmountrev[]; | ||
| 889 | |||
| 890 | static int __init init_inftl(void) | 885 | static int __init init_inftl(void) |
| 891 | { | 886 | { |
| 892 | printk(KERN_INFO "INFTL: inftlcore.c $Revision: 1.19 $, " | 887 | printk(KERN_INFO "INFTL: inftlcore.c $Revision: 1.19 $, " |
diff --git a/drivers/mtd/maps/alchemy-flash.c b/drivers/mtd/maps/alchemy-flash.c index a57791a6ce40..b933a2a27b18 100644 --- a/drivers/mtd/maps/alchemy-flash.c +++ b/drivers/mtd/maps/alchemy-flash.c | |||
| @@ -126,8 +126,6 @@ static struct mtd_partition alchemy_partitions[] = { | |||
| 126 | } | 126 | } |
| 127 | }; | 127 | }; |
| 128 | 128 | ||
| 129 | #define NB_OF(x) (sizeof(x)/sizeof(x[0])) | ||
| 130 | |||
| 131 | static struct mtd_info *mymtd; | 129 | static struct mtd_info *mymtd; |
| 132 | 130 | ||
| 133 | int __init alchemy_mtd_init(void) | 131 | int __init alchemy_mtd_init(void) |
| @@ -154,7 +152,7 @@ int __init alchemy_mtd_init(void) | |||
| 154 | * Static partition definition selection | 152 | * Static partition definition selection |
| 155 | */ | 153 | */ |
| 156 | parts = alchemy_partitions; | 154 | parts = alchemy_partitions; |
| 157 | nb_parts = NB_OF(alchemy_partitions); | 155 | nb_parts = ARRAY_SIZE(alchemy_partitions); |
| 158 | alchemy_map.size = window_size; | 156 | alchemy_map.size = window_size; |
| 159 | 157 | ||
| 160 | /* | 158 | /* |
diff --git a/drivers/mtd/maps/cfi_flagadm.c b/drivers/mtd/maps/cfi_flagadm.c index 6a8c0415bde8..fd0f0d3187de 100644 --- a/drivers/mtd/maps/cfi_flagadm.c +++ b/drivers/mtd/maps/cfi_flagadm.c | |||
| @@ -86,7 +86,7 @@ struct mtd_partition flagadm_parts[] = { | |||
| 86 | } | 86 | } |
| 87 | }; | 87 | }; |
| 88 | 88 | ||
| 89 | #define PARTITION_COUNT (sizeof(flagadm_parts)/sizeof(struct mtd_partition)) | 89 | #define PARTITION_COUNT ARRAY_SIZE(flagadm_parts) |
| 90 | 90 | ||
| 91 | static struct mtd_info *mymtd; | 91 | static struct mtd_info *mymtd; |
| 92 | 92 | ||
diff --git a/drivers/mtd/maps/dbox2-flash.c b/drivers/mtd/maps/dbox2-flash.c index 49d90542fc75..652813cd6c2d 100644 --- a/drivers/mtd/maps/dbox2-flash.c +++ b/drivers/mtd/maps/dbox2-flash.c | |||
| @@ -57,7 +57,7 @@ static struct mtd_partition partition_info[]= { | |||
| 57 | } | 57 | } |
| 58 | }; | 58 | }; |
| 59 | 59 | ||
| 60 | #define NUM_PARTITIONS (sizeof(partition_info) / sizeof(partition_info[0])) | 60 | #define NUM_PARTITIONS ARRAY_SIZE(partition_info) |
| 61 | 61 | ||
| 62 | #define WINDOW_ADDR 0x10000000 | 62 | #define WINDOW_ADDR 0x10000000 |
| 63 | #define WINDOW_SIZE 0x800000 | 63 | #define WINDOW_SIZE 0x800000 |
diff --git a/drivers/mtd/maps/dilnetpc.c b/drivers/mtd/maps/dilnetpc.c index efb221692641..c299d10b33e6 100644 --- a/drivers/mtd/maps/dilnetpc.c +++ b/drivers/mtd/maps/dilnetpc.c | |||
| @@ -300,7 +300,7 @@ static struct mtd_partition partition_info[]= | |||
| 300 | }, | 300 | }, |
| 301 | }; | 301 | }; |
| 302 | 302 | ||
| 303 | #define NUM_PARTITIONS (sizeof(partition_info)/sizeof(partition_info[0])) | 303 | #define NUM_PARTITIONS ARRAY_SIZE(partition_info) |
| 304 | 304 | ||
| 305 | static struct mtd_info *mymtd; | 305 | static struct mtd_info *mymtd; |
| 306 | static struct mtd_info *lowlvl_parts[NUM_PARTITIONS]; | 306 | static struct mtd_info *lowlvl_parts[NUM_PARTITIONS]; |
| @@ -345,7 +345,7 @@ static struct mtd_partition higlvl_partition_info[]= | |||
| 345 | }, | 345 | }, |
| 346 | }; | 346 | }; |
| 347 | 347 | ||
| 348 | #define NUM_HIGHLVL_PARTITIONS (sizeof(higlvl_partition_info)/sizeof(partition_info[0])) | 348 | #define NUM_HIGHLVL_PARTITIONS ARRAY_SIZE(higlvl_partition_info) |
| 349 | 349 | ||
| 350 | 350 | ||
| 351 | static int dnp_adnp_probe(void) | 351 | static int dnp_adnp_probe(void) |
diff --git a/drivers/mtd/maps/dmv182.c b/drivers/mtd/maps/dmv182.c index b993ac01a9a5..2bb3c0f0f970 100644 --- a/drivers/mtd/maps/dmv182.c +++ b/drivers/mtd/maps/dmv182.c | |||
| @@ -99,7 +99,7 @@ static struct mtd_info *this_mtd; | |||
| 99 | static int __init init_svme182(void) | 99 | static int __init init_svme182(void) |
| 100 | { | 100 | { |
| 101 | struct mtd_partition *partitions; | 101 | struct mtd_partition *partitions; |
| 102 | int num_parts = sizeof(svme182_partitions) / sizeof(struct mtd_partition); | 102 | int num_parts = ARRAY_SIZE(svme182_partitions); |
| 103 | 103 | ||
| 104 | partitions = svme182_partitions; | 104 | partitions = svme182_partitions; |
| 105 | 105 | ||
diff --git a/drivers/mtd/maps/h720x-flash.c b/drivers/mtd/maps/h720x-flash.c index 319094821101..0667101ccbe1 100644 --- a/drivers/mtd/maps/h720x-flash.c +++ b/drivers/mtd/maps/h720x-flash.c | |||
| @@ -59,7 +59,7 @@ static struct mtd_partition h720x_partitions[] = { | |||
| 59 | } | 59 | } |
| 60 | }; | 60 | }; |
| 61 | 61 | ||
| 62 | #define NUM_PARTITIONS (sizeof(h720x_partitions)/sizeof(h720x_partitions[0])) | 62 | #define NUM_PARTITIONS ARRAY_SIZE(h720x_partitions) |
| 63 | 63 | ||
| 64 | static int nr_mtd_parts; | 64 | static int nr_mtd_parts; |
| 65 | static struct mtd_partition *mtd_parts; | 65 | static struct mtd_partition *mtd_parts; |
diff --git a/drivers/mtd/maps/netsc520.c b/drivers/mtd/maps/netsc520.c index 33060a315722..ed215470158b 100644 --- a/drivers/mtd/maps/netsc520.c +++ b/drivers/mtd/maps/netsc520.c | |||
| @@ -76,7 +76,7 @@ static struct mtd_partition partition_info[]={ | |||
| 76 | .size = 0x80000 | 76 | .size = 0x80000 |
| 77 | }, | 77 | }, |
| 78 | }; | 78 | }; |
| 79 | #define NUM_PARTITIONS (sizeof(partition_info)/sizeof(partition_info[0])) | 79 | #define NUM_PARTITIONS ARRAY_SIZE(partition_info) |
| 80 | 80 | ||
| 81 | #define WINDOW_SIZE 0x00100000 | 81 | #define WINDOW_SIZE 0x00100000 |
| 82 | #define WINDOW_ADDR 0x00200000 | 82 | #define WINDOW_ADDR 0x00200000 |
| @@ -88,7 +88,7 @@ static struct map_info netsc520_map = { | |||
| 88 | .phys = WINDOW_ADDR, | 88 | .phys = WINDOW_ADDR, |
| 89 | }; | 89 | }; |
| 90 | 90 | ||
| 91 | #define NUM_FLASH_BANKS (sizeof(netsc520_map)/sizeof(struct map_info)) | 91 | #define NUM_FLASH_BANKS ARRAY_SIZE(netsc520_map) |
| 92 | 92 | ||
| 93 | static struct mtd_info *mymtd; | 93 | static struct mtd_info *mymtd; |
| 94 | 94 | ||
diff --git a/drivers/mtd/maps/nettel.c b/drivers/mtd/maps/nettel.c index 632eb2aa968f..54a3102ab19a 100644 --- a/drivers/mtd/maps/nettel.c +++ b/drivers/mtd/maps/nettel.c | |||
| @@ -128,8 +128,7 @@ static struct mtd_partition nettel_amd_partitions[] = { | |||
| 128 | } | 128 | } |
| 129 | }; | 129 | }; |
| 130 | 130 | ||
| 131 | #define NUM_AMD_PARTITIONS \ | 131 | #define NUM_AMD_PARTITIONS ARRAY_SIZE(nettel_amd_partitions) |
| 132 | (sizeof(nettel_amd_partitions)/sizeof(nettel_amd_partitions[0])) | ||
| 133 | 132 | ||
| 134 | /****************************************************************************/ | 133 | /****************************************************************************/ |
| 135 | 134 | ||
diff --git a/drivers/mtd/maps/ocotea.c b/drivers/mtd/maps/ocotea.c index c223514ca2eb..a21fcd195ab4 100644 --- a/drivers/mtd/maps/ocotea.c +++ b/drivers/mtd/maps/ocotea.c | |||
| @@ -58,8 +58,6 @@ static struct mtd_partition ocotea_large_partitions[] = { | |||
| 58 | } | 58 | } |
| 59 | }; | 59 | }; |
| 60 | 60 | ||
| 61 | #define NB_OF(x) (sizeof(x)/sizeof(x[0])) | ||
| 62 | |||
| 63 | int __init init_ocotea(void) | 61 | int __init init_ocotea(void) |
| 64 | { | 62 | { |
| 65 | u8 fpga0_reg; | 63 | u8 fpga0_reg; |
| @@ -97,7 +95,7 @@ int __init init_ocotea(void) | |||
| 97 | if (flash) { | 95 | if (flash) { |
| 98 | flash->owner = THIS_MODULE; | 96 | flash->owner = THIS_MODULE; |
| 99 | add_mtd_partitions(flash, ocotea_small_partitions, | 97 | add_mtd_partitions(flash, ocotea_small_partitions, |
| 100 | NB_OF(ocotea_small_partitions)); | 98 | ARRAY_SIZE(ocotea_small_partitions)); |
| 101 | } else { | 99 | } else { |
| 102 | printk("map probe failed for flash\n"); | 100 | printk("map probe failed for flash\n"); |
| 103 | return -ENXIO; | 101 | return -ENXIO; |
| @@ -118,7 +116,7 @@ int __init init_ocotea(void) | |||
| 118 | if (flash) { | 116 | if (flash) { |
| 119 | flash->owner = THIS_MODULE; | 117 | flash->owner = THIS_MODULE; |
| 120 | add_mtd_partitions(flash, ocotea_large_partitions, | 118 | add_mtd_partitions(flash, ocotea_large_partitions, |
| 121 | NB_OF(ocotea_large_partitions)); | 119 | ARRAY_SIZE(ocotea_large_partitions)); |
| 122 | } else { | 120 | } else { |
| 123 | printk("map probe failed for flash\n"); | 121 | printk("map probe failed for flash\n"); |
| 124 | return -ENXIO; | 122 | return -ENXIO; |
diff --git a/drivers/mtd/maps/pci.c b/drivers/mtd/maps/pci.c index 21822c2edbe4..d2ab1bae9c34 100644 --- a/drivers/mtd/maps/pci.c +++ b/drivers/mtd/maps/pci.c | |||
| @@ -334,9 +334,6 @@ mtd_pci_probe(struct pci_dev *dev, const struct pci_device_id *id) | |||
| 334 | return 0; | 334 | return 0; |
| 335 | 335 | ||
| 336 | release: | 336 | release: |
| 337 | if (mtd) | ||
| 338 | map_destroy(mtd); | ||
| 339 | |||
| 340 | if (map) { | 337 | if (map) { |
| 341 | map->exit(dev, map); | 338 | map->exit(dev, map); |
| 342 | kfree(map); | 339 | kfree(map); |
diff --git a/drivers/mtd/maps/pcmciamtd.c b/drivers/mtd/maps/pcmciamtd.c index f988c817e196..8bbc751a6021 100644 --- a/drivers/mtd/maps/pcmciamtd.c +++ b/drivers/mtd/maps/pcmciamtd.c | |||
| @@ -616,7 +616,7 @@ static void pcmciamtd_config(dev_link_t *link) | |||
| 616 | } else if(mem_type == 2) { | 616 | } else if(mem_type == 2) { |
| 617 | mtd = do_map_probe("map_rom", &dev->pcmcia_map); | 617 | mtd = do_map_probe("map_rom", &dev->pcmcia_map); |
| 618 | } else { | 618 | } else { |
| 619 | for(i = 0; i < sizeof(probes) / sizeof(char *); i++) { | 619 | for(i = 0; i < ARRAY_SIZE(probes); i++) { |
| 620 | DEBUG(1, "Trying %s", probes[i]); | 620 | DEBUG(1, "Trying %s", probes[i]); |
| 621 | mtd = do_map_probe(probes[i], &dev->pcmcia_map); | 621 | mtd = do_map_probe(probes[i], &dev->pcmcia_map); |
| 622 | if(mtd) | 622 | if(mtd) |
diff --git a/drivers/mtd/maps/redwood.c b/drivers/mtd/maps/redwood.c index 5b76ed886185..50b14033613f 100644 --- a/drivers/mtd/maps/redwood.c +++ b/drivers/mtd/maps/redwood.c | |||
| @@ -121,8 +121,7 @@ struct map_info redwood_flash_map = { | |||
| 121 | }; | 121 | }; |
| 122 | 122 | ||
| 123 | 123 | ||
| 124 | #define NUM_REDWOOD_FLASH_PARTITIONS \ | 124 | #define NUM_REDWOOD_FLASH_PARTITIONS ARRAY_SIZE(redwood_flash_partitions) |
| 125 | (sizeof(redwood_flash_partitions)/sizeof(redwood_flash_partitions[0])) | ||
| 126 | 125 | ||
| 127 | static struct mtd_info *redwood_mtd; | 126 | static struct mtd_info *redwood_mtd; |
| 128 | 127 | ||
diff --git a/drivers/mtd/maps/sbc8240.c b/drivers/mtd/maps/sbc8240.c index 225cdd9ba5b2..350286dc1d2e 100644 --- a/drivers/mtd/maps/sbc8240.c +++ b/drivers/mtd/maps/sbc8240.c | |||
| @@ -66,7 +66,7 @@ static struct map_info sbc8240_map[2] = { | |||
| 66 | } | 66 | } |
| 67 | }; | 67 | }; |
| 68 | 68 | ||
| 69 | #define NUM_FLASH_BANKS (sizeof(sbc8240_map) / sizeof(struct map_info)) | 69 | #define NUM_FLASH_BANKS ARRAY_SIZE(sbc8240_map) |
| 70 | 70 | ||
| 71 | /* | 71 | /* |
| 72 | * The following defines the partition layout of SBC8240 boards. | 72 | * The following defines the partition layout of SBC8240 boards. |
| @@ -125,8 +125,6 @@ static struct mtd_partition sbc8240_fs_partitions [] = { | |||
| 125 | } | 125 | } |
| 126 | }; | 126 | }; |
| 127 | 127 | ||
| 128 | #define NB_OF(x) (sizeof (x) / sizeof (x[0])) | ||
| 129 | |||
| 130 | /* trivial struct to describe partition information */ | 128 | /* trivial struct to describe partition information */ |
| 131 | struct mtd_part_def | 129 | struct mtd_part_def |
| 132 | { | 130 | { |
| @@ -190,10 +188,10 @@ int __init init_sbc8240_mtd (void) | |||
| 190 | #ifdef CONFIG_MTD_PARTITIONS | 188 | #ifdef CONFIG_MTD_PARTITIONS |
| 191 | sbc8240_part_banks[0].mtd_part = sbc8240_uboot_partitions; | 189 | sbc8240_part_banks[0].mtd_part = sbc8240_uboot_partitions; |
| 192 | sbc8240_part_banks[0].type = "static image"; | 190 | sbc8240_part_banks[0].type = "static image"; |
| 193 | sbc8240_part_banks[0].nums = NB_OF(sbc8240_uboot_partitions); | 191 | sbc8240_part_banks[0].nums = ARRAY_SIZE(sbc8240_uboot_partitions); |
| 194 | sbc8240_part_banks[1].mtd_part = sbc8240_fs_partitions; | 192 | sbc8240_part_banks[1].mtd_part = sbc8240_fs_partitions; |
| 195 | sbc8240_part_banks[1].type = "static file system"; | 193 | sbc8240_part_banks[1].type = "static file system"; |
| 196 | sbc8240_part_banks[1].nums = NB_OF(sbc8240_fs_partitions); | 194 | sbc8240_part_banks[1].nums = ARRAY_SIZE(sbc8240_fs_partitions); |
| 197 | 195 | ||
| 198 | for (i = 0; i < NUM_FLASH_BANKS; i++) { | 196 | for (i = 0; i < NUM_FLASH_BANKS; i++) { |
| 199 | 197 | ||
diff --git a/drivers/mtd/maps/sc520cdp.c b/drivers/mtd/maps/sc520cdp.c index ed92afadd8a9..e8c130e1efd3 100644 --- a/drivers/mtd/maps/sc520cdp.c +++ b/drivers/mtd/maps/sc520cdp.c | |||
| @@ -107,7 +107,7 @@ static struct map_info sc520cdp_map[] = { | |||
| 107 | }, | 107 | }, |
| 108 | }; | 108 | }; |
| 109 | 109 | ||
| 110 | #define NUM_FLASH_BANKS (sizeof(sc520cdp_map)/sizeof(struct map_info)) | 110 | #define NUM_FLASH_BANKS ARRAY_SIZE(sc520cdp_map) |
| 111 | 111 | ||
| 112 | static struct mtd_info *mymtd[NUM_FLASH_BANKS]; | 112 | static struct mtd_info *mymtd[NUM_FLASH_BANKS]; |
| 113 | static struct mtd_info *merged_mtd; | 113 | static struct mtd_info *merged_mtd; |
diff --git a/drivers/mtd/maps/scx200_docflash.c b/drivers/mtd/maps/scx200_docflash.c index 2c91dff8bb60..28b8a571a91a 100644 --- a/drivers/mtd/maps/scx200_docflash.c +++ b/drivers/mtd/maps/scx200_docflash.c | |||
| @@ -70,7 +70,7 @@ static struct mtd_partition partition_info[] = { | |||
| 70 | .size = 0x80000 | 70 | .size = 0x80000 |
| 71 | }, | 71 | }, |
| 72 | }; | 72 | }; |
| 73 | #define NUM_PARTITIONS (sizeof(partition_info)/sizeof(partition_info[0])) | 73 | #define NUM_PARTITIONS ARRAY_SIZE(partition_info) |
| 74 | #endif | 74 | #endif |
| 75 | 75 | ||
| 76 | 76 | ||
diff --git a/drivers/mtd/maps/sharpsl-flash.c b/drivers/mtd/maps/sharpsl-flash.c index 999f4bb3d845..12fe53c0d2fc 100644 --- a/drivers/mtd/maps/sharpsl-flash.c +++ b/drivers/mtd/maps/sharpsl-flash.c | |||
| @@ -49,8 +49,6 @@ static struct mtd_partition sharpsl_partitions[1] = { | |||
| 49 | } | 49 | } |
| 50 | }; | 50 | }; |
| 51 | 51 | ||
| 52 | #define NB_OF(x) (sizeof(x)/sizeof(x[0])) | ||
| 53 | |||
| 54 | int __init init_sharpsl(void) | 52 | int __init init_sharpsl(void) |
| 55 | { | 53 | { |
| 56 | struct mtd_partition *parts; | 54 | struct mtd_partition *parts; |
| @@ -92,7 +90,7 @@ int __init init_sharpsl(void) | |||
| 92 | } | 90 | } |
| 93 | 91 | ||
| 94 | parts = sharpsl_partitions; | 92 | parts = sharpsl_partitions; |
| 95 | nb_parts = NB_OF(sharpsl_partitions); | 93 | nb_parts = ARRAY_SIZE(sharpsl_partitions); |
| 96 | 94 | ||
| 97 | printk(KERN_NOTICE "Using %s partision definition\n", part_type); | 95 | printk(KERN_NOTICE "Using %s partision definition\n", part_type); |
| 98 | add_mtd_partitions(mymtd, parts, nb_parts); | 96 | add_mtd_partitions(mymtd, parts, nb_parts); |
diff --git a/drivers/mtd/maps/ts5500_flash.c b/drivers/mtd/maps/ts5500_flash.c index 4b372bcb17f1..a7422c200567 100644 --- a/drivers/mtd/maps/ts5500_flash.c +++ b/drivers/mtd/maps/ts5500_flash.c | |||
| @@ -64,7 +64,7 @@ static struct mtd_partition ts5500_partitions[] = { | |||
| 64 | } | 64 | } |
| 65 | }; | 65 | }; |
| 66 | 66 | ||
| 67 | #define NUM_PARTITIONS (sizeof(ts5500_partitions)/sizeof(struct mtd_partition)) | 67 | #define NUM_PARTITIONS ARRAY_SIZE(ts5500_partitions) |
| 68 | 68 | ||
| 69 | static struct mtd_info *mymtd; | 69 | static struct mtd_info *mymtd; |
| 70 | 70 | ||
diff --git a/drivers/mtd/maps/uclinux.c b/drivers/mtd/maps/uclinux.c index 79d92808b766..f7264dc2ac9b 100644 --- a/drivers/mtd/maps/uclinux.c +++ b/drivers/mtd/maps/uclinux.c | |||
| @@ -37,7 +37,7 @@ struct mtd_partition uclinux_romfs[] = { | |||
| 37 | { .name = "ROMfs" } | 37 | { .name = "ROMfs" } |
| 38 | }; | 38 | }; |
| 39 | 39 | ||
| 40 | #define NUM_PARTITIONS (sizeof(uclinux_romfs) / sizeof(uclinux_romfs[0])) | 40 | #define NUM_PARTITIONS ARRAY_SIZE(uclinux_romfs) |
| 41 | 41 | ||
| 42 | /****************************************************************************/ | 42 | /****************************************************************************/ |
| 43 | 43 | ||
diff --git a/drivers/mtd/maps/vmax301.c b/drivers/mtd/maps/vmax301.c index e0063941c0df..b3e487395435 100644 --- a/drivers/mtd/maps/vmax301.c +++ b/drivers/mtd/maps/vmax301.c | |||
| @@ -182,7 +182,7 @@ int __init init_vmax301(void) | |||
| 182 | } | 182 | } |
| 183 | } | 183 | } |
| 184 | 184 | ||
| 185 | if (!vmax_mtd[1] && !vmax_mtd[2]) { | 185 | if (!vmax_mtd[0] && !vmax_mtd[1]) { |
| 186 | iounmap((void *)iomapadr); | 186 | iounmap((void *)iomapadr); |
| 187 | return -ENXIO; | 187 | return -ENXIO; |
| 188 | } | 188 | } |
diff --git a/drivers/mtd/mtd_blkdevs.c b/drivers/mtd/mtd_blkdevs.c index 840dd66ce2dc..458d3c8ae1ee 100644 --- a/drivers/mtd/mtd_blkdevs.c +++ b/drivers/mtd/mtd_blkdevs.c | |||
| @@ -19,12 +19,12 @@ | |||
| 19 | #include <linux/spinlock.h> | 19 | #include <linux/spinlock.h> |
| 20 | #include <linux/hdreg.h> | 20 | #include <linux/hdreg.h> |
| 21 | #include <linux/init.h> | 21 | #include <linux/init.h> |
| 22 | #include <asm/semaphore.h> | 22 | #include <linux/mutex.h> |
| 23 | #include <asm/uaccess.h> | 23 | #include <asm/uaccess.h> |
| 24 | 24 | ||
| 25 | static LIST_HEAD(blktrans_majors); | 25 | static LIST_HEAD(blktrans_majors); |
| 26 | 26 | ||
| 27 | extern struct semaphore mtd_table_mutex; | 27 | extern struct mutex mtd_table_mutex; |
| 28 | extern struct mtd_info *mtd_table[]; | 28 | extern struct mtd_info *mtd_table[]; |
| 29 | 29 | ||
| 30 | struct mtd_blkcore_priv { | 30 | struct mtd_blkcore_priv { |
| @@ -122,9 +122,9 @@ static int mtd_blktrans_thread(void *arg) | |||
| 122 | 122 | ||
| 123 | spin_unlock_irq(rq->queue_lock); | 123 | spin_unlock_irq(rq->queue_lock); |
| 124 | 124 | ||
| 125 | down(&dev->sem); | 125 | mutex_lock(&dev->lock); |
| 126 | res = do_blktrans_request(tr, dev, req); | 126 | res = do_blktrans_request(tr, dev, req); |
| 127 | up(&dev->sem); | 127 | mutex_unlock(&dev->lock); |
| 128 | 128 | ||
| 129 | spin_lock_irq(rq->queue_lock); | 129 | spin_lock_irq(rq->queue_lock); |
| 130 | 130 | ||
| @@ -235,8 +235,8 @@ int add_mtd_blktrans_dev(struct mtd_blktrans_dev *new) | |||
| 235 | int last_devnum = -1; | 235 | int last_devnum = -1; |
| 236 | struct gendisk *gd; | 236 | struct gendisk *gd; |
| 237 | 237 | ||
| 238 | if (!down_trylock(&mtd_table_mutex)) { | 238 | if (!!mutex_trylock(&mtd_table_mutex)) { |
| 239 | up(&mtd_table_mutex); | 239 | mutex_unlock(&mtd_table_mutex); |
| 240 | BUG(); | 240 | BUG(); |
| 241 | } | 241 | } |
| 242 | 242 | ||
| @@ -267,7 +267,7 @@ int add_mtd_blktrans_dev(struct mtd_blktrans_dev *new) | |||
| 267 | return -EBUSY; | 267 | return -EBUSY; |
| 268 | } | 268 | } |
| 269 | 269 | ||
| 270 | init_MUTEX(&new->sem); | 270 | mutex_init(&new->lock); |
| 271 | list_add_tail(&new->list, &tr->devs); | 271 | list_add_tail(&new->list, &tr->devs); |
| 272 | added: | 272 | added: |
| 273 | if (!tr->writesect) | 273 | if (!tr->writesect) |
| @@ -313,8 +313,8 @@ int add_mtd_blktrans_dev(struct mtd_blktrans_dev *new) | |||
| 313 | 313 | ||
| 314 | int del_mtd_blktrans_dev(struct mtd_blktrans_dev *old) | 314 | int del_mtd_blktrans_dev(struct mtd_blktrans_dev *old) |
| 315 | { | 315 | { |
| 316 | if (!down_trylock(&mtd_table_mutex)) { | 316 | if (!!mutex_trylock(&mtd_table_mutex)) { |
| 317 | up(&mtd_table_mutex); | 317 | mutex_unlock(&mtd_table_mutex); |
| 318 | BUG(); | 318 | BUG(); |
| 319 | } | 319 | } |
| 320 | 320 | ||
| @@ -378,14 +378,14 @@ int register_mtd_blktrans(struct mtd_blktrans_ops *tr) | |||
| 378 | 378 | ||
| 379 | memset(tr->blkcore_priv, 0, sizeof(*tr->blkcore_priv)); | 379 | memset(tr->blkcore_priv, 0, sizeof(*tr->blkcore_priv)); |
| 380 | 380 | ||
| 381 | down(&mtd_table_mutex); | 381 | mutex_lock(&mtd_table_mutex); |
| 382 | 382 | ||
| 383 | ret = register_blkdev(tr->major, tr->name); | 383 | ret = register_blkdev(tr->major, tr->name); |
| 384 | if (ret) { | 384 | if (ret) { |
| 385 | printk(KERN_WARNING "Unable to register %s block device on major %d: %d\n", | 385 | printk(KERN_WARNING "Unable to register %s block device on major %d: %d\n", |
| 386 | tr->name, tr->major, ret); | 386 | tr->name, tr->major, ret); |
| 387 | kfree(tr->blkcore_priv); | 387 | kfree(tr->blkcore_priv); |
| 388 | up(&mtd_table_mutex); | 388 | mutex_unlock(&mtd_table_mutex); |
| 389 | return ret; | 389 | return ret; |
| 390 | } | 390 | } |
| 391 | spin_lock_init(&tr->blkcore_priv->queue_lock); | 391 | spin_lock_init(&tr->blkcore_priv->queue_lock); |
| @@ -396,7 +396,7 @@ int register_mtd_blktrans(struct mtd_blktrans_ops *tr) | |||
| 396 | if (!tr->blkcore_priv->rq) { | 396 | if (!tr->blkcore_priv->rq) { |
| 397 | unregister_blkdev(tr->major, tr->name); | 397 | unregister_blkdev(tr->major, tr->name); |
| 398 | kfree(tr->blkcore_priv); | 398 | kfree(tr->blkcore_priv); |
| 399 | up(&mtd_table_mutex); | 399 | mutex_unlock(&mtd_table_mutex); |
| 400 | return -ENOMEM; | 400 | return -ENOMEM; |
| 401 | } | 401 | } |
| 402 | 402 | ||
| @@ -407,7 +407,7 @@ int register_mtd_blktrans(struct mtd_blktrans_ops *tr) | |||
| 407 | blk_cleanup_queue(tr->blkcore_priv->rq); | 407 | blk_cleanup_queue(tr->blkcore_priv->rq); |
| 408 | unregister_blkdev(tr->major, tr->name); | 408 | unregister_blkdev(tr->major, tr->name); |
| 409 | kfree(tr->blkcore_priv); | 409 | kfree(tr->blkcore_priv); |
| 410 | up(&mtd_table_mutex); | 410 | mutex_unlock(&mtd_table_mutex); |
| 411 | return ret; | 411 | return ret; |
| 412 | } | 412 | } |
| 413 | 413 | ||
| @@ -419,7 +419,7 @@ int register_mtd_blktrans(struct mtd_blktrans_ops *tr) | |||
| 419 | tr->add_mtd(tr, mtd_table[i]); | 419 | tr->add_mtd(tr, mtd_table[i]); |
| 420 | } | 420 | } |
| 421 | 421 | ||
| 422 | up(&mtd_table_mutex); | 422 | mutex_unlock(&mtd_table_mutex); |
| 423 | 423 | ||
| 424 | return 0; | 424 | return 0; |
| 425 | } | 425 | } |
| @@ -428,7 +428,7 @@ int deregister_mtd_blktrans(struct mtd_blktrans_ops *tr) | |||
| 428 | { | 428 | { |
| 429 | struct list_head *this, *next; | 429 | struct list_head *this, *next; |
| 430 | 430 | ||
| 431 | down(&mtd_table_mutex); | 431 | mutex_lock(&mtd_table_mutex); |
| 432 | 432 | ||
| 433 | /* Clean up the kernel thread */ | 433 | /* Clean up the kernel thread */ |
| 434 | tr->blkcore_priv->exiting = 1; | 434 | tr->blkcore_priv->exiting = 1; |
| @@ -446,7 +446,7 @@ int deregister_mtd_blktrans(struct mtd_blktrans_ops *tr) | |||
| 446 | blk_cleanup_queue(tr->blkcore_priv->rq); | 446 | blk_cleanup_queue(tr->blkcore_priv->rq); |
| 447 | unregister_blkdev(tr->major, tr->name); | 447 | unregister_blkdev(tr->major, tr->name); |
| 448 | 448 | ||
| 449 | up(&mtd_table_mutex); | 449 | mutex_unlock(&mtd_table_mutex); |
| 450 | 450 | ||
| 451 | kfree(tr->blkcore_priv); | 451 | kfree(tr->blkcore_priv); |
| 452 | 452 | ||
diff --git a/drivers/mtd/mtdblock.c b/drivers/mtd/mtdblock.c index e84756644fd1..2cef280e388c 100644 --- a/drivers/mtd/mtdblock.c +++ b/drivers/mtd/mtdblock.c | |||
| @@ -19,11 +19,13 @@ | |||
| 19 | 19 | ||
| 20 | #include <linux/mtd/mtd.h> | 20 | #include <linux/mtd/mtd.h> |
| 21 | #include <linux/mtd/blktrans.h> | 21 | #include <linux/mtd/blktrans.h> |
| 22 | #include <linux/mutex.h> | ||
| 23 | |||
| 22 | 24 | ||
| 23 | static struct mtdblk_dev { | 25 | static struct mtdblk_dev { |
| 24 | struct mtd_info *mtd; | 26 | struct mtd_info *mtd; |
| 25 | int count; | 27 | int count; |
| 26 | struct semaphore cache_sem; | 28 | struct mutex cache_mutex; |
| 27 | unsigned char *cache_data; | 29 | unsigned char *cache_data; |
| 28 | unsigned long cache_offset; | 30 | unsigned long cache_offset; |
| 29 | unsigned int cache_size; | 31 | unsigned int cache_size; |
| @@ -284,7 +286,7 @@ static int mtdblock_open(struct mtd_blktrans_dev *mbd) | |||
| 284 | mtdblk->count = 1; | 286 | mtdblk->count = 1; |
| 285 | mtdblk->mtd = mtd; | 287 | mtdblk->mtd = mtd; |
| 286 | 288 | ||
| 287 | init_MUTEX (&mtdblk->cache_sem); | 289 | mutex_init(&mtdblk->cache_mutex); |
| 288 | mtdblk->cache_state = STATE_EMPTY; | 290 | mtdblk->cache_state = STATE_EMPTY; |
| 289 | if ((mtdblk->mtd->flags & MTD_CAP_RAM) != MTD_CAP_RAM && | 291 | if ((mtdblk->mtd->flags & MTD_CAP_RAM) != MTD_CAP_RAM && |
| 290 | mtdblk->mtd->erasesize) { | 292 | mtdblk->mtd->erasesize) { |
| @@ -306,9 +308,9 @@ static int mtdblock_release(struct mtd_blktrans_dev *mbd) | |||
| 306 | 308 | ||
| 307 | DEBUG(MTD_DEBUG_LEVEL1, "mtdblock_release\n"); | 309 | DEBUG(MTD_DEBUG_LEVEL1, "mtdblock_release\n"); |
| 308 | 310 | ||
| 309 | down(&mtdblk->cache_sem); | 311 | mutex_lock(&mtdblk->cache_mutex); |
| 310 | write_cached_data(mtdblk); | 312 | write_cached_data(mtdblk); |
| 311 | up(&mtdblk->cache_sem); | 313 | mutex_unlock(&mtdblk->cache_mutex); |
| 312 | 314 | ||
| 313 | if (!--mtdblk->count) { | 315 | if (!--mtdblk->count) { |
| 314 | /* It was the last usage. Free the device */ | 316 | /* It was the last usage. Free the device */ |
| @@ -327,9 +329,9 @@ static int mtdblock_flush(struct mtd_blktrans_dev *dev) | |||
| 327 | { | 329 | { |
| 328 | struct mtdblk_dev *mtdblk = mtdblks[dev->devnum]; | 330 | struct mtdblk_dev *mtdblk = mtdblks[dev->devnum]; |
| 329 | 331 | ||
| 330 | down(&mtdblk->cache_sem); | 332 | mutex_lock(&mtdblk->cache_mutex); |
| 331 | write_cached_data(mtdblk); | 333 | write_cached_data(mtdblk); |
| 332 | up(&mtdblk->cache_sem); | 334 | mutex_unlock(&mtdblk->cache_mutex); |
| 333 | 335 | ||
| 334 | if (mtdblk->mtd->sync) | 336 | if (mtdblk->mtd->sync) |
| 335 | mtdblk->mtd->sync(mtdblk->mtd); | 337 | mtdblk->mtd->sync(mtdblk->mtd); |
diff --git a/drivers/mtd/mtdcore.c b/drivers/mtd/mtdcore.c index dade02ab0687..9905870f56e5 100644 --- a/drivers/mtd/mtdcore.c +++ b/drivers/mtd/mtdcore.c | |||
| @@ -19,15 +19,13 @@ | |||
| 19 | #include <linux/ioctl.h> | 19 | #include <linux/ioctl.h> |
| 20 | #include <linux/init.h> | 20 | #include <linux/init.h> |
| 21 | #include <linux/mtd/compatmac.h> | 21 | #include <linux/mtd/compatmac.h> |
| 22 | #ifdef CONFIG_PROC_FS | ||
| 23 | #include <linux/proc_fs.h> | 22 | #include <linux/proc_fs.h> |
| 24 | #endif | ||
| 25 | 23 | ||
| 26 | #include <linux/mtd/mtd.h> | 24 | #include <linux/mtd/mtd.h> |
| 27 | 25 | ||
| 28 | /* These are exported solely for the purpose of mtd_blkdevs.c. You | 26 | /* These are exported solely for the purpose of mtd_blkdevs.c. You |
| 29 | should not use them for _anything_ else */ | 27 | should not use them for _anything_ else */ |
| 30 | DECLARE_MUTEX(mtd_table_mutex); | 28 | DEFINE_MUTEX(mtd_table_mutex); |
| 31 | struct mtd_info *mtd_table[MAX_MTD_DEVICES]; | 29 | struct mtd_info *mtd_table[MAX_MTD_DEVICES]; |
| 32 | 30 | ||
| 33 | EXPORT_SYMBOL_GPL(mtd_table_mutex); | 31 | EXPORT_SYMBOL_GPL(mtd_table_mutex); |
| @@ -49,7 +47,7 @@ int add_mtd_device(struct mtd_info *mtd) | |||
| 49 | { | 47 | { |
| 50 | int i; | 48 | int i; |
| 51 | 49 | ||
| 52 | down(&mtd_table_mutex); | 50 | mutex_lock(&mtd_table_mutex); |
| 53 | 51 | ||
| 54 | for (i=0; i < MAX_MTD_DEVICES; i++) | 52 | for (i=0; i < MAX_MTD_DEVICES; i++) |
| 55 | if (!mtd_table[i]) { | 53 | if (!mtd_table[i]) { |
| @@ -67,7 +65,7 @@ int add_mtd_device(struct mtd_info *mtd) | |||
| 67 | not->add(mtd); | 65 | not->add(mtd); |
| 68 | } | 66 | } |
| 69 | 67 | ||
| 70 | up(&mtd_table_mutex); | 68 | mutex_unlock(&mtd_table_mutex); |
| 71 | /* We _know_ we aren't being removed, because | 69 | /* We _know_ we aren't being removed, because |
| 72 | our caller is still holding us here. So none | 70 | our caller is still holding us here. So none |
| 73 | of this try_ nonsense, and no bitching about it | 71 | of this try_ nonsense, and no bitching about it |
| @@ -76,7 +74,7 @@ int add_mtd_device(struct mtd_info *mtd) | |||
| 76 | return 0; | 74 | return 0; |
| 77 | } | 75 | } |
| 78 | 76 | ||
| 79 | up(&mtd_table_mutex); | 77 | mutex_unlock(&mtd_table_mutex); |
| 80 | return 1; | 78 | return 1; |
| 81 | } | 79 | } |
| 82 | 80 | ||
| @@ -94,7 +92,7 @@ int del_mtd_device (struct mtd_info *mtd) | |||
| 94 | { | 92 | { |
| 95 | int ret; | 93 | int ret; |
| 96 | 94 | ||
| 97 | down(&mtd_table_mutex); | 95 | mutex_lock(&mtd_table_mutex); |
| 98 | 96 | ||
| 99 | if (mtd_table[mtd->index] != mtd) { | 97 | if (mtd_table[mtd->index] != mtd) { |
| 100 | ret = -ENODEV; | 98 | ret = -ENODEV; |
| @@ -118,7 +116,7 @@ int del_mtd_device (struct mtd_info *mtd) | |||
| 118 | ret = 0; | 116 | ret = 0; |
| 119 | } | 117 | } |
| 120 | 118 | ||
| 121 | up(&mtd_table_mutex); | 119 | mutex_unlock(&mtd_table_mutex); |
| 122 | return ret; | 120 | return ret; |
| 123 | } | 121 | } |
| 124 | 122 | ||
| @@ -135,7 +133,7 @@ void register_mtd_user (struct mtd_notifier *new) | |||
| 135 | { | 133 | { |
| 136 | int i; | 134 | int i; |
| 137 | 135 | ||
| 138 | down(&mtd_table_mutex); | 136 | mutex_lock(&mtd_table_mutex); |
| 139 | 137 | ||
| 140 | list_add(&new->list, &mtd_notifiers); | 138 | list_add(&new->list, &mtd_notifiers); |
| 141 | 139 | ||
| @@ -145,7 +143,7 @@ void register_mtd_user (struct mtd_notifier *new) | |||
| 145 | if (mtd_table[i]) | 143 | if (mtd_table[i]) |
| 146 | new->add(mtd_table[i]); | 144 | new->add(mtd_table[i]); |
| 147 | 145 | ||
| 148 | up(&mtd_table_mutex); | 146 | mutex_unlock(&mtd_table_mutex); |
| 149 | } | 147 | } |
| 150 | 148 | ||
| 151 | /** | 149 | /** |
| @@ -162,7 +160,7 @@ int unregister_mtd_user (struct mtd_notifier *old) | |||
| 162 | { | 160 | { |
| 163 | int i; | 161 | int i; |
| 164 | 162 | ||
| 165 | down(&mtd_table_mutex); | 163 | mutex_lock(&mtd_table_mutex); |
| 166 | 164 | ||
| 167 | module_put(THIS_MODULE); | 165 | module_put(THIS_MODULE); |
| 168 | 166 | ||
| @@ -171,7 +169,7 @@ int unregister_mtd_user (struct mtd_notifier *old) | |||
| 171 | old->remove(mtd_table[i]); | 169 | old->remove(mtd_table[i]); |
| 172 | 170 | ||
| 173 | list_del(&old->list); | 171 | list_del(&old->list); |
| 174 | up(&mtd_table_mutex); | 172 | mutex_unlock(&mtd_table_mutex); |
| 175 | return 0; | 173 | return 0; |
| 176 | } | 174 | } |
| 177 | 175 | ||
| @@ -193,7 +191,7 @@ struct mtd_info *get_mtd_device(struct mtd_info *mtd, int num) | |||
| 193 | struct mtd_info *ret = NULL; | 191 | struct mtd_info *ret = NULL; |
| 194 | int i; | 192 | int i; |
| 195 | 193 | ||
| 196 | down(&mtd_table_mutex); | 194 | mutex_lock(&mtd_table_mutex); |
| 197 | 195 | ||
| 198 | if (num == -1) { | 196 | if (num == -1) { |
| 199 | for (i=0; i< MAX_MTD_DEVICES; i++) | 197 | for (i=0; i< MAX_MTD_DEVICES; i++) |
| @@ -211,7 +209,7 @@ struct mtd_info *get_mtd_device(struct mtd_info *mtd, int num) | |||
| 211 | if (ret) | 209 | if (ret) |
| 212 | ret->usecount++; | 210 | ret->usecount++; |
| 213 | 211 | ||
| 214 | up(&mtd_table_mutex); | 212 | mutex_unlock(&mtd_table_mutex); |
| 215 | return ret; | 213 | return ret; |
| 216 | } | 214 | } |
| 217 | 215 | ||
| @@ -219,9 +217,9 @@ void put_mtd_device(struct mtd_info *mtd) | |||
| 219 | { | 217 | { |
| 220 | int c; | 218 | int c; |
| 221 | 219 | ||
| 222 | down(&mtd_table_mutex); | 220 | mutex_lock(&mtd_table_mutex); |
| 223 | c = --mtd->usecount; | 221 | c = --mtd->usecount; |
| 224 | up(&mtd_table_mutex); | 222 | mutex_unlock(&mtd_table_mutex); |
| 225 | BUG_ON(c < 0); | 223 | BUG_ON(c < 0); |
| 226 | 224 | ||
| 227 | module_put(mtd->owner); | 225 | module_put(mtd->owner); |
| @@ -296,10 +294,11 @@ EXPORT_SYMBOL(unregister_mtd_user); | |||
| 296 | EXPORT_SYMBOL(default_mtd_writev); | 294 | EXPORT_SYMBOL(default_mtd_writev); |
| 297 | EXPORT_SYMBOL(default_mtd_readv); | 295 | EXPORT_SYMBOL(default_mtd_readv); |
| 298 | 296 | ||
| 297 | #ifdef CONFIG_PROC_FS | ||
| 298 | |||
| 299 | /*====================================================================*/ | 299 | /*====================================================================*/ |
| 300 | /* Support for /proc/mtd */ | 300 | /* Support for /proc/mtd */ |
| 301 | 301 | ||
| 302 | #ifdef CONFIG_PROC_FS | ||
| 303 | static struct proc_dir_entry *proc_mtd; | 302 | static struct proc_dir_entry *proc_mtd; |
| 304 | 303 | ||
| 305 | static inline int mtd_proc_info (char *buf, int i) | 304 | static inline int mtd_proc_info (char *buf, int i) |
| @@ -319,7 +318,7 @@ static int mtd_read_proc (char *page, char **start, off_t off, int count, | |||
| 319 | int len, l, i; | 318 | int len, l, i; |
| 320 | off_t begin = 0; | 319 | off_t begin = 0; |
| 321 | 320 | ||
| 322 | down(&mtd_table_mutex); | 321 | mutex_lock(&mtd_table_mutex); |
| 323 | 322 | ||
| 324 | len = sprintf(page, "dev: size erasesize name\n"); | 323 | len = sprintf(page, "dev: size erasesize name\n"); |
| 325 | for (i=0; i< MAX_MTD_DEVICES; i++) { | 324 | for (i=0; i< MAX_MTD_DEVICES; i++) { |
| @@ -337,38 +336,34 @@ static int mtd_read_proc (char *page, char **start, off_t off, int count, | |||
| 337 | *eof = 1; | 336 | *eof = 1; |
| 338 | 337 | ||
| 339 | done: | 338 | done: |
| 340 | up(&mtd_table_mutex); | 339 | mutex_unlock(&mtd_table_mutex); |
| 341 | if (off >= len+begin) | 340 | if (off >= len+begin) |
| 342 | return 0; | 341 | return 0; |
| 343 | *start = page + (off-begin); | 342 | *start = page + (off-begin); |
| 344 | return ((count < begin+len-off) ? count : begin+len-off); | 343 | return ((count < begin+len-off) ? count : begin+len-off); |
| 345 | } | 344 | } |
| 346 | 345 | ||
| 347 | #endif /* CONFIG_PROC_FS */ | ||
| 348 | |||
| 349 | /*====================================================================*/ | 346 | /*====================================================================*/ |
| 350 | /* Init code */ | 347 | /* Init code */ |
| 351 | 348 | ||
| 352 | static int __init init_mtd(void) | 349 | static int __init init_mtd(void) |
| 353 | { | 350 | { |
| 354 | #ifdef CONFIG_PROC_FS | ||
| 355 | if ((proc_mtd = create_proc_entry( "mtd", 0, NULL ))) | 351 | if ((proc_mtd = create_proc_entry( "mtd", 0, NULL ))) |
| 356 | proc_mtd->read_proc = mtd_read_proc; | 352 | proc_mtd->read_proc = mtd_read_proc; |
| 357 | #endif | ||
| 358 | return 0; | 353 | return 0; |
| 359 | } | 354 | } |
| 360 | 355 | ||
| 361 | static void __exit cleanup_mtd(void) | 356 | static void __exit cleanup_mtd(void) |
| 362 | { | 357 | { |
| 363 | #ifdef CONFIG_PROC_FS | ||
| 364 | if (proc_mtd) | 358 | if (proc_mtd) |
| 365 | remove_proc_entry( "mtd", NULL); | 359 | remove_proc_entry( "mtd", NULL); |
| 366 | #endif | ||
| 367 | } | 360 | } |
| 368 | 361 | ||
| 369 | module_init(init_mtd); | 362 | module_init(init_mtd); |
| 370 | module_exit(cleanup_mtd); | 363 | module_exit(cleanup_mtd); |
| 371 | 364 | ||
| 365 | #endif /* CONFIG_PROC_FS */ | ||
| 366 | |||
| 372 | 367 | ||
| 373 | MODULE_LICENSE("GPL"); | 368 | MODULE_LICENSE("GPL"); |
| 374 | MODULE_AUTHOR("David Woodhouse <dwmw2@infradead.org>"); | 369 | MODULE_AUTHOR("David Woodhouse <dwmw2@infradead.org>"); |
diff --git a/drivers/mtd/nand/Kconfig b/drivers/mtd/nand/Kconfig index 1fc4c134d939..cfe288a6e853 100644 --- a/drivers/mtd/nand/Kconfig +++ b/drivers/mtd/nand/Kconfig | |||
| @@ -178,17 +178,16 @@ config MTD_NAND_DISKONCHIP_BBTWRITE | |||
| 178 | Even if you leave this disabled, you can enable BBT writes at module | 178 | Even if you leave this disabled, you can enable BBT writes at module |
| 179 | load time (assuming you build diskonchip as a module) with the module | 179 | load time (assuming you build diskonchip as a module) with the module |
| 180 | parameter "inftl_bbt_write=1". | 180 | parameter "inftl_bbt_write=1". |
| 181 | |||
| 182 | config MTD_NAND_SHARPSL | ||
| 183 | bool "Support for NAND Flash on Sharp SL Series (C7xx + others)" | ||
| 184 | depends on MTD_NAND && ARCH_PXA | ||
| 185 | |||
| 186 | config MTD_NAND_NANDSIM | ||
| 187 | bool "Support for NAND Flash Simulator" | ||
| 188 | depends on MTD_NAND && MTD_PARTITIONS | ||
| 189 | 181 | ||
| 182 | config MTD_NAND_SHARPSL | ||
| 183 | tristate "Support for NAND Flash on Sharp SL Series (C7xx + others)" | ||
| 184 | depends on MTD_NAND && ARCH_PXA | ||
| 185 | |||
| 186 | config MTD_NAND_NANDSIM | ||
| 187 | tristate "Support for NAND Flash Simulator" | ||
| 188 | depends on MTD_NAND && MTD_PARTITIONS | ||
| 190 | help | 189 | help |
| 191 | The simulator may simulate verious NAND flash chips for the | 190 | The simulator may simulate verious NAND flash chips for the |
| 192 | MTD nand layer. | 191 | MTD nand layer. |
| 193 | 192 | ||
| 194 | endmenu | 193 | endmenu |
diff --git a/drivers/mtd/nand/au1550nd.c b/drivers/mtd/nand/au1550nd.c index 201e1362da14..bde3550910a2 100644 --- a/drivers/mtd/nand/au1550nd.c +++ b/drivers/mtd/nand/au1550nd.c | |||
| @@ -55,8 +55,6 @@ static const struct mtd_partition partition_info[] = { | |||
| 55 | .size = MTDPART_SIZ_FULL | 55 | .size = MTDPART_SIZ_FULL |
| 56 | } | 56 | } |
| 57 | }; | 57 | }; |
| 58 | #define NB_OF(x) (sizeof(x)/sizeof(x[0])) | ||
| 59 | |||
| 60 | 58 | ||
| 61 | /** | 59 | /** |
| 62 | * au_read_byte - read one byte from the chip | 60 | * au_read_byte - read one byte from the chip |
| @@ -462,7 +460,7 @@ int __init au1xxx_nand_init (void) | |||
| 462 | } | 460 | } |
| 463 | 461 | ||
| 464 | /* Register the partitions */ | 462 | /* Register the partitions */ |
| 465 | add_mtd_partitions(au1550_mtd, partition_info, NB_OF(partition_info)); | 463 | add_mtd_partitions(au1550_mtd, partition_info, ARRAY_SIZE(partition_info)); |
| 466 | 464 | ||
| 467 | return 0; | 465 | return 0; |
| 468 | 466 | ||
diff --git a/drivers/mtd/nand/nand_base.c b/drivers/mtd/nand/nand_base.c index 5d222460b42a..95e96fa1fceb 100644 --- a/drivers/mtd/nand/nand_base.c +++ b/drivers/mtd/nand/nand_base.c | |||
| @@ -80,6 +80,7 @@ | |||
| 80 | #include <linux/mtd/compatmac.h> | 80 | #include <linux/mtd/compatmac.h> |
| 81 | #include <linux/interrupt.h> | 81 | #include <linux/interrupt.h> |
| 82 | #include <linux/bitops.h> | 82 | #include <linux/bitops.h> |
| 83 | #include <linux/leds.h> | ||
| 83 | #include <asm/io.h> | 84 | #include <asm/io.h> |
| 84 | 85 | ||
| 85 | #ifdef CONFIG_MTD_PARTITIONS | 86 | #ifdef CONFIG_MTD_PARTITIONS |
| @@ -515,6 +516,8 @@ static int nand_block_checkbad (struct mtd_info *mtd, loff_t ofs, int getchip, i | |||
| 515 | return nand_isbad_bbt (mtd, ofs, allowbbt); | 516 | return nand_isbad_bbt (mtd, ofs, allowbbt); |
| 516 | } | 517 | } |
| 517 | 518 | ||
| 519 | DEFINE_LED_TRIGGER(nand_led_trigger); | ||
| 520 | |||
| 518 | /* | 521 | /* |
| 519 | * Wait for the ready pin, after a command | 522 | * Wait for the ready pin, after a command |
| 520 | * The timeout is catched later. | 523 | * The timeout is catched later. |
| @@ -524,12 +527,14 @@ static void nand_wait_ready(struct mtd_info *mtd) | |||
| 524 | struct nand_chip *this = mtd->priv; | 527 | struct nand_chip *this = mtd->priv; |
| 525 | unsigned long timeo = jiffies + 2; | 528 | unsigned long timeo = jiffies + 2; |
| 526 | 529 | ||
| 530 | led_trigger_event(nand_led_trigger, LED_FULL); | ||
| 527 | /* wait until command is processed or timeout occures */ | 531 | /* wait until command is processed or timeout occures */ |
| 528 | do { | 532 | do { |
| 529 | if (this->dev_ready(mtd)) | 533 | if (this->dev_ready(mtd)) |
| 530 | return; | 534 | break; |
| 531 | touch_softlockup_watchdog(); | 535 | touch_softlockup_watchdog(); |
| 532 | } while (time_before(jiffies, timeo)); | 536 | } while (time_before(jiffies, timeo)); |
| 537 | led_trigger_event(nand_led_trigger, LED_OFF); | ||
| 533 | } | 538 | } |
| 534 | 539 | ||
| 535 | /** | 540 | /** |
| @@ -817,6 +822,8 @@ static int nand_wait(struct mtd_info *mtd, struct nand_chip *this, int state) | |||
| 817 | else | 822 | else |
| 818 | timeo += (HZ * 20) / 1000; | 823 | timeo += (HZ * 20) / 1000; |
| 819 | 824 | ||
| 825 | led_trigger_event(nand_led_trigger, LED_FULL); | ||
| 826 | |||
| 820 | /* Apply this short delay always to ensure that we do wait tWB in | 827 | /* Apply this short delay always to ensure that we do wait tWB in |
| 821 | * any case on any machine. */ | 828 | * any case on any machine. */ |
| 822 | ndelay (100); | 829 | ndelay (100); |
| @@ -840,6 +847,8 @@ static int nand_wait(struct mtd_info *mtd, struct nand_chip *this, int state) | |||
| 840 | } | 847 | } |
| 841 | cond_resched(); | 848 | cond_resched(); |
| 842 | } | 849 | } |
| 850 | led_trigger_event(nand_led_trigger, LED_OFF); | ||
| 851 | |||
| 843 | status = (int) this->read_byte(mtd); | 852 | status = (int) this->read_byte(mtd); |
| 844 | return status; | 853 | return status; |
| 845 | } | 854 | } |
| @@ -2724,6 +2733,21 @@ void nand_release (struct mtd_info *mtd) | |||
| 2724 | EXPORT_SYMBOL_GPL (nand_scan); | 2733 | EXPORT_SYMBOL_GPL (nand_scan); |
| 2725 | EXPORT_SYMBOL_GPL (nand_release); | 2734 | EXPORT_SYMBOL_GPL (nand_release); |
| 2726 | 2735 | ||
| 2736 | |||
| 2737 | static int __init nand_base_init(void) | ||
| 2738 | { | ||
| 2739 | led_trigger_register_simple("nand-disk", &nand_led_trigger); | ||
| 2740 | return 0; | ||
| 2741 | } | ||
| 2742 | |||
| 2743 | static void __exit nand_base_exit(void) | ||
| 2744 | { | ||
| 2745 | led_trigger_unregister_simple(nand_led_trigger); | ||
| 2746 | } | ||
| 2747 | |||
| 2748 | module_init(nand_base_init); | ||
| 2749 | module_exit(nand_base_exit); | ||
| 2750 | |||
| 2727 | MODULE_LICENSE ("GPL"); | 2751 | MODULE_LICENSE ("GPL"); |
| 2728 | MODULE_AUTHOR ("Steven J. Hill <sjhill@realitydiluted.com>, Thomas Gleixner <tglx@linutronix.de>"); | 2752 | MODULE_AUTHOR ("Steven J. Hill <sjhill@realitydiluted.com>, Thomas Gleixner <tglx@linutronix.de>"); |
| 2729 | MODULE_DESCRIPTION ("Generic NAND flash driver code"); | 2753 | MODULE_DESCRIPTION ("Generic NAND flash driver code"); |
diff --git a/drivers/mtd/redboot.c b/drivers/mtd/redboot.c index 8815c8dbef2d..c077d2ec9cdd 100644 --- a/drivers/mtd/redboot.c +++ b/drivers/mtd/redboot.c | |||
| @@ -85,10 +85,6 @@ static int parse_redboot_partitions(struct mtd_info *master, | |||
| 85 | 85 | ||
| 86 | numslots = (master->erasesize / sizeof(struct fis_image_desc)); | 86 | numslots = (master->erasesize / sizeof(struct fis_image_desc)); |
| 87 | for (i = 0; i < numslots; i++) { | 87 | for (i = 0; i < numslots; i++) { |
| 88 | if (buf[i].name[0] == 0xff) { | ||
| 89 | i = numslots; | ||
| 90 | break; | ||
| 91 | } | ||
| 92 | if (!memcmp(buf[i].name, "FIS directory", 14)) { | 88 | if (!memcmp(buf[i].name, "FIS directory", 14)) { |
| 93 | /* This is apparently the FIS directory entry for the | 89 | /* This is apparently the FIS directory entry for the |
| 94 | * FIS directory itself. The FIS directory size is | 90 | * FIS directory itself. The FIS directory size is |
| @@ -128,7 +124,7 @@ static int parse_redboot_partitions(struct mtd_info *master, | |||
| 128 | struct fis_list *new_fl, **prev; | 124 | struct fis_list *new_fl, **prev; |
| 129 | 125 | ||
| 130 | if (buf[i].name[0] == 0xff) | 126 | if (buf[i].name[0] == 0xff) |
| 131 | break; | 127 | continue; |
| 132 | if (!redboot_checksum(&buf[i])) | 128 | if (!redboot_checksum(&buf[i])) |
| 133 | break; | 129 | break; |
| 134 | 130 | ||
diff --git a/drivers/net/3c59x.c b/drivers/net/3c59x.c index 70f63891b19c..274b0138d442 100644 --- a/drivers/net/3c59x.c +++ b/drivers/net/3c59x.c | |||
| @@ -788,7 +788,7 @@ struct vortex_private { | |||
| 788 | int options; /* User-settable misc. driver options. */ | 788 | int options; /* User-settable misc. driver options. */ |
| 789 | unsigned int media_override:4, /* Passed-in media type. */ | 789 | unsigned int media_override:4, /* Passed-in media type. */ |
| 790 | default_media:4, /* Read from the EEPROM/Wn3_Config. */ | 790 | default_media:4, /* Read from the EEPROM/Wn3_Config. */ |
| 791 | full_duplex:1, force_fd:1, autoselect:1, | 791 | full_duplex:1, autoselect:1, |
| 792 | bus_master:1, /* Vortex can only do a fragment bus-m. */ | 792 | bus_master:1, /* Vortex can only do a fragment bus-m. */ |
| 793 | full_bus_master_tx:1, full_bus_master_rx:2, /* Boomerang */ | 793 | full_bus_master_tx:1, full_bus_master_rx:2, /* Boomerang */ |
| 794 | flow_ctrl:1, /* Use 802.3x flow control (PAUSE only) */ | 794 | flow_ctrl:1, /* Use 802.3x flow control (PAUSE only) */ |
| @@ -1633,12 +1633,6 @@ vortex_set_duplex(struct net_device *dev) | |||
| 1633 | ((vp->full_duplex && vp->flow_ctrl && vp->partner_flow_ctrl) ? | 1633 | ((vp->full_duplex && vp->flow_ctrl && vp->partner_flow_ctrl) ? |
| 1634 | 0x100 : 0), | 1634 | 0x100 : 0), |
| 1635 | ioaddr + Wn3_MAC_Ctrl); | 1635 | ioaddr + Wn3_MAC_Ctrl); |
| 1636 | |||
| 1637 | issue_and_wait(dev, TxReset); | ||
| 1638 | /* | ||
| 1639 | * Don't reset the PHY - that upsets autonegotiation during DHCP operations. | ||
| 1640 | */ | ||
| 1641 | issue_and_wait(dev, RxReset|0x04); | ||
| 1642 | } | 1636 | } |
| 1643 | 1637 | ||
| 1644 | static void vortex_check_media(struct net_device *dev, unsigned int init) | 1638 | static void vortex_check_media(struct net_device *dev, unsigned int init) |
| @@ -1663,7 +1657,7 @@ vortex_up(struct net_device *dev) | |||
| 1663 | struct vortex_private *vp = netdev_priv(dev); | 1657 | struct vortex_private *vp = netdev_priv(dev); |
| 1664 | void __iomem *ioaddr = vp->ioaddr; | 1658 | void __iomem *ioaddr = vp->ioaddr; |
| 1665 | unsigned int config; | 1659 | unsigned int config; |
| 1666 | int i; | 1660 | int i, mii_reg1, mii_reg5; |
| 1667 | 1661 | ||
| 1668 | if (VORTEX_PCI(vp)) { | 1662 | if (VORTEX_PCI(vp)) { |
| 1669 | pci_set_power_state(VORTEX_PCI(vp), PCI_D0); /* Go active */ | 1663 | pci_set_power_state(VORTEX_PCI(vp), PCI_D0); /* Go active */ |
| @@ -1723,14 +1717,23 @@ vortex_up(struct net_device *dev) | |||
| 1723 | printk(KERN_DEBUG "vortex_up(): writing 0x%x to InternalConfig\n", config); | 1717 | printk(KERN_DEBUG "vortex_up(): writing 0x%x to InternalConfig\n", config); |
| 1724 | iowrite32(config, ioaddr + Wn3_Config); | 1718 | iowrite32(config, ioaddr + Wn3_Config); |
| 1725 | 1719 | ||
| 1726 | netif_carrier_off(dev); | ||
| 1727 | if (dev->if_port == XCVR_MII || dev->if_port == XCVR_NWAY) { | 1720 | if (dev->if_port == XCVR_MII || dev->if_port == XCVR_NWAY) { |
| 1728 | EL3WINDOW(4); | 1721 | EL3WINDOW(4); |
| 1722 | mii_reg1 = mdio_read(dev, vp->phys[0], MII_BMSR); | ||
| 1723 | mii_reg5 = mdio_read(dev, vp->phys[0], MII_LPA); | ||
| 1724 | vp->partner_flow_ctrl = ((mii_reg5 & 0x0400) != 0); | ||
| 1725 | |||
| 1729 | vortex_check_media(dev, 1); | 1726 | vortex_check_media(dev, 1); |
| 1730 | } | 1727 | } |
| 1731 | else | 1728 | else |
| 1732 | vortex_set_duplex(dev); | 1729 | vortex_set_duplex(dev); |
| 1733 | 1730 | ||
| 1731 | issue_and_wait(dev, TxReset); | ||
| 1732 | /* | ||
| 1733 | * Don't reset the PHY - that upsets autonegotiation during DHCP operations. | ||
| 1734 | */ | ||
| 1735 | issue_and_wait(dev, RxReset|0x04); | ||
| 1736 | |||
| 1734 | 1737 | ||
| 1735 | iowrite16(SetStatusEnb | 0x00, ioaddr + EL3_CMD); | 1738 | iowrite16(SetStatusEnb | 0x00, ioaddr + EL3_CMD); |
| 1736 | 1739 | ||
| @@ -2083,16 +2086,14 @@ vortex_error(struct net_device *dev, int status) | |||
| 2083 | } | 2086 | } |
| 2084 | if (tx_status & 0x14) vp->stats.tx_fifo_errors++; | 2087 | if (tx_status & 0x14) vp->stats.tx_fifo_errors++; |
| 2085 | if (tx_status & 0x38) vp->stats.tx_aborted_errors++; | 2088 | if (tx_status & 0x38) vp->stats.tx_aborted_errors++; |
| 2089 | if (tx_status & 0x08) vp->xstats.tx_max_collisions++; | ||
| 2086 | iowrite8(0, ioaddr + TxStatus); | 2090 | iowrite8(0, ioaddr + TxStatus); |
| 2087 | if (tx_status & 0x30) { /* txJabber or txUnderrun */ | 2091 | if (tx_status & 0x30) { /* txJabber or txUnderrun */ |
| 2088 | do_tx_reset = 1; | 2092 | do_tx_reset = 1; |
| 2089 | } else if (tx_status & 0x08) { /* maxCollisions */ | 2093 | } else if ((tx_status & 0x08) && (vp->drv_flags & MAX_COLLISION_RESET)) { /* maxCollisions */ |
| 2090 | vp->xstats.tx_max_collisions++; | 2094 | do_tx_reset = 1; |
| 2091 | if (vp->drv_flags & MAX_COLLISION_RESET) { | 2095 | reset_mask = 0x0108; /* Reset interface logic, but not download logic */ |
| 2092 | do_tx_reset = 1; | 2096 | } else { /* Merely re-enable the transmitter. */ |
| 2093 | reset_mask = 0x0108; /* Reset interface logic, but not download logic */ | ||
| 2094 | } | ||
| 2095 | } else { /* Merely re-enable the transmitter. */ | ||
| 2096 | iowrite16(TxEnable, ioaddr + EL3_CMD); | 2097 | iowrite16(TxEnable, ioaddr + EL3_CMD); |
| 2097 | } | 2098 | } |
| 2098 | } | 2099 | } |
diff --git a/drivers/net/Kconfig b/drivers/net/Kconfig index e20b849a22e8..bdaaad8f2123 100644 --- a/drivers/net/Kconfig +++ b/drivers/net/Kconfig | |||
| @@ -2313,13 +2313,11 @@ config S2IO_NAPI | |||
| 2313 | 2313 | ||
| 2314 | endmenu | 2314 | endmenu |
| 2315 | 2315 | ||
| 2316 | if !UML | ||
| 2317 | source "drivers/net/tokenring/Kconfig" | 2316 | source "drivers/net/tokenring/Kconfig" |
| 2318 | 2317 | ||
| 2319 | source "drivers/net/wireless/Kconfig" | 2318 | source "drivers/net/wireless/Kconfig" |
| 2320 | 2319 | ||
| 2321 | source "drivers/net/pcmcia/Kconfig" | 2320 | source "drivers/net/pcmcia/Kconfig" |
| 2322 | endif | ||
| 2323 | 2321 | ||
| 2324 | source "drivers/net/wan/Kconfig" | 2322 | source "drivers/net/wan/Kconfig" |
| 2325 | 2323 | ||
diff --git a/drivers/net/netconsole.c b/drivers/net/netconsole.c index edd1b5306b16..75b35ad760de 100644 --- a/drivers/net/netconsole.c +++ b/drivers/net/netconsole.c | |||
| @@ -94,7 +94,7 @@ static struct console netconsole = { | |||
| 94 | static int option_setup(char *opt) | 94 | static int option_setup(char *opt) |
| 95 | { | 95 | { |
| 96 | configured = !netpoll_parse_options(&np, opt); | 96 | configured = !netpoll_parse_options(&np, opt); |
| 97 | return 0; | 97 | return 1; |
| 98 | } | 98 | } |
| 99 | 99 | ||
| 100 | __setup("netconsole=", option_setup); | 100 | __setup("netconsole=", option_setup); |
diff --git a/drivers/net/pcmcia/xirc2ps_cs.c b/drivers/net/pcmcia/xirc2ps_cs.c index eed496803fe4..e8f849e12976 100644 --- a/drivers/net/pcmcia/xirc2ps_cs.c +++ b/drivers/net/pcmcia/xirc2ps_cs.c | |||
| @@ -1973,7 +1973,7 @@ static int __init setup_xirc2ps_cs(char *str) | |||
| 1973 | MAYBE_SET(lockup_hack, 6); | 1973 | MAYBE_SET(lockup_hack, 6); |
| 1974 | #undef MAYBE_SET | 1974 | #undef MAYBE_SET |
| 1975 | 1975 | ||
| 1976 | return 0; | 1976 | return 1; |
| 1977 | } | 1977 | } |
| 1978 | 1978 | ||
| 1979 | __setup("xirc2ps_cs=", setup_xirc2ps_cs); | 1979 | __setup("xirc2ps_cs=", setup_xirc2ps_cs); |
diff --git a/drivers/net/tokenring/Kconfig b/drivers/net/tokenring/Kconfig index e4cfc80b283b..99c4c1922f19 100644 --- a/drivers/net/tokenring/Kconfig +++ b/drivers/net/tokenring/Kconfig | |||
| @@ -3,7 +3,7 @@ | |||
| 3 | # | 3 | # |
| 4 | 4 | ||
| 5 | menu "Token Ring devices" | 5 | menu "Token Ring devices" |
| 6 | depends on NETDEVICES | 6 | depends on NETDEVICES && !UML |
| 7 | 7 | ||
| 8 | # So far, we only have PCI, ISA, and MCA token ring devices | 8 | # So far, we only have PCI, ISA, and MCA token ring devices |
| 9 | config TR | 9 | config TR |
diff --git a/drivers/net/wireless/Kconfig b/drivers/net/wireless/Kconfig index f85e30190008..bad09ebdb50b 100644 --- a/drivers/net/wireless/Kconfig +++ b/drivers/net/wireless/Kconfig | |||
| @@ -356,7 +356,7 @@ config PCI_HERMES | |||
| 356 | 356 | ||
| 357 | config ATMEL | 357 | config ATMEL |
| 358 | tristate "Atmel at76c50x chipset 802.11b support" | 358 | tristate "Atmel at76c50x chipset 802.11b support" |
| 359 | depends on NET_RADIO | 359 | depends on NET_RADIO && (PCI || PCMCIA) |
| 360 | select FW_LOADER | 360 | select FW_LOADER |
| 361 | select CRC32 | 361 | select CRC32 |
| 362 | ---help--- | 362 | ---help--- |
diff --git a/drivers/parisc/ccio-dma.c b/drivers/parisc/ccio-dma.c index 93f8a8fa8890..a5d826237b26 100644 --- a/drivers/parisc/ccio-dma.c +++ b/drivers/parisc/ccio-dma.c | |||
| @@ -1560,7 +1560,7 @@ static int ccio_probe(struct parisc_device *dev) | |||
| 1560 | *ioc_p = ioc; | 1560 | *ioc_p = ioc; |
| 1561 | 1561 | ||
| 1562 | ioc->hw_path = dev->hw_path; | 1562 | ioc->hw_path = dev->hw_path; |
| 1563 | ioc->ioc_regs = ioremap(dev->hpa.start, 4096); | 1563 | ioc->ioc_regs = ioremap_nocache(dev->hpa.start, 4096); |
| 1564 | ccio_ioc_init(ioc); | 1564 | ccio_ioc_init(ioc); |
| 1565 | ccio_init_resources(ioc); | 1565 | ccio_init_resources(ioc); |
| 1566 | hppa_dma_ops = &ccio_ops; | 1566 | hppa_dma_ops = &ccio_ops; |
diff --git a/drivers/parisc/dino.c b/drivers/parisc/dino.c index 3d1a7f98c676..6e8ed0c81a6c 100644 --- a/drivers/parisc/dino.c +++ b/drivers/parisc/dino.c | |||
| @@ -5,6 +5,7 @@ | |||
| 5 | ** (c) Copyright 1999 SuSE GmbH | 5 | ** (c) Copyright 1999 SuSE GmbH |
| 6 | ** (c) Copyright 1999,2000 Hewlett-Packard Company | 6 | ** (c) Copyright 1999,2000 Hewlett-Packard Company |
| 7 | ** (c) Copyright 2000 Grant Grundler | 7 | ** (c) Copyright 2000 Grant Grundler |
| 8 | ** (c) Copyright 2006 Helge Deller | ||
| 8 | ** | 9 | ** |
| 9 | ** This program is free software; you can redistribute it and/or modify | 10 | ** This program is free software; you can redistribute it and/or modify |
| 10 | ** it under the terms of the GNU General Public License as published by | 11 | ** it under the terms of the GNU General Public License as published by |
| @@ -785,7 +786,7 @@ dino_bridge_init(struct dino_device *dino_dev, const char *name) | |||
| 785 | if((io_addr & (1 << i)) == 0) | 786 | if((io_addr & (1 << i)) == 0) |
| 786 | continue; | 787 | continue; |
| 787 | 788 | ||
| 788 | start = (unsigned long)(signed int)(0xf0000000 | (i << 23)); | 789 | start = F_EXTEND(0xf0000000UL) | (i << 23); |
| 789 | end = start + 8 * 1024 * 1024 - 1; | 790 | end = start + 8 * 1024 * 1024 - 1; |
| 790 | 791 | ||
| 791 | DBG("DINO RANGE %d is at 0x%lx-0x%lx\n", count, | 792 | DBG("DINO RANGE %d is at 0x%lx-0x%lx\n", count, |
| @@ -996,7 +997,7 @@ static int __init dino_probe(struct parisc_device *dev) | |||
| 996 | } | 997 | } |
| 997 | 998 | ||
| 998 | dino_dev->hba.dev = dev; | 999 | dino_dev->hba.dev = dev; |
| 999 | dino_dev->hba.base_addr = ioremap(hpa, 4096); | 1000 | dino_dev->hba.base_addr = ioremap_nocache(hpa, 4096); |
| 1000 | dino_dev->hba.lmmio_space_offset = 0; /* CPU addrs == bus addrs */ | 1001 | dino_dev->hba.lmmio_space_offset = 0; /* CPU addrs == bus addrs */ |
| 1001 | spin_lock_init(&dino_dev->dinosaur_pen); | 1002 | spin_lock_init(&dino_dev->dinosaur_pen); |
| 1002 | dino_dev->hba.iommu = ccio_get_iommu(dev); | 1003 | dino_dev->hba.iommu = ccio_get_iommu(dev); |
diff --git a/drivers/parisc/eisa.c b/drivers/parisc/eisa.c index 3d94d86c1c9f..9d3bd15bf53b 100644 --- a/drivers/parisc/eisa.c +++ b/drivers/parisc/eisa.c | |||
| @@ -366,7 +366,7 @@ static int __devinit eisa_probe(struct parisc_device *dev) | |||
| 366 | eisa_dev.eeprom_addr = MIRAGE_EEPROM_BASE_ADDR; | 366 | eisa_dev.eeprom_addr = MIRAGE_EEPROM_BASE_ADDR; |
| 367 | } | 367 | } |
| 368 | } | 368 | } |
| 369 | eisa_eeprom_addr = ioremap(eisa_dev.eeprom_addr, HPEE_MAX_LENGTH); | 369 | eisa_eeprom_addr = ioremap_nocache(eisa_dev.eeprom_addr, HPEE_MAX_LENGTH); |
| 370 | result = eisa_enumerator(eisa_dev.eeprom_addr, &eisa_dev.hba.io_space, | 370 | result = eisa_enumerator(eisa_dev.eeprom_addr, &eisa_dev.hba.io_space, |
| 371 | &eisa_dev.hba.lmmio_space); | 371 | &eisa_dev.hba.lmmio_space); |
| 372 | init_eisa_pic(); | 372 | init_eisa_pic(); |
diff --git a/drivers/parisc/iosapic.c b/drivers/parisc/iosapic.c index 8d7a36392eb8..7a458d5bc751 100644 --- a/drivers/parisc/iosapic.c +++ b/drivers/parisc/iosapic.c | |||
| @@ -879,7 +879,7 @@ void *iosapic_register(unsigned long hpa) | |||
| 879 | return NULL; | 879 | return NULL; |
| 880 | } | 880 | } |
| 881 | 881 | ||
| 882 | isi->addr = ioremap(hpa, 4096); | 882 | isi->addr = ioremap_nocache(hpa, 4096); |
| 883 | isi->isi_hpa = hpa; | 883 | isi->isi_hpa = hpa; |
| 884 | isi->isi_version = iosapic_rd_version(isi); | 884 | isi->isi_version = iosapic_rd_version(isi); |
| 885 | isi->isi_num_vectors = IOSAPIC_IRDT_MAX_ENTRY(isi->isi_version) + 1; | 885 | isi->isi_num_vectors = IOSAPIC_IRDT_MAX_ENTRY(isi->isi_version) + 1; |
diff --git a/drivers/parisc/lba_pci.c b/drivers/parisc/lba_pci.c index e8a2a4a852f5..3fe4a77fa16a 100644 --- a/drivers/parisc/lba_pci.c +++ b/drivers/parisc/lba_pci.c | |||
| @@ -1213,7 +1213,7 @@ lba_pat_resources(struct parisc_device *pa_dev, struct lba_device *lba_dev) | |||
| 1213 | ** Postable I/O port space is per PCI host adapter. | 1213 | ** Postable I/O port space is per PCI host adapter. |
| 1214 | ** base of 64MB PIOP region | 1214 | ** base of 64MB PIOP region |
| 1215 | */ | 1215 | */ |
| 1216 | lba_dev->iop_base = ioremap(p->start, 64 * 1024 * 1024); | 1216 | lba_dev->iop_base = ioremap_nocache(p->start, 64 * 1024 * 1024); |
| 1217 | 1217 | ||
| 1218 | sprintf(lba_dev->hba.io_name, "PCI%02lx Ports", | 1218 | sprintf(lba_dev->hba.io_name, "PCI%02lx Ports", |
| 1219 | lba_dev->hba.bus_num.start); | 1219 | lba_dev->hba.bus_num.start); |
| @@ -1525,7 +1525,7 @@ lba_driver_probe(struct parisc_device *dev) | |||
| 1525 | u32 func_class; | 1525 | u32 func_class; |
| 1526 | void *tmp_obj; | 1526 | void *tmp_obj; |
| 1527 | char *version; | 1527 | char *version; |
| 1528 | void __iomem *addr = ioremap(dev->hpa.start, 4096); | 1528 | void __iomem *addr = ioremap_nocache(dev->hpa.start, 4096); |
| 1529 | 1529 | ||
| 1530 | /* Read HW Rev First */ | 1530 | /* Read HW Rev First */ |
| 1531 | func_class = READ_REG32(addr + LBA_FCLASS); | 1531 | func_class = READ_REG32(addr + LBA_FCLASS); |
| @@ -1619,7 +1619,7 @@ lba_driver_probe(struct parisc_device *dev) | |||
| 1619 | } else { | 1619 | } else { |
| 1620 | if (!astro_iop_base) { | 1620 | if (!astro_iop_base) { |
| 1621 | /* Sprockets PDC uses NPIOP region */ | 1621 | /* Sprockets PDC uses NPIOP region */ |
| 1622 | astro_iop_base = ioremap(LBA_PORT_BASE, 64 * 1024); | 1622 | astro_iop_base = ioremap_nocache(LBA_PORT_BASE, 64 * 1024); |
| 1623 | pci_port = &lba_astro_port_ops; | 1623 | pci_port = &lba_astro_port_ops; |
| 1624 | } | 1624 | } |
| 1625 | 1625 | ||
| @@ -1700,7 +1700,7 @@ void __init lba_init(void) | |||
| 1700 | */ | 1700 | */ |
| 1701 | void lba_set_iregs(struct parisc_device *lba, u32 ibase, u32 imask) | 1701 | void lba_set_iregs(struct parisc_device *lba, u32 ibase, u32 imask) |
| 1702 | { | 1702 | { |
| 1703 | void __iomem * base_addr = ioremap(lba->hpa.start, 4096); | 1703 | void __iomem * base_addr = ioremap_nocache(lba->hpa.start, 4096); |
| 1704 | 1704 | ||
| 1705 | imask <<= 2; /* adjust for hints - 2 more bits */ | 1705 | imask <<= 2; /* adjust for hints - 2 more bits */ |
| 1706 | 1706 | ||
diff --git a/drivers/parisc/pdc_stable.c b/drivers/parisc/pdc_stable.c index a28e17898fbd..4e53be9c03ab 100644 --- a/drivers/parisc/pdc_stable.c +++ b/drivers/parisc/pdc_stable.c | |||
| @@ -4,9 +4,8 @@ | |||
| 4 | * Copyright (C) 2005-2006 Thibaut VARENE <varenet@parisc-linux.org> | 4 | * Copyright (C) 2005-2006 Thibaut VARENE <varenet@parisc-linux.org> |
| 5 | * | 5 | * |
| 6 | * This program is free software; you can redistribute it and/or modify | 6 | * This program is free software; you can redistribute it and/or modify |
| 7 | * it under the terms of the GNU General Public License as published by | 7 | * it under the terms of the GNU General Public License, version 2, as |
| 8 | * the Free Software Foundation; either version 2 of the License, or | 8 | * published by the Free Software Foundation. |
| 9 | * (at your option) any later version. | ||
| 10 | * | 9 | * |
| 11 | * This program is distributed in the hope that it will be useful, | 10 | * This program is distributed in the hope that it will be useful, |
| 12 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | 11 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
diff --git a/drivers/parisc/sba_iommu.c b/drivers/parisc/sba_iommu.c index 0821747e44cf..42b32ff2fca6 100644 --- a/drivers/parisc/sba_iommu.c +++ b/drivers/parisc/sba_iommu.c | |||
| @@ -1642,9 +1642,9 @@ sba_ioc_init(struct parisc_device *sba, struct ioc *ioc, int ioc_num) | |||
| 1642 | ** | 1642 | ** |
| 1643 | **************************************************************************/ | 1643 | **************************************************************************/ |
| 1644 | 1644 | ||
| 1645 | static void __iomem *ioc_remap(struct sba_device *sba_dev, int offset) | 1645 | static void __iomem *ioc_remap(struct sba_device *sba_dev, unsigned int offset) |
| 1646 | { | 1646 | { |
| 1647 | return ioremap(sba_dev->dev->hpa.start + offset, SBA_FUNC_SIZE); | 1647 | return ioremap_nocache(sba_dev->dev->hpa.start + offset, SBA_FUNC_SIZE); |
| 1648 | } | 1648 | } |
| 1649 | 1649 | ||
| 1650 | static void sba_hw_init(struct sba_device *sba_dev) | 1650 | static void sba_hw_init(struct sba_device *sba_dev) |
| @@ -2040,7 +2040,7 @@ sba_driver_callback(struct parisc_device *dev) | |||
| 2040 | u32 func_class; | 2040 | u32 func_class; |
| 2041 | int i; | 2041 | int i; |
| 2042 | char *version; | 2042 | char *version; |
| 2043 | void __iomem *sba_addr = ioremap(dev->hpa.start, SBA_FUNC_SIZE); | 2043 | void __iomem *sba_addr = ioremap_nocache(dev->hpa.start, SBA_FUNC_SIZE); |
| 2044 | struct proc_dir_entry *info_entry, *bitmap_entry, *root; | 2044 | struct proc_dir_entry *info_entry, *bitmap_entry, *root; |
| 2045 | 2045 | ||
| 2046 | sba_dump_ranges(sba_addr); | 2046 | sba_dump_ranges(sba_addr); |
diff --git a/drivers/parisc/superio.c b/drivers/parisc/superio.c index ad6d3b28a3a6..719b863bc20e 100644 --- a/drivers/parisc/superio.c +++ b/drivers/parisc/superio.c | |||
| @@ -12,6 +12,7 @@ | |||
| 12 | * (C) Copyright 2001 John Marvin <jsm fc hp com> | 12 | * (C) Copyright 2001 John Marvin <jsm fc hp com> |
| 13 | * (C) Copyright 2003 Grant Grundler <grundler parisc-linux org> | 13 | * (C) Copyright 2003 Grant Grundler <grundler parisc-linux org> |
| 14 | * (C) Copyright 2005 Kyle McMartin <kyle@parisc-linux.org> | 14 | * (C) Copyright 2005 Kyle McMartin <kyle@parisc-linux.org> |
| 15 | * (C) Copyright 2006 Helge Deller <deller@gmx.de> | ||
| 15 | * | 16 | * |
| 16 | * This program is free software; you can redistribute it and/or | 17 | * This program is free software; you can redistribute it and/or |
| 17 | * modify it under the terms of the GNU General Public License as | 18 | * modify it under the terms of the GNU General Public License as |
| @@ -388,43 +389,34 @@ int superio_fixup_irq(struct pci_dev *pcidev) | |||
| 388 | return local_irq; | 389 | return local_irq; |
| 389 | } | 390 | } |
| 390 | 391 | ||
| 391 | static struct uart_port serial[] = { | ||
| 392 | { | ||
| 393 | .iotype = UPIO_PORT, | ||
| 394 | .line = 0, | ||
| 395 | .type = PORT_16550A, | ||
| 396 | .uartclk = 115200*16, | ||
| 397 | .fifosize = 16, | ||
| 398 | }, | ||
| 399 | { | ||
| 400 | .iotype = UPIO_PORT, | ||
| 401 | .line = 1, | ||
| 402 | .type = PORT_16550A, | ||
| 403 | .uartclk = 115200*16, | ||
| 404 | .fifosize = 16, | ||
| 405 | } | ||
| 406 | }; | ||
| 407 | |||
| 408 | static void __devinit superio_serial_init(void) | 392 | static void __devinit superio_serial_init(void) |
| 409 | { | 393 | { |
| 410 | #ifdef CONFIG_SERIAL_8250 | 394 | #ifdef CONFIG_SERIAL_8250 |
| 411 | int retval; | 395 | int retval; |
| 412 | 396 | struct uart_port serial_port; | |
| 413 | serial[0].iobase = sio_dev.sp1_base; | 397 | |
| 414 | serial[0].irq = SP1_IRQ; | 398 | memset(&serial_port, 0, sizeof(serial_port)); |
| 415 | spin_lock_init(&serial[0].lock); | 399 | serial_port.iotype = UPIO_PORT; |
| 416 | 400 | serial_port.type = PORT_16550A; | |
| 417 | retval = early_serial_setup(&serial[0]); | 401 | serial_port.uartclk = 115200*16; |
| 402 | serial_port.fifosize = 16; | ||
| 403 | spin_lock_init(&serial_port.lock); | ||
| 404 | |||
| 405 | /* serial port #1 */ | ||
| 406 | serial_port.iobase = sio_dev.sp1_base; | ||
| 407 | serial_port.irq = SP1_IRQ; | ||
| 408 | serial_port.line = 0; | ||
| 409 | retval = early_serial_setup(&serial_port); | ||
| 418 | if (retval < 0) { | 410 | if (retval < 0) { |
| 419 | printk(KERN_WARNING PFX "Register Serial #0 failed.\n"); | 411 | printk(KERN_WARNING PFX "Register Serial #0 failed.\n"); |
| 420 | return; | 412 | return; |
| 421 | } | 413 | } |
| 422 | 414 | ||
| 423 | serial[1].iobase = sio_dev.sp2_base; | 415 | /* serial port #2 */ |
| 424 | serial[1].irq = SP2_IRQ; | 416 | serial_port.iobase = sio_dev.sp2_base; |
| 425 | spin_lock_init(&serial[1].lock); | 417 | serial_port.irq = SP2_IRQ; |
| 426 | retval = early_serial_setup(&serial[1]); | 418 | serial_port.line = 1; |
| 427 | 419 | retval = early_serial_setup(&serial_port); | |
| 428 | if (retval < 0) | 420 | if (retval < 0) |
| 429 | printk(KERN_WARNING PFX "Register Serial #1 failed.\n"); | 421 | printk(KERN_WARNING PFX "Register Serial #1 failed.\n"); |
| 430 | #endif /* CONFIG_SERIAL_8250 */ | 422 | #endif /* CONFIG_SERIAL_8250 */ |
diff --git a/drivers/pcmcia/vrc4171_card.c b/drivers/pcmcia/vrc4171_card.c index 0574efd7828a..459e6e1946fd 100644 --- a/drivers/pcmcia/vrc4171_card.c +++ b/drivers/pcmcia/vrc4171_card.c | |||
| @@ -634,7 +634,7 @@ static void vrc4171_remove_sockets(void) | |||
| 634 | static int __devinit vrc4171_card_setup(char *options) | 634 | static int __devinit vrc4171_card_setup(char *options) |
| 635 | { | 635 | { |
| 636 | if (options == NULL || *options == '\0') | 636 | if (options == NULL || *options == '\0') |
| 637 | return 0; | 637 | return 1; |
| 638 | 638 | ||
| 639 | if (strncmp(options, "irq:", 4) == 0) { | 639 | if (strncmp(options, "irq:", 4) == 0) { |
| 640 | int irq; | 640 | int irq; |
| @@ -644,7 +644,7 @@ static int __devinit vrc4171_card_setup(char *options) | |||
| 644 | vrc4171_irq = irq; | 644 | vrc4171_irq = irq; |
| 645 | 645 | ||
| 646 | if (*options != ',') | 646 | if (*options != ',') |
| 647 | return 0; | 647 | return 1; |
| 648 | options++; | 648 | options++; |
| 649 | } | 649 | } |
| 650 | 650 | ||
| @@ -663,10 +663,10 @@ static int __devinit vrc4171_card_setup(char *options) | |||
| 663 | } | 663 | } |
| 664 | 664 | ||
| 665 | if (*options != ',') | 665 | if (*options != ',') |
| 666 | return 0; | 666 | return 1; |
| 667 | options++; | 667 | options++; |
| 668 | } else | 668 | } else |
| 669 | return 0; | 669 | return 1; |
| 670 | 670 | ||
| 671 | } | 671 | } |
| 672 | 672 | ||
| @@ -688,7 +688,7 @@ static int __devinit vrc4171_card_setup(char *options) | |||
| 688 | } | 688 | } |
| 689 | 689 | ||
| 690 | if (*options != ',') | 690 | if (*options != ',') |
| 691 | return 0; | 691 | return 1; |
| 692 | options++; | 692 | options++; |
| 693 | 693 | ||
| 694 | if (strncmp(options, "memnoprobe", 10) == 0) | 694 | if (strncmp(options, "memnoprobe", 10) == 0) |
| @@ -700,7 +700,7 @@ static int __devinit vrc4171_card_setup(char *options) | |||
| 700 | } | 700 | } |
| 701 | } | 701 | } |
| 702 | 702 | ||
| 703 | return 0; | 703 | return 1; |
| 704 | } | 704 | } |
| 705 | 705 | ||
| 706 | __setup("vrc4171_card=", vrc4171_card_setup); | 706 | __setup("vrc4171_card=", vrc4171_card_setup); |
diff --git a/drivers/pcmcia/vrc4173_cardu.c b/drivers/pcmcia/vrc4173_cardu.c index 57f38dba0a48..6004196f7cc1 100644 --- a/drivers/pcmcia/vrc4173_cardu.c +++ b/drivers/pcmcia/vrc4173_cardu.c | |||
| @@ -516,7 +516,7 @@ static int __devinit vrc4173_cardu_probe(struct pci_dev *dev, | |||
| 516 | static int __devinit vrc4173_cardu_setup(char *options) | 516 | static int __devinit vrc4173_cardu_setup(char *options) |
| 517 | { | 517 | { |
| 518 | if (options == NULL || *options == '\0') | 518 | if (options == NULL || *options == '\0') |
| 519 | return 0; | 519 | return 1; |
| 520 | 520 | ||
| 521 | if (strncmp(options, "cardu1:", 7) == 0) { | 521 | if (strncmp(options, "cardu1:", 7) == 0) { |
| 522 | options += 7; | 522 | options += 7; |
| @@ -527,9 +527,9 @@ static int __devinit vrc4173_cardu_setup(char *options) | |||
| 527 | } | 527 | } |
| 528 | 528 | ||
| 529 | if (*options != ',') | 529 | if (*options != ',') |
| 530 | return 0; | 530 | return 1; |
| 531 | } else | 531 | } else |
| 532 | return 0; | 532 | return 1; |
| 533 | } | 533 | } |
| 534 | 534 | ||
| 535 | if (strncmp(options, "cardu2:", 7) == 0) { | 535 | if (strncmp(options, "cardu2:", 7) == 0) { |
| @@ -538,7 +538,7 @@ static int __devinit vrc4173_cardu_setup(char *options) | |||
| 538 | cardu_sockets[CARDU2].noprobe = 1; | 538 | cardu_sockets[CARDU2].noprobe = 1; |
| 539 | } | 539 | } |
| 540 | 540 | ||
| 541 | return 0; | 541 | return 1; |
| 542 | } | 542 | } |
| 543 | 543 | ||
| 544 | __setup("vrc4173_cardu=", vrc4173_cardu_setup); | 544 | __setup("vrc4173_cardu=", vrc4173_cardu_setup); |
diff --git a/drivers/scsi/ahci.c b/drivers/scsi/ahci.c index ffba65656a83..1bd82c4e52a0 100644 --- a/drivers/scsi/ahci.c +++ b/drivers/scsi/ahci.c | |||
| @@ -293,6 +293,10 @@ static const struct pci_device_id ahci_pci_tbl[] = { | |||
| 293 | board_ahci }, /* JMicron JMB360 */ | 293 | board_ahci }, /* JMicron JMB360 */ |
| 294 | { 0x197b, 0x2363, PCI_ANY_ID, PCI_ANY_ID, 0, 0, | 294 | { 0x197b, 0x2363, PCI_ANY_ID, PCI_ANY_ID, 0, 0, |
| 295 | board_ahci }, /* JMicron JMB363 */ | 295 | board_ahci }, /* JMicron JMB363 */ |
| 296 | { PCI_VENDOR_ID_ATI, 0x4380, PCI_ANY_ID, PCI_ANY_ID, 0, 0, | ||
| 297 | board_ahci }, /* ATI SB600 non-raid */ | ||
| 298 | { PCI_VENDOR_ID_ATI, 0x4381, PCI_ANY_ID, PCI_ANY_ID, 0, 0, | ||
| 299 | board_ahci }, /* ATI SB600 raid */ | ||
| 296 | { } /* terminate list */ | 300 | { } /* terminate list */ |
| 297 | }; | 301 | }; |
| 298 | 302 | ||
diff --git a/drivers/scsi/ata_piix.c b/drivers/scsi/ata_piix.c index 2d5be84d8bd4..24e71b555172 100644 --- a/drivers/scsi/ata_piix.c +++ b/drivers/scsi/ata_piix.c | |||
| @@ -301,7 +301,7 @@ static struct piix_map_db ich6_map_db = { | |||
| 301 | .mask = 0x3, | 301 | .mask = 0x3, |
| 302 | .map = { | 302 | .map = { |
| 303 | /* PM PS SM SS MAP */ | 303 | /* PM PS SM SS MAP */ |
| 304 | { P0, P1, P2, P3 }, /* 00b */ | 304 | { P0, P2, P1, P3 }, /* 00b */ |
| 305 | { IDE, IDE, P1, P3 }, /* 01b */ | 305 | { IDE, IDE, P1, P3 }, /* 01b */ |
| 306 | { P0, P2, IDE, IDE }, /* 10b */ | 306 | { P0, P2, IDE, IDE }, /* 10b */ |
| 307 | { RV, RV, RV, RV }, | 307 | { RV, RV, RV, RV }, |
| @@ -312,7 +312,7 @@ static struct piix_map_db ich6m_map_db = { | |||
| 312 | .mask = 0x3, | 312 | .mask = 0x3, |
| 313 | .map = { | 313 | .map = { |
| 314 | /* PM PS SM SS MAP */ | 314 | /* PM PS SM SS MAP */ |
| 315 | { P0, P1, P2, P3 }, /* 00b */ | 315 | { P0, P2, RV, RV }, /* 00b */ |
| 316 | { RV, RV, RV, RV }, | 316 | { RV, RV, RV, RV }, |
| 317 | { P0, P2, IDE, IDE }, /* 10b */ | 317 | { P0, P2, IDE, IDE }, /* 10b */ |
| 318 | { RV, RV, RV, RV }, | 318 | { RV, RV, RV, RV }, |
diff --git a/drivers/scsi/ibmmca.c b/drivers/scsi/ibmmca.c index 3a8462e8d063..24eb59e143a9 100644 --- a/drivers/scsi/ibmmca.c +++ b/drivers/scsi/ibmmca.c | |||
| @@ -2488,7 +2488,7 @@ static int option_setup(char *str) | |||
| 2488 | } | 2488 | } |
| 2489 | ints[0] = i - 1; | 2489 | ints[0] = i - 1; |
| 2490 | internal_ibmmca_scsi_setup(cur, ints); | 2490 | internal_ibmmca_scsi_setup(cur, ints); |
| 2491 | return 0; | 2491 | return 1; |
| 2492 | } | 2492 | } |
| 2493 | 2493 | ||
| 2494 | __setup("ibmmcascsi=", option_setup); | 2494 | __setup("ibmmcascsi=", option_setup); |
diff --git a/drivers/scsi/lasi700.c b/drivers/scsi/lasi700.c index 459a4daebece..eb7bd310cc82 100644 --- a/drivers/scsi/lasi700.c +++ b/drivers/scsi/lasi700.c | |||
| @@ -112,7 +112,7 @@ lasi700_probe(struct parisc_device *dev) | |||
| 112 | 112 | ||
| 113 | hostdata->dev = &dev->dev; | 113 | hostdata->dev = &dev->dev; |
| 114 | dma_set_mask(&dev->dev, DMA_32BIT_MASK); | 114 | dma_set_mask(&dev->dev, DMA_32BIT_MASK); |
| 115 | hostdata->base = ioremap(base, 0x100); | 115 | hostdata->base = ioremap_nocache(base, 0x100); |
| 116 | hostdata->differential = 0; | 116 | hostdata->differential = 0; |
| 117 | 117 | ||
| 118 | if (dev->id.sversion == LASI_700_SVERSION) { | 118 | if (dev->id.sversion == LASI_700_SVERSION) { |
diff --git a/drivers/scsi/libata-bmdma.c b/drivers/scsi/libata-bmdma.c index 95d81d86d8b7..835dff0bafdc 100644 --- a/drivers/scsi/libata-bmdma.c +++ b/drivers/scsi/libata-bmdma.c | |||
| @@ -703,6 +703,7 @@ ata_pci_init_native_mode(struct pci_dev *pdev, struct ata_port_info **port, int | |||
| 703 | struct ata_probe_ent *probe_ent = | 703 | struct ata_probe_ent *probe_ent = |
| 704 | ata_probe_ent_alloc(pci_dev_to_dev(pdev), port[0]); | 704 | ata_probe_ent_alloc(pci_dev_to_dev(pdev), port[0]); |
| 705 | int p = 0; | 705 | int p = 0; |
| 706 | unsigned long bmdma; | ||
| 706 | 707 | ||
| 707 | if (!probe_ent) | 708 | if (!probe_ent) |
| 708 | return NULL; | 709 | return NULL; |
| @@ -716,7 +717,12 @@ ata_pci_init_native_mode(struct pci_dev *pdev, struct ata_port_info **port, int | |||
| 716 | probe_ent->port[p].altstatus_addr = | 717 | probe_ent->port[p].altstatus_addr = |
| 717 | probe_ent->port[p].ctl_addr = | 718 | probe_ent->port[p].ctl_addr = |
| 718 | pci_resource_start(pdev, 1) | ATA_PCI_CTL_OFS; | 719 | pci_resource_start(pdev, 1) | ATA_PCI_CTL_OFS; |
| 719 | probe_ent->port[p].bmdma_addr = pci_resource_start(pdev, 4); | 720 | bmdma = pci_resource_start(pdev, 4); |
| 721 | if (bmdma) { | ||
| 722 | if (inb(bmdma + 2) & 0x80) | ||
| 723 | probe_ent->host_set_flags |= ATA_HOST_SIMPLEX; | ||
| 724 | probe_ent->port[p].bmdma_addr = bmdma; | ||
| 725 | } | ||
| 720 | ata_std_ports(&probe_ent->port[p]); | 726 | ata_std_ports(&probe_ent->port[p]); |
| 721 | p++; | 727 | p++; |
| 722 | } | 728 | } |
| @@ -726,7 +732,13 @@ ata_pci_init_native_mode(struct pci_dev *pdev, struct ata_port_info **port, int | |||
| 726 | probe_ent->port[p].altstatus_addr = | 732 | probe_ent->port[p].altstatus_addr = |
| 727 | probe_ent->port[p].ctl_addr = | 733 | probe_ent->port[p].ctl_addr = |
| 728 | pci_resource_start(pdev, 3) | ATA_PCI_CTL_OFS; | 734 | pci_resource_start(pdev, 3) | ATA_PCI_CTL_OFS; |
| 729 | probe_ent->port[p].bmdma_addr = pci_resource_start(pdev, 4) + 8; | 735 | bmdma = pci_resource_start(pdev, 4); |
| 736 | if (bmdma) { | ||
| 737 | bmdma += 8; | ||
| 738 | if(inb(bmdma + 2) & 0x80) | ||
| 739 | probe_ent->host_set_flags |= ATA_HOST_SIMPLEX; | ||
| 740 | probe_ent->port[p].bmdma_addr = bmdma; | ||
| 741 | } | ||
| 730 | ata_std_ports(&probe_ent->port[p]); | 742 | ata_std_ports(&probe_ent->port[p]); |
| 731 | p++; | 743 | p++; |
| 732 | } | 744 | } |
| @@ -740,6 +752,7 @@ static struct ata_probe_ent *ata_pci_init_legacy_port(struct pci_dev *pdev, | |||
| 740 | struct ata_port_info *port, int port_num) | 752 | struct ata_port_info *port, int port_num) |
| 741 | { | 753 | { |
| 742 | struct ata_probe_ent *probe_ent; | 754 | struct ata_probe_ent *probe_ent; |
| 755 | unsigned long bmdma; | ||
| 743 | 756 | ||
| 744 | probe_ent = ata_probe_ent_alloc(pci_dev_to_dev(pdev), port); | 757 | probe_ent = ata_probe_ent_alloc(pci_dev_to_dev(pdev), port); |
| 745 | if (!probe_ent) | 758 | if (!probe_ent) |
| @@ -766,8 +779,13 @@ static struct ata_probe_ent *ata_pci_init_legacy_port(struct pci_dev *pdev, | |||
| 766 | break; | 779 | break; |
| 767 | } | 780 | } |
| 768 | 781 | ||
| 769 | probe_ent->port[0].bmdma_addr = | 782 | bmdma = pci_resource_start(pdev, 4); |
| 770 | pci_resource_start(pdev, 4) + 8 * port_num; | 783 | if (bmdma != 0) { |
| 784 | bmdma += 8 * port_num; | ||
| 785 | probe_ent->port[0].bmdma_addr = bmdma; | ||
| 786 | if (inb(bmdma + 2) & 0x80) | ||
| 787 | probe_ent->host_set_flags |= ATA_HOST_SIMPLEX; | ||
| 788 | } | ||
| 771 | ata_std_ports(&probe_ent->port[0]); | 789 | ata_std_ports(&probe_ent->port[0]); |
| 772 | 790 | ||
| 773 | return probe_ent; | 791 | return probe_ent; |
diff --git a/drivers/scsi/libata-core.c b/drivers/scsi/libata-core.c index d279666dcb38..e63c1ff1e102 100644 --- a/drivers/scsi/libata-core.c +++ b/drivers/scsi/libata-core.c | |||
| @@ -62,7 +62,9 @@ | |||
| 62 | #include "libata.h" | 62 | #include "libata.h" |
| 63 | 63 | ||
| 64 | static unsigned int ata_dev_init_params(struct ata_port *ap, | 64 | static unsigned int ata_dev_init_params(struct ata_port *ap, |
| 65 | struct ata_device *dev); | 65 | struct ata_device *dev, |
| 66 | u16 heads, | ||
| 67 | u16 sectors); | ||
| 66 | static void ata_set_mode(struct ata_port *ap); | 68 | static void ata_set_mode(struct ata_port *ap); |
| 67 | static unsigned int ata_dev_set_xfermode(struct ata_port *ap, | 69 | static unsigned int ata_dev_set_xfermode(struct ata_port *ap, |
| 68 | struct ata_device *dev); | 70 | struct ata_device *dev); |
| @@ -276,7 +278,7 @@ static void ata_unpack_xfermask(unsigned int xfer_mask, | |||
| 276 | } | 278 | } |
| 277 | 279 | ||
| 278 | static const struct ata_xfer_ent { | 280 | static const struct ata_xfer_ent { |
| 279 | unsigned int shift, bits; | 281 | int shift, bits; |
| 280 | u8 base; | 282 | u8 base; |
| 281 | } ata_xfer_tbl[] = { | 283 | } ata_xfer_tbl[] = { |
| 282 | { ATA_SHIFT_PIO, ATA_BITS_PIO, XFER_PIO_0 }, | 284 | { ATA_SHIFT_PIO, ATA_BITS_PIO, XFER_PIO_0 }, |
| @@ -987,9 +989,7 @@ ata_exec_internal(struct ata_port *ap, struct ata_device *dev, | |||
| 987 | qc->private_data = &wait; | 989 | qc->private_data = &wait; |
| 988 | qc->complete_fn = ata_qc_complete_internal; | 990 | qc->complete_fn = ata_qc_complete_internal; |
| 989 | 991 | ||
| 990 | qc->err_mask = ata_qc_issue(qc); | 992 | ata_qc_issue(qc); |
| 991 | if (qc->err_mask) | ||
| 992 | ata_qc_complete(qc); | ||
| 993 | 993 | ||
| 994 | spin_unlock_irqrestore(&ap->host_set->lock, flags); | 994 | spin_unlock_irqrestore(&ap->host_set->lock, flags); |
| 995 | 995 | ||
| @@ -1081,9 +1081,8 @@ unsigned int ata_pio_need_iordy(const struct ata_device *adev) | |||
| 1081 | * | 1081 | * |
| 1082 | * Read ID data from the specified device. ATA_CMD_ID_ATA is | 1082 | * Read ID data from the specified device. ATA_CMD_ID_ATA is |
| 1083 | * performed on ATA devices and ATA_CMD_ID_ATAPI on ATAPI | 1083 | * performed on ATA devices and ATA_CMD_ID_ATAPI on ATAPI |
| 1084 | * devices. This function also takes care of EDD signature | 1084 | * devices. This function also issues ATA_CMD_INIT_DEV_PARAMS |
| 1085 | * misreporting (to be removed once EDD support is gone) and | 1085 | * for pre-ATA4 drives. |
| 1086 | * issues ATA_CMD_INIT_DEV_PARAMS for pre-ATA4 drives. | ||
| 1087 | * | 1086 | * |
| 1088 | * LOCKING: | 1087 | * LOCKING: |
| 1089 | * Kernel thread context (may sleep) | 1088 | * Kernel thread context (may sleep) |
| @@ -1095,7 +1094,6 @@ static int ata_dev_read_id(struct ata_port *ap, struct ata_device *dev, | |||
| 1095 | unsigned int *p_class, int post_reset, u16 **p_id) | 1094 | unsigned int *p_class, int post_reset, u16 **p_id) |
| 1096 | { | 1095 | { |
| 1097 | unsigned int class = *p_class; | 1096 | unsigned int class = *p_class; |
| 1098 | unsigned int using_edd; | ||
| 1099 | struct ata_taskfile tf; | 1097 | struct ata_taskfile tf; |
| 1100 | unsigned int err_mask = 0; | 1098 | unsigned int err_mask = 0; |
| 1101 | u16 *id; | 1099 | u16 *id; |
| @@ -1104,12 +1102,6 @@ static int ata_dev_read_id(struct ata_port *ap, struct ata_device *dev, | |||
| 1104 | 1102 | ||
| 1105 | DPRINTK("ENTER, host %u, dev %u\n", ap->id, dev->devno); | 1103 | DPRINTK("ENTER, host %u, dev %u\n", ap->id, dev->devno); |
| 1106 | 1104 | ||
| 1107 | if (ap->ops->probe_reset || | ||
| 1108 | ap->flags & (ATA_FLAG_SRST | ATA_FLAG_SATA_RESET)) | ||
| 1109 | using_edd = 0; | ||
| 1110 | else | ||
| 1111 | using_edd = 1; | ||
| 1112 | |||
| 1113 | ata_dev_select(ap, dev->devno, 1, 1); /* select device 0/1 */ | 1105 | ata_dev_select(ap, dev->devno, 1, 1); /* select device 0/1 */ |
| 1114 | 1106 | ||
| 1115 | id = kmalloc(sizeof(id[0]) * ATA_ID_WORDS, GFP_KERNEL); | 1107 | id = kmalloc(sizeof(id[0]) * ATA_ID_WORDS, GFP_KERNEL); |
| @@ -1139,39 +1131,16 @@ static int ata_dev_read_id(struct ata_port *ap, struct ata_device *dev, | |||
| 1139 | 1131 | ||
| 1140 | err_mask = ata_exec_internal(ap, dev, &tf, DMA_FROM_DEVICE, | 1132 | err_mask = ata_exec_internal(ap, dev, &tf, DMA_FROM_DEVICE, |
| 1141 | id, sizeof(id[0]) * ATA_ID_WORDS); | 1133 | id, sizeof(id[0]) * ATA_ID_WORDS); |
| 1142 | |||
| 1143 | if (err_mask) { | 1134 | if (err_mask) { |
| 1144 | rc = -EIO; | 1135 | rc = -EIO; |
| 1145 | reason = "I/O error"; | 1136 | reason = "I/O error"; |
| 1146 | |||
| 1147 | if (err_mask & ~AC_ERR_DEV) | ||
| 1148 | goto err_out; | ||
| 1149 | |||
| 1150 | /* | ||
| 1151 | * arg! EDD works for all test cases, but seems to return | ||
| 1152 | * the ATA signature for some ATAPI devices. Until the | ||
| 1153 | * reason for this is found and fixed, we fix up the mess | ||
| 1154 | * here. If IDENTIFY DEVICE returns command aborted | ||
| 1155 | * (as ATAPI devices do), then we issue an | ||
| 1156 | * IDENTIFY PACKET DEVICE. | ||
| 1157 | * | ||
| 1158 | * ATA software reset (SRST, the default) does not appear | ||
| 1159 | * to have this problem. | ||
| 1160 | */ | ||
| 1161 | if ((using_edd) && (class == ATA_DEV_ATA)) { | ||
| 1162 | u8 err = tf.feature; | ||
| 1163 | if (err & ATA_ABORTED) { | ||
| 1164 | class = ATA_DEV_ATAPI; | ||
| 1165 | goto retry; | ||
| 1166 | } | ||
| 1167 | } | ||
| 1168 | goto err_out; | 1137 | goto err_out; |
| 1169 | } | 1138 | } |
| 1170 | 1139 | ||
| 1171 | swap_buf_le16(id, ATA_ID_WORDS); | 1140 | swap_buf_le16(id, ATA_ID_WORDS); |
| 1172 | 1141 | ||
| 1173 | /* sanity check */ | 1142 | /* sanity check */ |
| 1174 | if ((class == ATA_DEV_ATA) != ata_id_is_ata(id)) { | 1143 | if ((class == ATA_DEV_ATA) != (ata_id_is_ata(id) | ata_id_is_cfa(id))) { |
| 1175 | rc = -EINVAL; | 1144 | rc = -EINVAL; |
| 1176 | reason = "device reports illegal type"; | 1145 | reason = "device reports illegal type"; |
| 1177 | goto err_out; | 1146 | goto err_out; |
| @@ -1187,7 +1156,7 @@ static int ata_dev_read_id(struct ata_port *ap, struct ata_device *dev, | |||
| 1187 | * Some drives were very specific about that exact sequence. | 1156 | * Some drives were very specific about that exact sequence. |
| 1188 | */ | 1157 | */ |
| 1189 | if (ata_id_major_version(id) < 4 || !ata_id_has_lba(id)) { | 1158 | if (ata_id_major_version(id) < 4 || !ata_id_has_lba(id)) { |
| 1190 | err_mask = ata_dev_init_params(ap, dev); | 1159 | err_mask = ata_dev_init_params(ap, dev, id[3], id[6]); |
| 1191 | if (err_mask) { | 1160 | if (err_mask) { |
| 1192 | rc = -EIO; | 1161 | rc = -EIO; |
| 1193 | reason = "INIT_DEV_PARAMS failed"; | 1162 | reason = "INIT_DEV_PARAMS failed"; |
| @@ -1440,7 +1409,11 @@ static int ata_bus_probe(struct ata_port *ap) | |||
| 1440 | if (!found) | 1409 | if (!found) |
| 1441 | goto err_out_disable; | 1410 | goto err_out_disable; |
| 1442 | 1411 | ||
| 1443 | ata_set_mode(ap); | 1412 | if (ap->ops->set_mode) |
| 1413 | ap->ops->set_mode(ap); | ||
| 1414 | else | ||
| 1415 | ata_set_mode(ap); | ||
| 1416 | |||
| 1444 | if (ap->flags & ATA_FLAG_PORT_DISABLED) | 1417 | if (ap->flags & ATA_FLAG_PORT_DISABLED) |
| 1445 | goto err_out_disable; | 1418 | goto err_out_disable; |
| 1446 | 1419 | ||
| @@ -1845,7 +1818,7 @@ static void ata_host_set_dma(struct ata_port *ap) | |||
| 1845 | */ | 1818 | */ |
| 1846 | static void ata_set_mode(struct ata_port *ap) | 1819 | static void ata_set_mode(struct ata_port *ap) |
| 1847 | { | 1820 | { |
| 1848 | int i, rc; | 1821 | int i, rc, used_dma = 0; |
| 1849 | 1822 | ||
| 1850 | /* step 1: calculate xfer_mask */ | 1823 | /* step 1: calculate xfer_mask */ |
| 1851 | for (i = 0; i < ATA_MAX_DEVICES; i++) { | 1824 | for (i = 0; i < ATA_MAX_DEVICES; i++) { |
| @@ -1863,6 +1836,9 @@ static void ata_set_mode(struct ata_port *ap) | |||
| 1863 | dma_mask = ata_pack_xfermask(0, dev->mwdma_mask, dev->udma_mask); | 1836 | dma_mask = ata_pack_xfermask(0, dev->mwdma_mask, dev->udma_mask); |
| 1864 | dev->pio_mode = ata_xfer_mask2mode(pio_mask); | 1837 | dev->pio_mode = ata_xfer_mask2mode(pio_mask); |
| 1865 | dev->dma_mode = ata_xfer_mask2mode(dma_mask); | 1838 | dev->dma_mode = ata_xfer_mask2mode(dma_mask); |
| 1839 | |||
| 1840 | if (dev->dma_mode) | ||
| 1841 | used_dma = 1; | ||
| 1866 | } | 1842 | } |
| 1867 | 1843 | ||
| 1868 | /* step 2: always set host PIO timings */ | 1844 | /* step 2: always set host PIO timings */ |
| @@ -1884,6 +1860,17 @@ static void ata_set_mode(struct ata_port *ap) | |||
| 1884 | goto err_out; | 1860 | goto err_out; |
| 1885 | } | 1861 | } |
| 1886 | 1862 | ||
| 1863 | /* | ||
| 1864 | * Record simplex status. If we selected DMA then the other | ||
| 1865 | * host channels are not permitted to do so. | ||
| 1866 | */ | ||
| 1867 | |||
| 1868 | if (used_dma && (ap->host_set->flags & ATA_HOST_SIMPLEX)) | ||
| 1869 | ap->host_set->simplex_claimed = 1; | ||
| 1870 | |||
| 1871 | /* | ||
| 1872 | * Chip specific finalisation | ||
| 1873 | */ | ||
| 1887 | if (ap->ops->post_set_mode) | 1874 | if (ap->ops->post_set_mode) |
| 1888 | ap->ops->post_set_mode(ap); | 1875 | ap->ops->post_set_mode(ap); |
| 1889 | 1876 | ||
| @@ -2005,45 +1992,6 @@ static void ata_bus_post_reset(struct ata_port *ap, unsigned int devmask) | |||
| 2005 | ap->ops->dev_select(ap, 0); | 1992 | ap->ops->dev_select(ap, 0); |
| 2006 | } | 1993 | } |
| 2007 | 1994 | ||
| 2008 | /** | ||
| 2009 | * ata_bus_edd - Issue EXECUTE DEVICE DIAGNOSTIC command. | ||
| 2010 | * @ap: Port to reset and probe | ||
| 2011 | * | ||
| 2012 | * Use the EXECUTE DEVICE DIAGNOSTIC command to reset and | ||
| 2013 | * probe the bus. Not often used these days. | ||
| 2014 | * | ||
| 2015 | * LOCKING: | ||
| 2016 | * PCI/etc. bus probe sem. | ||
| 2017 | * Obtains host_set lock. | ||
| 2018 | * | ||
| 2019 | */ | ||
| 2020 | |||
| 2021 | static unsigned int ata_bus_edd(struct ata_port *ap) | ||
| 2022 | { | ||
| 2023 | struct ata_taskfile tf; | ||
| 2024 | unsigned long flags; | ||
| 2025 | |||
| 2026 | /* set up execute-device-diag (bus reset) taskfile */ | ||
| 2027 | /* also, take interrupts to a known state (disabled) */ | ||
| 2028 | DPRINTK("execute-device-diag\n"); | ||
| 2029 | ata_tf_init(ap, &tf, 0); | ||
| 2030 | tf.ctl |= ATA_NIEN; | ||
| 2031 | tf.command = ATA_CMD_EDD; | ||
| 2032 | tf.protocol = ATA_PROT_NODATA; | ||
| 2033 | |||
| 2034 | /* do bus reset */ | ||
| 2035 | spin_lock_irqsave(&ap->host_set->lock, flags); | ||
| 2036 | ata_tf_to_host(ap, &tf); | ||
| 2037 | spin_unlock_irqrestore(&ap->host_set->lock, flags); | ||
| 2038 | |||
| 2039 | /* spec says at least 2ms. but who knows with those | ||
| 2040 | * crazy ATAPI devices... | ||
| 2041 | */ | ||
| 2042 | msleep(150); | ||
| 2043 | |||
| 2044 | return ata_busy_sleep(ap, ATA_TMOUT_BOOT_QUICK, ATA_TMOUT_BOOT); | ||
| 2045 | } | ||
| 2046 | |||
| 2047 | static unsigned int ata_bus_softreset(struct ata_port *ap, | 1995 | static unsigned int ata_bus_softreset(struct ata_port *ap, |
| 2048 | unsigned int devmask) | 1996 | unsigned int devmask) |
| 2049 | { | 1997 | { |
| @@ -2078,13 +2026,12 @@ static unsigned int ata_bus_softreset(struct ata_port *ap, | |||
| 2078 | */ | 2026 | */ |
| 2079 | msleep(150); | 2027 | msleep(150); |
| 2080 | 2028 | ||
| 2081 | |||
| 2082 | /* Before we perform post reset processing we want to see if | 2029 | /* Before we perform post reset processing we want to see if |
| 2083 | the bus shows 0xFF because the odd clown forgets the D7 pulldown | 2030 | * the bus shows 0xFF because the odd clown forgets the D7 |
| 2084 | resistor */ | 2031 | * pulldown resistor. |
| 2085 | 2032 | */ | |
| 2086 | if (ata_check_status(ap) == 0xFF) | 2033 | if (ata_check_status(ap) == 0xFF) |
| 2087 | return 1; /* Positive is failure for some reason */ | 2034 | return AC_ERR_OTHER; |
| 2088 | 2035 | ||
| 2089 | ata_bus_post_reset(ap, devmask); | 2036 | ata_bus_post_reset(ap, devmask); |
| 2090 | 2037 | ||
| @@ -2116,7 +2063,7 @@ void ata_bus_reset(struct ata_port *ap) | |||
| 2116 | struct ata_ioports *ioaddr = &ap->ioaddr; | 2063 | struct ata_ioports *ioaddr = &ap->ioaddr; |
| 2117 | unsigned int slave_possible = ap->flags & ATA_FLAG_SLAVE_POSS; | 2064 | unsigned int slave_possible = ap->flags & ATA_FLAG_SLAVE_POSS; |
| 2118 | u8 err; | 2065 | u8 err; |
| 2119 | unsigned int dev0, dev1 = 0, rc = 0, devmask = 0; | 2066 | unsigned int dev0, dev1 = 0, devmask = 0; |
| 2120 | 2067 | ||
| 2121 | DPRINTK("ENTER, host %u, port %u\n", ap->id, ap->port_no); | 2068 | DPRINTK("ENTER, host %u, port %u\n", ap->id, ap->port_no); |
| 2122 | 2069 | ||
| @@ -2139,18 +2086,8 @@ void ata_bus_reset(struct ata_port *ap) | |||
| 2139 | 2086 | ||
| 2140 | /* issue bus reset */ | 2087 | /* issue bus reset */ |
| 2141 | if (ap->flags & ATA_FLAG_SRST) | 2088 | if (ap->flags & ATA_FLAG_SRST) |
| 2142 | rc = ata_bus_softreset(ap, devmask); | 2089 | if (ata_bus_softreset(ap, devmask)) |
| 2143 | else if ((ap->flags & ATA_FLAG_SATA_RESET) == 0) { | 2090 | goto err_out; |
| 2144 | /* set up device control */ | ||
| 2145 | if (ap->flags & ATA_FLAG_MMIO) | ||
| 2146 | writeb(ap->ctl, (void __iomem *) ioaddr->ctl_addr); | ||
| 2147 | else | ||
| 2148 | outb(ap->ctl, ioaddr->ctl_addr); | ||
| 2149 | rc = ata_bus_edd(ap); | ||
| 2150 | } | ||
| 2151 | |||
| 2152 | if (rc) | ||
| 2153 | goto err_out; | ||
| 2154 | 2091 | ||
| 2155 | /* | 2092 | /* |
| 2156 | * determine by signature whether we have ATA or ATAPI devices | 2093 | * determine by signature whether we have ATA or ATAPI devices |
| @@ -2223,9 +2160,9 @@ static int sata_phy_resume(struct ata_port *ap) | |||
| 2223 | * so makes reset sequence different from the original | 2160 | * so makes reset sequence different from the original |
| 2224 | * ->phy_reset implementation and Jeff nervous. :-P | 2161 | * ->phy_reset implementation and Jeff nervous. :-P |
| 2225 | */ | 2162 | */ |
| 2226 | extern void ata_std_probeinit(struct ata_port *ap) | 2163 | void ata_std_probeinit(struct ata_port *ap) |
| 2227 | { | 2164 | { |
| 2228 | if (ap->flags & ATA_FLAG_SATA && ap->ops->scr_read) { | 2165 | if ((ap->flags & ATA_FLAG_SATA) && ap->ops->scr_read) { |
| 2229 | sata_phy_resume(ap); | 2166 | sata_phy_resume(ap); |
| 2230 | if (sata_dev_present(ap)) | 2167 | if (sata_dev_present(ap)) |
| 2231 | ata_busy_sleep(ap, ATA_TMOUT_BOOT_QUICK, ATA_TMOUT_BOOT); | 2168 | ata_busy_sleep(ap, ATA_TMOUT_BOOT_QUICK, ATA_TMOUT_BOOT); |
| @@ -2714,18 +2651,23 @@ static int ata_dma_blacklisted(const struct ata_device *dev) | |||
| 2714 | * known limits including host controller limits, device | 2651 | * known limits including host controller limits, device |
| 2715 | * blacklist, etc... | 2652 | * blacklist, etc... |
| 2716 | * | 2653 | * |
| 2654 | * FIXME: The current implementation limits all transfer modes to | ||
| 2655 | * the fastest of the lowested device on the port. This is not | ||
| 2656 | * required on most controllers. | ||
| 2657 | * | ||
| 2717 | * LOCKING: | 2658 | * LOCKING: |
| 2718 | * None. | 2659 | * None. |
| 2719 | */ | 2660 | */ |
| 2720 | static void ata_dev_xfermask(struct ata_port *ap, struct ata_device *dev) | 2661 | static void ata_dev_xfermask(struct ata_port *ap, struct ata_device *dev) |
| 2721 | { | 2662 | { |
| 2663 | struct ata_host_set *hs = ap->host_set; | ||
| 2722 | unsigned long xfer_mask; | 2664 | unsigned long xfer_mask; |
| 2723 | int i; | 2665 | int i; |
| 2724 | 2666 | ||
| 2725 | xfer_mask = ata_pack_xfermask(ap->pio_mask, ap->mwdma_mask, | 2667 | xfer_mask = ata_pack_xfermask(ap->pio_mask, ap->mwdma_mask, |
| 2726 | ap->udma_mask); | 2668 | ap->udma_mask); |
| 2727 | 2669 | ||
| 2728 | /* use port-wide xfermask for now */ | 2670 | /* FIXME: Use port-wide xfermask for now */ |
| 2729 | for (i = 0; i < ATA_MAX_DEVICES; i++) { | 2671 | for (i = 0; i < ATA_MAX_DEVICES; i++) { |
| 2730 | struct ata_device *d = &ap->device[i]; | 2672 | struct ata_device *d = &ap->device[i]; |
| 2731 | if (!ata_dev_present(d)) | 2673 | if (!ata_dev_present(d)) |
| @@ -2735,12 +2677,23 @@ static void ata_dev_xfermask(struct ata_port *ap, struct ata_device *dev) | |||
| 2735 | xfer_mask &= ata_id_xfermask(d->id); | 2677 | xfer_mask &= ata_id_xfermask(d->id); |
| 2736 | if (ata_dma_blacklisted(d)) | 2678 | if (ata_dma_blacklisted(d)) |
| 2737 | xfer_mask &= ~(ATA_MASK_MWDMA | ATA_MASK_UDMA); | 2679 | xfer_mask &= ~(ATA_MASK_MWDMA | ATA_MASK_UDMA); |
| 2680 | /* Apply cable rule here. Don't apply it early because when | ||
| 2681 | we handle hot plug the cable type can itself change */ | ||
| 2682 | if (ap->cbl == ATA_CBL_PATA40) | ||
| 2683 | xfer_mask &= ~(0xF8 << ATA_SHIFT_UDMA); | ||
| 2738 | } | 2684 | } |
| 2739 | 2685 | ||
| 2740 | if (ata_dma_blacklisted(dev)) | 2686 | if (ata_dma_blacklisted(dev)) |
| 2741 | printk(KERN_WARNING "ata%u: dev %u is on DMA blacklist, " | 2687 | printk(KERN_WARNING "ata%u: dev %u is on DMA blacklist, " |
| 2742 | "disabling DMA\n", ap->id, dev->devno); | 2688 | "disabling DMA\n", ap->id, dev->devno); |
| 2743 | 2689 | ||
| 2690 | if (hs->flags & ATA_HOST_SIMPLEX) { | ||
| 2691 | if (hs->simplex_claimed) | ||
| 2692 | xfer_mask &= ~(ATA_MASK_MWDMA | ATA_MASK_UDMA); | ||
| 2693 | } | ||
| 2694 | if (ap->ops->mode_filter) | ||
| 2695 | xfer_mask = ap->ops->mode_filter(ap, dev, xfer_mask); | ||
| 2696 | |||
| 2744 | ata_unpack_xfermask(xfer_mask, &dev->pio_mask, &dev->mwdma_mask, | 2697 | ata_unpack_xfermask(xfer_mask, &dev->pio_mask, &dev->mwdma_mask, |
| 2745 | &dev->udma_mask); | 2698 | &dev->udma_mask); |
| 2746 | } | 2699 | } |
| @@ -2795,16 +2748,16 @@ static unsigned int ata_dev_set_xfermode(struct ata_port *ap, | |||
| 2795 | */ | 2748 | */ |
| 2796 | 2749 | ||
| 2797 | static unsigned int ata_dev_init_params(struct ata_port *ap, | 2750 | static unsigned int ata_dev_init_params(struct ata_port *ap, |
| 2798 | struct ata_device *dev) | 2751 | struct ata_device *dev, |
| 2752 | u16 heads, | ||
| 2753 | u16 sectors) | ||
| 2799 | { | 2754 | { |
| 2800 | struct ata_taskfile tf; | 2755 | struct ata_taskfile tf; |
| 2801 | unsigned int err_mask; | 2756 | unsigned int err_mask; |
| 2802 | u16 sectors = dev->id[6]; | ||
| 2803 | u16 heads = dev->id[3]; | ||
| 2804 | 2757 | ||
| 2805 | /* Number of sectors per track 1-255. Number of heads 1-16 */ | 2758 | /* Number of sectors per track 1-255. Number of heads 1-16 */ |
| 2806 | if (sectors < 1 || sectors > 255 || heads < 1 || heads > 16) | 2759 | if (sectors < 1 || sectors > 255 || heads < 1 || heads > 16) |
| 2807 | return 0; | 2760 | return AC_ERR_INVALID; |
| 2808 | 2761 | ||
| 2809 | /* set up init dev params taskfile */ | 2762 | /* set up init dev params taskfile */ |
| 2810 | DPRINTK("init dev params \n"); | 2763 | DPRINTK("init dev params \n"); |
| @@ -4042,15 +3995,14 @@ static inline int ata_should_dma_map(struct ata_queued_cmd *qc) | |||
| 4042 | * | 3995 | * |
| 4043 | * LOCKING: | 3996 | * LOCKING: |
| 4044 | * spin_lock_irqsave(host_set lock) | 3997 | * spin_lock_irqsave(host_set lock) |
| 4045 | * | ||
| 4046 | * RETURNS: | ||
| 4047 | * Zero on success, AC_ERR_* mask on failure | ||
| 4048 | */ | 3998 | */ |
| 4049 | 3999 | void ata_qc_issue(struct ata_queued_cmd *qc) | |
| 4050 | unsigned int ata_qc_issue(struct ata_queued_cmd *qc) | ||
| 4051 | { | 4000 | { |
| 4052 | struct ata_port *ap = qc->ap; | 4001 | struct ata_port *ap = qc->ap; |
| 4053 | 4002 | ||
| 4003 | qc->ap->active_tag = qc->tag; | ||
| 4004 | qc->flags |= ATA_QCFLAG_ACTIVE; | ||
| 4005 | |||
| 4054 | if (ata_should_dma_map(qc)) { | 4006 | if (ata_should_dma_map(qc)) { |
| 4055 | if (qc->flags & ATA_QCFLAG_SG) { | 4007 | if (qc->flags & ATA_QCFLAG_SG) { |
| 4056 | if (ata_sg_setup(qc)) | 4008 | if (ata_sg_setup(qc)) |
| @@ -4065,17 +4017,18 @@ unsigned int ata_qc_issue(struct ata_queued_cmd *qc) | |||
| 4065 | 4017 | ||
| 4066 | ap->ops->qc_prep(qc); | 4018 | ap->ops->qc_prep(qc); |
| 4067 | 4019 | ||
| 4068 | qc->ap->active_tag = qc->tag; | 4020 | qc->err_mask |= ap->ops->qc_issue(qc); |
| 4069 | qc->flags |= ATA_QCFLAG_ACTIVE; | 4021 | if (unlikely(qc->err_mask)) |
| 4070 | 4022 | goto err; | |
| 4071 | return ap->ops->qc_issue(qc); | 4023 | return; |
| 4072 | 4024 | ||
| 4073 | sg_err: | 4025 | sg_err: |
| 4074 | qc->flags &= ~ATA_QCFLAG_DMAMAP; | 4026 | qc->flags &= ~ATA_QCFLAG_DMAMAP; |
| 4075 | return AC_ERR_SYSTEM; | 4027 | qc->err_mask |= AC_ERR_SYSTEM; |
| 4028 | err: | ||
| 4029 | ata_qc_complete(qc); | ||
| 4076 | } | 4030 | } |
| 4077 | 4031 | ||
| 4078 | |||
| 4079 | /** | 4032 | /** |
| 4080 | * ata_qc_issue_prot - issue taskfile to device in proto-dependent manner | 4033 | * ata_qc_issue_prot - issue taskfile to device in proto-dependent manner |
| 4081 | * @qc: command to issue to device | 4034 | * @qc: command to issue to device |
| @@ -4536,6 +4489,14 @@ static struct ata_port * ata_host_add(const struct ata_probe_ent *ent, | |||
| 4536 | int rc; | 4489 | int rc; |
| 4537 | 4490 | ||
| 4538 | DPRINTK("ENTER\n"); | 4491 | DPRINTK("ENTER\n"); |
| 4492 | |||
| 4493 | if (!ent->port_ops->probe_reset && | ||
| 4494 | !(ent->host_flags & (ATA_FLAG_SATA_RESET | ATA_FLAG_SRST))) { | ||
| 4495 | printk(KERN_ERR "ata%u: no reset mechanism available\n", | ||
| 4496 | port_no); | ||
| 4497 | return NULL; | ||
| 4498 | } | ||
| 4499 | |||
| 4539 | host = scsi_host_alloc(ent->sht, sizeof(struct ata_port)); | 4500 | host = scsi_host_alloc(ent->sht, sizeof(struct ata_port)); |
| 4540 | if (!host) | 4501 | if (!host) |
| 4541 | return NULL; | 4502 | return NULL; |
| @@ -4596,6 +4557,7 @@ int ata_device_add(const struct ata_probe_ent *ent) | |||
| 4596 | host_set->mmio_base = ent->mmio_base; | 4557 | host_set->mmio_base = ent->mmio_base; |
| 4597 | host_set->private_data = ent->private_data; | 4558 | host_set->private_data = ent->private_data; |
| 4598 | host_set->ops = ent->port_ops; | 4559 | host_set->ops = ent->port_ops; |
| 4560 | host_set->flags = ent->host_set_flags; | ||
| 4599 | 4561 | ||
| 4600 | /* register each port bound to this device */ | 4562 | /* register each port bound to this device */ |
| 4601 | for (i = 0; i < ent->n_ports; i++) { | 4563 | for (i = 0; i < ent->n_ports; i++) { |
diff --git a/drivers/scsi/libata-scsi.c b/drivers/scsi/libata-scsi.c index 628191bfd990..53f5b0d9161c 100644 --- a/drivers/scsi/libata-scsi.c +++ b/drivers/scsi/libata-scsi.c | |||
| @@ -1431,9 +1431,7 @@ static void ata_scsi_translate(struct ata_port *ap, struct ata_device *dev, | |||
| 1431 | goto early_finish; | 1431 | goto early_finish; |
| 1432 | 1432 | ||
| 1433 | /* select device, send command to hardware */ | 1433 | /* select device, send command to hardware */ |
| 1434 | qc->err_mask = ata_qc_issue(qc); | 1434 | ata_qc_issue(qc); |
| 1435 | if (qc->err_mask) | ||
| 1436 | ata_qc_complete(qc); | ||
| 1437 | 1435 | ||
| 1438 | VPRINTK("EXIT\n"); | 1436 | VPRINTK("EXIT\n"); |
| 1439 | return; | 1437 | return; |
| @@ -2199,9 +2197,7 @@ static void atapi_request_sense(struct ata_queued_cmd *qc) | |||
| 2199 | 2197 | ||
| 2200 | qc->complete_fn = atapi_sense_complete; | 2198 | qc->complete_fn = atapi_sense_complete; |
| 2201 | 2199 | ||
| 2202 | qc->err_mask = ata_qc_issue(qc); | 2200 | ata_qc_issue(qc); |
| 2203 | if (qc->err_mask) | ||
| 2204 | ata_qc_complete(qc); | ||
| 2205 | 2201 | ||
| 2206 | DPRINTK("EXIT\n"); | 2202 | DPRINTK("EXIT\n"); |
| 2207 | } | 2203 | } |
diff --git a/drivers/scsi/libata.h b/drivers/scsi/libata.h index 65f52beea884..1c755b14521a 100644 --- a/drivers/scsi/libata.h +++ b/drivers/scsi/libata.h | |||
| @@ -47,7 +47,7 @@ extern struct ata_queued_cmd *ata_qc_new_init(struct ata_port *ap, | |||
| 47 | extern int ata_rwcmd_protocol(struct ata_queued_cmd *qc); | 47 | extern int ata_rwcmd_protocol(struct ata_queued_cmd *qc); |
| 48 | extern void ata_port_flush_task(struct ata_port *ap); | 48 | extern void ata_port_flush_task(struct ata_port *ap); |
| 49 | extern void ata_qc_free(struct ata_queued_cmd *qc); | 49 | extern void ata_qc_free(struct ata_queued_cmd *qc); |
| 50 | extern unsigned int ata_qc_issue(struct ata_queued_cmd *qc); | 50 | extern void ata_qc_issue(struct ata_queued_cmd *qc); |
| 51 | extern int ata_check_atapi_dma(struct ata_queued_cmd *qc); | 51 | extern int ata_check_atapi_dma(struct ata_queued_cmd *qc); |
| 52 | extern void ata_dev_select(struct ata_port *ap, unsigned int device, | 52 | extern void ata_dev_select(struct ata_port *ap, unsigned int device, |
| 53 | unsigned int wait, unsigned int can_sleep); | 53 | unsigned int wait, unsigned int can_sleep); |
diff --git a/drivers/scsi/sata_mv.c b/drivers/scsi/sata_mv.c index 275ed9bd898c..fa901fd65085 100644 --- a/drivers/scsi/sata_mv.c +++ b/drivers/scsi/sata_mv.c | |||
| @@ -1010,7 +1010,7 @@ static void mv_fill_sg(struct ata_queued_cmd *qc) | |||
| 1010 | 1010 | ||
| 1011 | pp->sg_tbl[i].addr = cpu_to_le32(addr & 0xffffffff); | 1011 | pp->sg_tbl[i].addr = cpu_to_le32(addr & 0xffffffff); |
| 1012 | pp->sg_tbl[i].addr_hi = cpu_to_le32((addr >> 16) >> 16); | 1012 | pp->sg_tbl[i].addr_hi = cpu_to_le32((addr >> 16) >> 16); |
| 1013 | pp->sg_tbl[i].flags_size = cpu_to_le32(len); | 1013 | pp->sg_tbl[i].flags_size = cpu_to_le32(len & 0xffff); |
| 1014 | 1014 | ||
| 1015 | sg_len -= len; | 1015 | sg_len -= len; |
| 1016 | addr += len; | 1016 | addr += len; |
| @@ -1350,7 +1350,6 @@ static void mv_host_intr(struct ata_host_set *host_set, u32 relevant, | |||
| 1350 | { | 1350 | { |
| 1351 | void __iomem *mmio = host_set->mmio_base; | 1351 | void __iomem *mmio = host_set->mmio_base; |
| 1352 | void __iomem *hc_mmio = mv_hc_base(mmio, hc); | 1352 | void __iomem *hc_mmio = mv_hc_base(mmio, hc); |
| 1353 | struct ata_port *ap; | ||
| 1354 | struct ata_queued_cmd *qc; | 1353 | struct ata_queued_cmd *qc; |
| 1355 | u32 hc_irq_cause; | 1354 | u32 hc_irq_cause; |
| 1356 | int shift, port, port0, hard_port, handled; | 1355 | int shift, port, port0, hard_port, handled; |
| @@ -1373,25 +1372,32 @@ static void mv_host_intr(struct ata_host_set *host_set, u32 relevant, | |||
| 1373 | 1372 | ||
| 1374 | for (port = port0; port < port0 + MV_PORTS_PER_HC; port++) { | 1373 | for (port = port0; port < port0 + MV_PORTS_PER_HC; port++) { |
| 1375 | u8 ata_status = 0; | 1374 | u8 ata_status = 0; |
| 1376 | ap = host_set->ports[port]; | 1375 | struct ata_port *ap = host_set->ports[port]; |
| 1376 | struct mv_port_priv *pp = ap->private_data; | ||
| 1377 | |||
| 1377 | hard_port = port & MV_PORT_MASK; /* range 0-3 */ | 1378 | hard_port = port & MV_PORT_MASK; /* range 0-3 */ |
| 1378 | handled = 0; /* ensure ata_status is set if handled++ */ | 1379 | handled = 0; /* ensure ata_status is set if handled++ */ |
| 1379 | 1380 | ||
| 1380 | if ((CRPB_DMA_DONE << hard_port) & hc_irq_cause) { | 1381 | /* Note that DEV_IRQ might happen spuriously during EDMA, |
| 1381 | /* new CRPB on the queue; just one at a time until NCQ | 1382 | * and should be ignored in such cases. We could mask it, |
| 1382 | */ | 1383 | * but it's pretty rare and may not be worth the overhead. |
| 1383 | ata_status = mv_get_crpb_status(ap); | 1384 | */ |
| 1384 | handled++; | 1385 | if (pp->pp_flags & MV_PP_FLAG_EDMA_EN) { |
| 1385 | } else if ((DEV_IRQ << hard_port) & hc_irq_cause) { | 1386 | /* EDMA: check for response queue interrupt */ |
| 1386 | /* received ATA IRQ; read the status reg to clear INTRQ | 1387 | if ((CRPB_DMA_DONE << hard_port) & hc_irq_cause) { |
| 1387 | */ | 1388 | ata_status = mv_get_crpb_status(ap); |
| 1388 | ata_status = readb((void __iomem *) | 1389 | handled = 1; |
| 1390 | } | ||
| 1391 | } else { | ||
| 1392 | /* PIO: check for device (drive) interrupt */ | ||
| 1393 | if ((DEV_IRQ << hard_port) & hc_irq_cause) { | ||
| 1394 | ata_status = readb((void __iomem *) | ||
| 1389 | ap->ioaddr.status_addr); | 1395 | ap->ioaddr.status_addr); |
| 1390 | handled++; | 1396 | handled = 1; |
| 1397 | } | ||
| 1391 | } | 1398 | } |
| 1392 | 1399 | ||
| 1393 | if (ap && | 1400 | if (ap->flags & (ATA_FLAG_PORT_DISABLED | ATA_FLAG_NOINTR)) |
| 1394 | (ap->flags & (ATA_FLAG_PORT_DISABLED | ATA_FLAG_NOINTR))) | ||
| 1395 | continue; | 1401 | continue; |
| 1396 | 1402 | ||
| 1397 | err_mask = ac_err_mask(ata_status); | 1403 | err_mask = ac_err_mask(ata_status); |
| @@ -1403,12 +1409,12 @@ static void mv_host_intr(struct ata_host_set *host_set, u32 relevant, | |||
| 1403 | if ((PORT0_ERR << shift) & relevant) { | 1409 | if ((PORT0_ERR << shift) & relevant) { |
| 1404 | mv_err_intr(ap); | 1410 | mv_err_intr(ap); |
| 1405 | err_mask |= AC_ERR_OTHER; | 1411 | err_mask |= AC_ERR_OTHER; |
| 1406 | handled++; | 1412 | handled = 1; |
| 1407 | } | 1413 | } |
| 1408 | 1414 | ||
| 1409 | if (handled && ap) { | 1415 | if (handled) { |
| 1410 | qc = ata_qc_from_tag(ap, ap->active_tag); | 1416 | qc = ata_qc_from_tag(ap, ap->active_tag); |
| 1411 | if (NULL != qc) { | 1417 | if (qc && (qc->flags & ATA_QCFLAG_ACTIVE)) { |
| 1412 | VPRINTK("port %u IRQ found for qc, " | 1418 | VPRINTK("port %u IRQ found for qc, " |
| 1413 | "ata_status 0x%x\n", port,ata_status); | 1419 | "ata_status 0x%x\n", port,ata_status); |
| 1414 | /* mark qc status appropriately */ | 1420 | /* mark qc status appropriately */ |
diff --git a/drivers/scsi/zalon.c b/drivers/scsi/zalon.c index b131432c677d..a6cfbb3b361c 100644 --- a/drivers/scsi/zalon.c +++ b/drivers/scsi/zalon.c | |||
| @@ -88,7 +88,7 @@ zalon_probe(struct parisc_device *dev) | |||
| 88 | struct gsc_irq gsc_irq; | 88 | struct gsc_irq gsc_irq; |
| 89 | u32 zalon_vers; | 89 | u32 zalon_vers; |
| 90 | int error = -ENODEV; | 90 | int error = -ENODEV; |
| 91 | void __iomem *zalon = ioremap(dev->hpa.start, 4096); | 91 | void __iomem *zalon = ioremap_nocache(dev->hpa.start, 4096); |
| 92 | void __iomem *io_port = zalon + GSC_SCSI_ZALON_OFFSET; | 92 | void __iomem *io_port = zalon + GSC_SCSI_ZALON_OFFSET; |
| 93 | static int unit = 0; | 93 | static int unit = 0; |
| 94 | struct Scsi_Host *host; | 94 | struct Scsi_Host *host; |
diff --git a/drivers/serial/8250_gsc.c b/drivers/serial/8250_gsc.c index 8b4947933d9b..913c71cc0569 100644 --- a/drivers/serial/8250_gsc.c +++ b/drivers/serial/8250_gsc.c | |||
| @@ -52,13 +52,14 @@ serial_init_chip(struct parisc_device *dev) | |||
| 52 | address += 0x800; | 52 | address += 0x800; |
| 53 | } | 53 | } |
| 54 | 54 | ||
| 55 | memset(&port, 0, sizeof(struct uart_port)); | 55 | memset(&port, 0, sizeof(port)); |
| 56 | port.mapbase = address; | 56 | port.iotype = UPIO_MEM; |
| 57 | port.irq = dev->irq; | 57 | port.uartclk = LASI_BASE_BAUD * 16; |
| 58 | port.iotype = UPIO_MEM; | 58 | port.mapbase = address; |
| 59 | port.flags = UPF_IOREMAP | UPF_BOOT_AUTOCONF; | 59 | port.membase = ioremap_nocache(address, 16); |
| 60 | port.uartclk = LASI_BASE_BAUD * 16; | 60 | port.irq = dev->irq; |
| 61 | port.dev = &dev->dev; | 61 | port.flags = UPF_BOOT_AUTOCONF; |
| 62 | port.dev = &dev->dev; | ||
| 62 | 63 | ||
| 63 | err = serial8250_register_port(&port); | 64 | err = serial8250_register_port(&port); |
| 64 | if (err < 0) { | 65 | if (err < 0) { |
diff --git a/drivers/serial/jsm/jsm_tty.c b/drivers/serial/jsm/jsm_tty.c index 4d48b625cd3d..7d823705193c 100644 --- a/drivers/serial/jsm/jsm_tty.c +++ b/drivers/serial/jsm/jsm_tty.c | |||
| @@ -142,12 +142,14 @@ static void jsm_tty_send_xchar(struct uart_port *port, char ch) | |||
| 142 | { | 142 | { |
| 143 | unsigned long lock_flags; | 143 | unsigned long lock_flags; |
| 144 | struct jsm_channel *channel = (struct jsm_channel *)port; | 144 | struct jsm_channel *channel = (struct jsm_channel *)port; |
| 145 | struct termios *termios; | ||
| 145 | 146 | ||
| 146 | spin_lock_irqsave(&port->lock, lock_flags); | 147 | spin_lock_irqsave(&port->lock, lock_flags); |
| 147 | if (ch == port->info->tty->termios->c_cc[VSTART]) | 148 | termios = port->info->tty->termios; |
| 149 | if (ch == termios->c_cc[VSTART]) | ||
| 148 | channel->ch_bd->bd_ops->send_start_character(channel); | 150 | channel->ch_bd->bd_ops->send_start_character(channel); |
| 149 | 151 | ||
| 150 | if (ch == port->info->tty->termios->c_cc[VSTOP]) | 152 | if (ch == termios->c_cc[VSTOP]) |
| 151 | channel->ch_bd->bd_ops->send_stop_character(channel); | 153 | channel->ch_bd->bd_ops->send_stop_character(channel); |
| 152 | spin_unlock_irqrestore(&port->lock, lock_flags); | 154 | spin_unlock_irqrestore(&port->lock, lock_flags); |
| 153 | } | 155 | } |
| @@ -178,6 +180,7 @@ static int jsm_tty_open(struct uart_port *port) | |||
| 178 | struct jsm_board *brd; | 180 | struct jsm_board *brd; |
| 179 | int rc = 0; | 181 | int rc = 0; |
| 180 | struct jsm_channel *channel = (struct jsm_channel *)port; | 182 | struct jsm_channel *channel = (struct jsm_channel *)port; |
| 183 | struct termios *termios; | ||
| 181 | 184 | ||
| 182 | /* Get board pointer from our array of majors we have allocated */ | 185 | /* Get board pointer from our array of majors we have allocated */ |
| 183 | brd = channel->ch_bd; | 186 | brd = channel->ch_bd; |
| @@ -239,12 +242,13 @@ static int jsm_tty_open(struct uart_port *port) | |||
| 239 | channel->ch_cached_lsr = 0; | 242 | channel->ch_cached_lsr = 0; |
| 240 | channel->ch_stops_sent = 0; | 243 | channel->ch_stops_sent = 0; |
| 241 | 244 | ||
| 242 | channel->ch_c_cflag = port->info->tty->termios->c_cflag; | 245 | termios = port->info->tty->termios; |
| 243 | channel->ch_c_iflag = port->info->tty->termios->c_iflag; | 246 | channel->ch_c_cflag = termios->c_cflag; |
| 244 | channel->ch_c_oflag = port->info->tty->termios->c_oflag; | 247 | channel->ch_c_iflag = termios->c_iflag; |
| 245 | channel->ch_c_lflag = port->info->tty->termios->c_lflag; | 248 | channel->ch_c_oflag = termios->c_oflag; |
| 246 | channel->ch_startc = port->info->tty->termios->c_cc[VSTART]; | 249 | channel->ch_c_lflag = termios->c_lflag; |
| 247 | channel->ch_stopc = port->info->tty->termios->c_cc[VSTOP]; | 250 | channel->ch_startc = termios->c_cc[VSTART]; |
| 251 | channel->ch_stopc = termios->c_cc[VSTOP]; | ||
| 248 | 252 | ||
| 249 | /* Tell UART to init itself */ | 253 | /* Tell UART to init itself */ |
| 250 | brd->bd_ops->uart_init(channel); | 254 | brd->bd_ops->uart_init(channel); |
| @@ -784,6 +788,7 @@ static void jsm_carrier(struct jsm_channel *ch) | |||
| 784 | 788 | ||
| 785 | void jsm_check_queue_flow_control(struct jsm_channel *ch) | 789 | void jsm_check_queue_flow_control(struct jsm_channel *ch) |
| 786 | { | 790 | { |
| 791 | struct board_ops *bd_ops = ch->ch_bd->bd_ops; | ||
| 787 | int qleft = 0; | 792 | int qleft = 0; |
| 788 | 793 | ||
| 789 | /* Store how much space we have left in the queue */ | 794 | /* Store how much space we have left in the queue */ |
| @@ -809,7 +814,7 @@ void jsm_check_queue_flow_control(struct jsm_channel *ch) | |||
| 809 | /* HWFLOW */ | 814 | /* HWFLOW */ |
| 810 | if (ch->ch_c_cflag & CRTSCTS) { | 815 | if (ch->ch_c_cflag & CRTSCTS) { |
| 811 | if(!(ch->ch_flags & CH_RECEIVER_OFF)) { | 816 | if(!(ch->ch_flags & CH_RECEIVER_OFF)) { |
| 812 | ch->ch_bd->bd_ops->disable_receiver(ch); | 817 | bd_ops->disable_receiver(ch); |
| 813 | ch->ch_flags |= (CH_RECEIVER_OFF); | 818 | ch->ch_flags |= (CH_RECEIVER_OFF); |
| 814 | jsm_printk(READ, INFO, &ch->ch_bd->pci_dev, | 819 | jsm_printk(READ, INFO, &ch->ch_bd->pci_dev, |
| 815 | "Internal queue hit hilevel mark (%d)! Turning off interrupts.\n", | 820 | "Internal queue hit hilevel mark (%d)! Turning off interrupts.\n", |
| @@ -819,7 +824,7 @@ void jsm_check_queue_flow_control(struct jsm_channel *ch) | |||
| 819 | /* SWFLOW */ | 824 | /* SWFLOW */ |
| 820 | else if (ch->ch_c_iflag & IXOFF) { | 825 | else if (ch->ch_c_iflag & IXOFF) { |
| 821 | if (ch->ch_stops_sent <= MAX_STOPS_SENT) { | 826 | if (ch->ch_stops_sent <= MAX_STOPS_SENT) { |
| 822 | ch->ch_bd->bd_ops->send_stop_character(ch); | 827 | bd_ops->send_stop_character(ch); |
| 823 | ch->ch_stops_sent++; | 828 | ch->ch_stops_sent++; |
| 824 | jsm_printk(READ, INFO, &ch->ch_bd->pci_dev, | 829 | jsm_printk(READ, INFO, &ch->ch_bd->pci_dev, |
| 825 | "Sending stop char! Times sent: %x\n", ch->ch_stops_sent); | 830 | "Sending stop char! Times sent: %x\n", ch->ch_stops_sent); |
| @@ -846,7 +851,7 @@ void jsm_check_queue_flow_control(struct jsm_channel *ch) | |||
| 846 | /* HWFLOW */ | 851 | /* HWFLOW */ |
| 847 | if (ch->ch_c_cflag & CRTSCTS) { | 852 | if (ch->ch_c_cflag & CRTSCTS) { |
| 848 | if (ch->ch_flags & CH_RECEIVER_OFF) { | 853 | if (ch->ch_flags & CH_RECEIVER_OFF) { |
| 849 | ch->ch_bd->bd_ops->enable_receiver(ch); | 854 | bd_ops->enable_receiver(ch); |
| 850 | ch->ch_flags &= ~(CH_RECEIVER_OFF); | 855 | ch->ch_flags &= ~(CH_RECEIVER_OFF); |
| 851 | jsm_printk(READ, INFO, &ch->ch_bd->pci_dev, | 856 | jsm_printk(READ, INFO, &ch->ch_bd->pci_dev, |
| 852 | "Internal queue hit lowlevel mark (%d)! Turning on interrupts.\n", | 857 | "Internal queue hit lowlevel mark (%d)! Turning on interrupts.\n", |
| @@ -856,7 +861,7 @@ void jsm_check_queue_flow_control(struct jsm_channel *ch) | |||
| 856 | /* SWFLOW */ | 861 | /* SWFLOW */ |
| 857 | else if (ch->ch_c_iflag & IXOFF && ch->ch_stops_sent) { | 862 | else if (ch->ch_c_iflag & IXOFF && ch->ch_stops_sent) { |
| 858 | ch->ch_stops_sent = 0; | 863 | ch->ch_stops_sent = 0; |
| 859 | ch->ch_bd->bd_ops->send_start_character(ch); | 864 | bd_ops->send_start_character(ch); |
| 860 | jsm_printk(READ, INFO, &ch->ch_bd->pci_dev, "Sending start char!\n"); | 865 | jsm_printk(READ, INFO, &ch->ch_bd->pci_dev, "Sending start char!\n"); |
| 861 | } | 866 | } |
| 862 | } | 867 | } |
diff --git a/drivers/serial/mux.c b/drivers/serial/mux.c index 868eaf4a1a68..64c0e89124c9 100644 --- a/drivers/serial/mux.c +++ b/drivers/serial/mux.c | |||
| @@ -51,7 +51,7 @@ | |||
| 51 | #define MUX_BREAK(status) ((status & 0xF000) == 0x2000) | 51 | #define MUX_BREAK(status) ((status & 0xF000) == 0x2000) |
| 52 | 52 | ||
| 53 | #define MUX_NR 256 | 53 | #define MUX_NR 256 |
| 54 | static unsigned int port_cnt = 0; | 54 | static unsigned int port_cnt __read_mostly; |
| 55 | static struct uart_port mux_ports[MUX_NR]; | 55 | static struct uart_port mux_ports[MUX_NR]; |
| 56 | 56 | ||
| 57 | static struct uart_driver mux_driver = { | 57 | static struct uart_driver mux_driver = { |
| @@ -461,7 +461,7 @@ static int __init mux_probe(struct parisc_device *dev) | |||
| 461 | port->iobase = 0; | 461 | port->iobase = 0; |
| 462 | port->mapbase = dev->hpa.start + MUX_OFFSET + | 462 | port->mapbase = dev->hpa.start + MUX_OFFSET + |
| 463 | (i * MUX_LINE_OFFSET); | 463 | (i * MUX_LINE_OFFSET); |
| 464 | port->membase = ioremap(port->mapbase, MUX_LINE_OFFSET); | 464 | port->membase = ioremap_nocache(port->mapbase, MUX_LINE_OFFSET); |
| 465 | port->iotype = UPIO_MEM; | 465 | port->iotype = UPIO_MEM; |
| 466 | port->type = PORT_MUX; | 466 | port->type = PORT_MUX; |
| 467 | port->irq = NO_IRQ; | 467 | port->irq = NO_IRQ; |
diff --git a/drivers/video/Kconfig b/drivers/video/Kconfig index 22e9d696fdd2..f87c0171f4ec 100644 --- a/drivers/video/Kconfig +++ b/drivers/video/Kconfig | |||
| @@ -904,18 +904,6 @@ config FB_MATROX_MULTIHEAD | |||
| 904 | There is no need for enabling 'Matrox multihead support' if you have | 904 | There is no need for enabling 'Matrox multihead support' if you have |
| 905 | only one Matrox card in the box. | 905 | only one Matrox card in the box. |
| 906 | 906 | ||
| 907 | config FB_RADEON_OLD | ||
| 908 | tristate "ATI Radeon display support (Old driver)" | ||
| 909 | depends on FB && PCI | ||
| 910 | select FB_CFB_FILLRECT | ||
| 911 | select FB_CFB_COPYAREA | ||
| 912 | select FB_CFB_IMAGEBLIT | ||
| 913 | select FB_MACMODES if PPC | ||
| 914 | help | ||
| 915 | Choose this option if you want to use an ATI Radeon graphics card as | ||
| 916 | a framebuffer device. There are both PCI and AGP versions. You | ||
| 917 | don't need to choose this to run the Radeon in plain VGA mode. | ||
| 918 | |||
| 919 | config FB_RADEON | 907 | config FB_RADEON |
| 920 | tristate "ATI Radeon display support" | 908 | tristate "ATI Radeon display support" |
| 921 | depends on FB && PCI | 909 | depends on FB && PCI |
diff --git a/drivers/video/Makefile b/drivers/video/Makefile index cb90218515ac..23de3b2c7856 100644 --- a/drivers/video/Makefile +++ b/drivers/video/Makefile | |||
| @@ -39,7 +39,6 @@ obj-$(CONFIG_FB_KYRO) += kyro/ | |||
| 39 | obj-$(CONFIG_FB_SAVAGE) += savage/ | 39 | obj-$(CONFIG_FB_SAVAGE) += savage/ |
| 40 | obj-$(CONFIG_FB_GEODE) += geode/ | 40 | obj-$(CONFIG_FB_GEODE) += geode/ |
| 41 | obj-$(CONFIG_FB_I810) += vgastate.o | 41 | obj-$(CONFIG_FB_I810) += vgastate.o |
| 42 | obj-$(CONFIG_FB_RADEON_OLD) += radeonfb.o | ||
| 43 | obj-$(CONFIG_FB_NEOMAGIC) += neofb.o vgastate.o | 42 | obj-$(CONFIG_FB_NEOMAGIC) += neofb.o vgastate.o |
| 44 | obj-$(CONFIG_FB_VIRGE) += virgefb.o | 43 | obj-$(CONFIG_FB_VIRGE) += virgefb.o |
| 45 | obj-$(CONFIG_FB_3DFX) += tdfxfb.o | 44 | obj-$(CONFIG_FB_3DFX) += tdfxfb.o |
diff --git a/drivers/video/backlight/Kconfig b/drivers/video/backlight/Kconfig index 9d996f2c10d5..b895eaaa73fd 100644 --- a/drivers/video/backlight/Kconfig +++ b/drivers/video/backlight/Kconfig | |||
| @@ -43,11 +43,11 @@ config LCD_DEVICE | |||
| 43 | default y | 43 | default y |
| 44 | 44 | ||
| 45 | config BACKLIGHT_CORGI | 45 | config BACKLIGHT_CORGI |
| 46 | tristate "Sharp Corgi Backlight Driver (SL-C7xx Series)" | 46 | tristate "Sharp Corgi Backlight Driver (SL Series)" |
| 47 | depends on BACKLIGHT_DEVICE && PXA_SHARPSL | 47 | depends on BACKLIGHT_DEVICE && PXA_SHARPSL |
| 48 | default y | 48 | default y |
| 49 | help | 49 | help |
| 50 | If you have a Sharp Zaurus SL-C7xx, say y to enable the | 50 | If you have a Sharp Zaurus SL-C7xx, SL-Cxx00 or SL-6000x say y to enable the |
| 51 | backlight driver. | 51 | backlight driver. |
| 52 | 52 | ||
| 53 | config BACKLIGHT_HP680 | 53 | config BACKLIGHT_HP680 |
diff --git a/drivers/video/backlight/backlight.c b/drivers/video/backlight/backlight.c index 151fda8dded0..334b1db1bd7c 100644 --- a/drivers/video/backlight/backlight.c +++ b/drivers/video/backlight/backlight.c | |||
| @@ -16,14 +16,12 @@ | |||
| 16 | 16 | ||
| 17 | static ssize_t backlight_show_power(struct class_device *cdev, char *buf) | 17 | static ssize_t backlight_show_power(struct class_device *cdev, char *buf) |
| 18 | { | 18 | { |
| 19 | int rc; | 19 | int rc = -ENXIO; |
| 20 | struct backlight_device *bd = to_backlight_device(cdev); | 20 | struct backlight_device *bd = to_backlight_device(cdev); |
| 21 | 21 | ||
| 22 | down(&bd->sem); | 22 | down(&bd->sem); |
| 23 | if (likely(bd->props && bd->props->get_power)) | 23 | if (likely(bd->props)) |
| 24 | rc = sprintf(buf, "%d\n", bd->props->get_power(bd)); | 24 | rc = sprintf(buf, "%d\n", bd->props->power); |
| 25 | else | ||
| 26 | rc = -ENXIO; | ||
| 27 | up(&bd->sem); | 25 | up(&bd->sem); |
| 28 | 26 | ||
| 29 | return rc; | 27 | return rc; |
| @@ -31,7 +29,7 @@ static ssize_t backlight_show_power(struct class_device *cdev, char *buf) | |||
| 31 | 29 | ||
| 32 | static ssize_t backlight_store_power(struct class_device *cdev, const char *buf, size_t count) | 30 | static ssize_t backlight_store_power(struct class_device *cdev, const char *buf, size_t count) |
| 33 | { | 31 | { |
| 34 | int rc, power; | 32 | int rc = -ENXIO, power; |
| 35 | char *endp; | 33 | char *endp; |
| 36 | struct backlight_device *bd = to_backlight_device(cdev); | 34 | struct backlight_device *bd = to_backlight_device(cdev); |
| 37 | 35 | ||
| @@ -40,12 +38,13 @@ static ssize_t backlight_store_power(struct class_device *cdev, const char *buf, | |||
| 40 | return -EINVAL; | 38 | return -EINVAL; |
| 41 | 39 | ||
| 42 | down(&bd->sem); | 40 | down(&bd->sem); |
| 43 | if (likely(bd->props && bd->props->set_power)) { | 41 | if (likely(bd->props)) { |
| 44 | pr_debug("backlight: set power to %d\n", power); | 42 | pr_debug("backlight: set power to %d\n", power); |
| 45 | bd->props->set_power(bd, power); | 43 | bd->props->power = power; |
| 44 | if (likely(bd->props->update_status)) | ||
| 45 | bd->props->update_status(bd); | ||
| 46 | rc = count; | 46 | rc = count; |
| 47 | } else | 47 | } |
| 48 | rc = -ENXIO; | ||
| 49 | up(&bd->sem); | 48 | up(&bd->sem); |
| 50 | 49 | ||
| 51 | return rc; | 50 | return rc; |
| @@ -53,14 +52,12 @@ static ssize_t backlight_store_power(struct class_device *cdev, const char *buf, | |||
| 53 | 52 | ||
| 54 | static ssize_t backlight_show_brightness(struct class_device *cdev, char *buf) | 53 | static ssize_t backlight_show_brightness(struct class_device *cdev, char *buf) |
| 55 | { | 54 | { |
| 56 | int rc; | 55 | int rc = -ENXIO; |
| 57 | struct backlight_device *bd = to_backlight_device(cdev); | 56 | struct backlight_device *bd = to_backlight_device(cdev); |
| 58 | 57 | ||
| 59 | down(&bd->sem); | 58 | down(&bd->sem); |
| 60 | if (likely(bd->props && bd->props->get_brightness)) | 59 | if (likely(bd->props)) |
| 61 | rc = sprintf(buf, "%d\n", bd->props->get_brightness(bd)); | 60 | rc = sprintf(buf, "%d\n", bd->props->brightness); |
| 62 | else | ||
| 63 | rc = -ENXIO; | ||
| 64 | up(&bd->sem); | 61 | up(&bd->sem); |
| 65 | 62 | ||
| 66 | return rc; | 63 | return rc; |
| @@ -68,7 +65,7 @@ static ssize_t backlight_show_brightness(struct class_device *cdev, char *buf) | |||
| 68 | 65 | ||
| 69 | static ssize_t backlight_store_brightness(struct class_device *cdev, const char *buf, size_t count) | 66 | static ssize_t backlight_store_brightness(struct class_device *cdev, const char *buf, size_t count) |
| 70 | { | 67 | { |
| 71 | int rc, brightness; | 68 | int rc = -ENXIO, brightness; |
| 72 | char *endp; | 69 | char *endp; |
| 73 | struct backlight_device *bd = to_backlight_device(cdev); | 70 | struct backlight_device *bd = to_backlight_device(cdev); |
| 74 | 71 | ||
| @@ -77,12 +74,18 @@ static ssize_t backlight_store_brightness(struct class_device *cdev, const char | |||
| 77 | return -EINVAL; | 74 | return -EINVAL; |
| 78 | 75 | ||
| 79 | down(&bd->sem); | 76 | down(&bd->sem); |
| 80 | if (likely(bd->props && bd->props->set_brightness)) { | 77 | if (likely(bd->props)) { |
| 81 | pr_debug("backlight: set brightness to %d\n", brightness); | 78 | if (brightness > bd->props->max_brightness) |
| 82 | bd->props->set_brightness(bd, brightness); | 79 | rc = -EINVAL; |
| 83 | rc = count; | 80 | else { |
| 84 | } else | 81 | pr_debug("backlight: set brightness to %d\n", |
| 85 | rc = -ENXIO; | 82 | brightness); |
| 83 | bd->props->brightness = brightness; | ||
| 84 | if (likely(bd->props->update_status)) | ||
| 85 | bd->props->update_status(bd); | ||
| 86 | rc = count; | ||
| 87 | } | ||
| 88 | } | ||
| 86 | up(&bd->sem); | 89 | up(&bd->sem); |
| 87 | 90 | ||
| 88 | return rc; | 91 | return rc; |
| @@ -90,14 +93,26 @@ static ssize_t backlight_store_brightness(struct class_device *cdev, const char | |||
| 90 | 93 | ||
| 91 | static ssize_t backlight_show_max_brightness(struct class_device *cdev, char *buf) | 94 | static ssize_t backlight_show_max_brightness(struct class_device *cdev, char *buf) |
| 92 | { | 95 | { |
| 93 | int rc; | 96 | int rc = -ENXIO; |
| 94 | struct backlight_device *bd = to_backlight_device(cdev); | 97 | struct backlight_device *bd = to_backlight_device(cdev); |
| 95 | 98 | ||
| 96 | down(&bd->sem); | 99 | down(&bd->sem); |
| 97 | if (likely(bd->props)) | 100 | if (likely(bd->props)) |
| 98 | rc = sprintf(buf, "%d\n", bd->props->max_brightness); | 101 | rc = sprintf(buf, "%d\n", bd->props->max_brightness); |
| 99 | else | 102 | up(&bd->sem); |
| 100 | rc = -ENXIO; | 103 | |
| 104 | return rc; | ||
| 105 | } | ||
| 106 | |||
| 107 | static ssize_t backlight_show_actual_brightness(struct class_device *cdev, | ||
| 108 | char *buf) | ||
| 109 | { | ||
| 110 | int rc = -ENXIO; | ||
| 111 | struct backlight_device *bd = to_backlight_device(cdev); | ||
| 112 | |||
| 113 | down(&bd->sem); | ||
| 114 | if (likely(bd->props && bd->props->get_brightness)) | ||
| 115 | rc = sprintf(buf, "%d\n", bd->props->get_brightness(bd)); | ||
| 101 | up(&bd->sem); | 116 | up(&bd->sem); |
| 102 | 117 | ||
| 103 | return rc; | 118 | return rc; |
| @@ -123,7 +138,10 @@ static struct class backlight_class = { | |||
| 123 | 138 | ||
| 124 | static struct class_device_attribute bl_class_device_attributes[] = { | 139 | static struct class_device_attribute bl_class_device_attributes[] = { |
| 125 | DECLARE_ATTR(power, 0644, backlight_show_power, backlight_store_power), | 140 | DECLARE_ATTR(power, 0644, backlight_show_power, backlight_store_power), |
| 126 | DECLARE_ATTR(brightness, 0644, backlight_show_brightness, backlight_store_brightness), | 141 | DECLARE_ATTR(brightness, 0644, backlight_show_brightness, |
| 142 | backlight_store_brightness), | ||
| 143 | DECLARE_ATTR(actual_brightness, 0444, backlight_show_actual_brightness, | ||
| 144 | NULL), | ||
| 127 | DECLARE_ATTR(max_brightness, 0444, backlight_show_max_brightness, NULL), | 145 | DECLARE_ATTR(max_brightness, 0444, backlight_show_max_brightness, NULL), |
| 128 | }; | 146 | }; |
| 129 | 147 | ||
| @@ -144,8 +162,12 @@ static int fb_notifier_callback(struct notifier_block *self, | |||
| 144 | bd = container_of(self, struct backlight_device, fb_notif); | 162 | bd = container_of(self, struct backlight_device, fb_notif); |
| 145 | down(&bd->sem); | 163 | down(&bd->sem); |
| 146 | if (bd->props) | 164 | if (bd->props) |
| 147 | if (!bd->props->check_fb || bd->props->check_fb(evdata->info)) | 165 | if (!bd->props->check_fb || |
| 148 | bd->props->set_power(bd, *(int *)evdata->data); | 166 | bd->props->check_fb(evdata->info)) { |
| 167 | bd->props->fb_blank = *(int *)evdata->data; | ||
| 168 | if (likely(bd->props && bd->props->update_status)) | ||
| 169 | bd->props->update_status(bd); | ||
| 170 | } | ||
| 149 | up(&bd->sem); | 171 | up(&bd->sem); |
| 150 | return 0; | 172 | return 0; |
| 151 | } | 173 | } |
| @@ -231,6 +253,12 @@ void backlight_device_unregister(struct backlight_device *bd) | |||
| 231 | &bl_class_device_attributes[i]); | 253 | &bl_class_device_attributes[i]); |
| 232 | 254 | ||
| 233 | down(&bd->sem); | 255 | down(&bd->sem); |
| 256 | if (likely(bd->props && bd->props->update_status)) { | ||
| 257 | bd->props->brightness = 0; | ||
| 258 | bd->props->power = 0; | ||
| 259 | bd->props->update_status(bd); | ||
| 260 | } | ||
| 261 | |||
| 234 | bd->props = NULL; | 262 | bd->props = NULL; |
| 235 | up(&bd->sem); | 263 | up(&bd->sem); |
| 236 | 264 | ||
diff --git a/drivers/video/backlight/corgi_bl.c b/drivers/video/backlight/corgi_bl.c index d0aaf450e8c7..2ebbfd95145f 100644 --- a/drivers/video/backlight/corgi_bl.c +++ b/drivers/video/backlight/corgi_bl.c | |||
| @@ -1,7 +1,7 @@ | |||
| 1 | /* | 1 | /* |
| 2 | * Backlight Driver for Sharp Corgi | 2 | * Backlight Driver for Sharp Zaurus Handhelds (various models) |
| 3 | * | 3 | * |
| 4 | * Copyright (c) 2004-2005 Richard Purdie | 4 | * Copyright (c) 2004-2006 Richard Purdie |
| 5 | * | 5 | * |
| 6 | * Based on Sharp's 2.4 Backlight Driver | 6 | * Based on Sharp's 2.4 Backlight Driver |
| 7 | * | 7 | * |
| @@ -15,80 +15,63 @@ | |||
| 15 | #include <linux/kernel.h> | 15 | #include <linux/kernel.h> |
| 16 | #include <linux/init.h> | 16 | #include <linux/init.h> |
| 17 | #include <linux/platform_device.h> | 17 | #include <linux/platform_device.h> |
| 18 | #include <linux/spinlock.h> | 18 | #include <linux/mutex.h> |
| 19 | #include <linux/fb.h> | 19 | #include <linux/fb.h> |
| 20 | #include <linux/backlight.h> | 20 | #include <linux/backlight.h> |
| 21 | |||
| 22 | #include <asm/arch/sharpsl.h> | 21 | #include <asm/arch/sharpsl.h> |
| 23 | #include <asm/hardware/sharpsl_pm.h> | 22 | #include <asm/hardware/sharpsl_pm.h> |
| 24 | 23 | ||
| 25 | #define CORGI_DEFAULT_INTENSITY 0x1f | 24 | static int corgibl_intensity; |
| 26 | #define CORGI_LIMIT_MASK 0x0b | 25 | static DEFINE_MUTEX(bl_mutex); |
| 27 | |||
| 28 | static int corgibl_powermode = FB_BLANK_UNBLANK; | ||
| 29 | static int current_intensity = 0; | ||
| 30 | static int corgibl_limit = 0; | ||
| 31 | static void (*corgibl_mach_set_intensity)(int intensity); | ||
| 32 | static spinlock_t bl_lock = SPIN_LOCK_UNLOCKED; | ||
| 33 | static struct backlight_properties corgibl_data; | 26 | static struct backlight_properties corgibl_data; |
| 27 | static struct backlight_device *corgi_backlight_device; | ||
| 28 | static struct corgibl_machinfo *bl_machinfo; | ||
| 34 | 29 | ||
| 35 | static void corgibl_send_intensity(int intensity) | 30 | static unsigned long corgibl_flags; |
| 31 | #define CORGIBL_SUSPENDED 0x01 | ||
| 32 | #define CORGIBL_BATTLOW 0x02 | ||
| 33 | |||
| 34 | static int corgibl_send_intensity(struct backlight_device *bd) | ||
| 36 | { | 35 | { |
| 37 | unsigned long flags; | ||
| 38 | void (*corgi_kick_batt)(void); | 36 | void (*corgi_kick_batt)(void); |
| 37 | int intensity = bd->props->brightness; | ||
| 39 | 38 | ||
| 40 | if (corgibl_powermode != FB_BLANK_UNBLANK) { | 39 | if (bd->props->power != FB_BLANK_UNBLANK) |
| 41 | intensity = 0; | 40 | intensity = 0; |
| 42 | } else { | 41 | if (bd->props->fb_blank != FB_BLANK_UNBLANK) |
| 43 | if (corgibl_limit) | 42 | intensity = 0; |
| 44 | intensity &= CORGI_LIMIT_MASK; | 43 | if (corgibl_flags & CORGIBL_SUSPENDED) |
| 45 | } | 44 | intensity = 0; |
| 46 | 45 | if (corgibl_flags & CORGIBL_BATTLOW) | |
| 47 | spin_lock_irqsave(&bl_lock, flags); | 46 | intensity &= bl_machinfo->limit_mask; |
| 48 | 47 | ||
| 49 | corgibl_mach_set_intensity(intensity); | 48 | mutex_lock(&bl_mutex); |
| 49 | bl_machinfo->set_bl_intensity(intensity); | ||
| 50 | mutex_unlock(&bl_mutex); | ||
| 50 | 51 | ||
| 51 | spin_unlock_irqrestore(&bl_lock, flags); | 52 | corgibl_intensity = intensity; |
| 52 | 53 | ||
| 53 | corgi_kick_batt = symbol_get(sharpsl_battery_kick); | 54 | corgi_kick_batt = symbol_get(sharpsl_battery_kick); |
| 54 | if (corgi_kick_batt) { | 55 | if (corgi_kick_batt) { |
| 55 | corgi_kick_batt(); | 56 | corgi_kick_batt(); |
| 56 | symbol_put(sharpsl_battery_kick); | 57 | symbol_put(sharpsl_battery_kick); |
| 57 | } | 58 | } |
| 58 | } | ||
| 59 | 59 | ||
| 60 | static void corgibl_blank(int blank) | 60 | return 0; |
| 61 | { | ||
| 62 | switch(blank) { | ||
| 63 | |||
| 64 | case FB_BLANK_NORMAL: | ||
| 65 | case FB_BLANK_VSYNC_SUSPEND: | ||
| 66 | case FB_BLANK_HSYNC_SUSPEND: | ||
| 67 | case FB_BLANK_POWERDOWN: | ||
| 68 | if (corgibl_powermode == FB_BLANK_UNBLANK) { | ||
| 69 | corgibl_send_intensity(0); | ||
| 70 | corgibl_powermode = blank; | ||
| 71 | } | ||
| 72 | break; | ||
| 73 | case FB_BLANK_UNBLANK: | ||
| 74 | if (corgibl_powermode != FB_BLANK_UNBLANK) { | ||
| 75 | corgibl_powermode = blank; | ||
| 76 | corgibl_send_intensity(current_intensity); | ||
| 77 | } | ||
| 78 | break; | ||
| 79 | } | ||
| 80 | } | 61 | } |
| 81 | 62 | ||
| 82 | #ifdef CONFIG_PM | 63 | #ifdef CONFIG_PM |
| 83 | static int corgibl_suspend(struct platform_device *dev, pm_message_t state) | 64 | static int corgibl_suspend(struct platform_device *dev, pm_message_t state) |
| 84 | { | 65 | { |
| 85 | corgibl_blank(FB_BLANK_POWERDOWN); | 66 | corgibl_flags |= CORGIBL_SUSPENDED; |
| 67 | corgibl_send_intensity(corgi_backlight_device); | ||
| 86 | return 0; | 68 | return 0; |
| 87 | } | 69 | } |
| 88 | 70 | ||
| 89 | static int corgibl_resume(struct platform_device *dev) | 71 | static int corgibl_resume(struct platform_device *dev) |
| 90 | { | 72 | { |
| 91 | corgibl_blank(FB_BLANK_UNBLANK); | 73 | corgibl_flags &= ~CORGIBL_SUSPENDED; |
| 74 | corgibl_send_intensity(corgi_backlight_device); | ||
| 92 | return 0; | 75 | return 0; |
| 93 | } | 76 | } |
| 94 | #else | 77 | #else |
| @@ -96,68 +79,55 @@ static int corgibl_resume(struct platform_device *dev) | |||
| 96 | #define corgibl_resume NULL | 79 | #define corgibl_resume NULL |
| 97 | #endif | 80 | #endif |
| 98 | 81 | ||
| 99 | 82 | static int corgibl_get_intensity(struct backlight_device *bd) | |
| 100 | static int corgibl_set_power(struct backlight_device *bd, int state) | ||
| 101 | { | ||
| 102 | corgibl_blank(state); | ||
| 103 | return 0; | ||
| 104 | } | ||
| 105 | |||
| 106 | static int corgibl_get_power(struct backlight_device *bd) | ||
| 107 | { | 83 | { |
| 108 | return corgibl_powermode; | 84 | return corgibl_intensity; |
| 109 | } | 85 | } |
| 110 | 86 | ||
| 111 | static int corgibl_set_intensity(struct backlight_device *bd, int intensity) | 87 | static int corgibl_set_intensity(struct backlight_device *bd) |
| 112 | { | 88 | { |
| 113 | if (intensity > corgibl_data.max_brightness) | 89 | corgibl_send_intensity(corgi_backlight_device); |
| 114 | intensity = corgibl_data.max_brightness; | ||
| 115 | corgibl_send_intensity(intensity); | ||
| 116 | current_intensity=intensity; | ||
| 117 | return 0; | 90 | return 0; |
| 118 | } | 91 | } |
| 119 | 92 | ||
| 120 | static int corgibl_get_intensity(struct backlight_device *bd) | ||
| 121 | { | ||
| 122 | return current_intensity; | ||
| 123 | } | ||
| 124 | |||
| 125 | /* | 93 | /* |
| 126 | * Called when the battery is low to limit the backlight intensity. | 94 | * Called when the battery is low to limit the backlight intensity. |
| 127 | * If limit==0 clear any limit, otherwise limit the intensity | 95 | * If limit==0 clear any limit, otherwise limit the intensity |
| 128 | */ | 96 | */ |
| 129 | void corgibl_limit_intensity(int limit) | 97 | void corgibl_limit_intensity(int limit) |
| 130 | { | 98 | { |
| 131 | corgibl_limit = (limit ? 1 : 0); | 99 | if (limit) |
| 132 | corgibl_send_intensity(current_intensity); | 100 | corgibl_flags |= CORGIBL_BATTLOW; |
| 101 | else | ||
| 102 | corgibl_flags &= ~CORGIBL_BATTLOW; | ||
| 103 | corgibl_send_intensity(corgi_backlight_device); | ||
| 133 | } | 104 | } |
| 134 | EXPORT_SYMBOL(corgibl_limit_intensity); | 105 | EXPORT_SYMBOL(corgibl_limit_intensity); |
| 135 | 106 | ||
| 136 | 107 | ||
| 137 | static struct backlight_properties corgibl_data = { | 108 | static struct backlight_properties corgibl_data = { |
| 138 | .owner = THIS_MODULE, | 109 | .owner = THIS_MODULE, |
| 139 | .get_power = corgibl_get_power, | ||
| 140 | .set_power = corgibl_set_power, | ||
| 141 | .get_brightness = corgibl_get_intensity, | 110 | .get_brightness = corgibl_get_intensity, |
| 142 | .set_brightness = corgibl_set_intensity, | 111 | .update_status = corgibl_set_intensity, |
| 143 | }; | 112 | }; |
| 144 | 113 | ||
| 145 | static struct backlight_device *corgi_backlight_device; | ||
| 146 | |||
| 147 | static int __init corgibl_probe(struct platform_device *pdev) | 114 | static int __init corgibl_probe(struct platform_device *pdev) |
| 148 | { | 115 | { |
| 149 | struct corgibl_machinfo *machinfo = pdev->dev.platform_data; | 116 | struct corgibl_machinfo *machinfo = pdev->dev.platform_data; |
| 150 | 117 | ||
| 118 | bl_machinfo = machinfo; | ||
| 151 | corgibl_data.max_brightness = machinfo->max_intensity; | 119 | corgibl_data.max_brightness = machinfo->max_intensity; |
| 152 | corgibl_mach_set_intensity = machinfo->set_bl_intensity; | 120 | if (!machinfo->limit_mask) |
| 121 | machinfo->limit_mask = -1; | ||
| 153 | 122 | ||
| 154 | corgi_backlight_device = backlight_device_register ("corgi-bl", | 123 | corgi_backlight_device = backlight_device_register ("corgi-bl", |
| 155 | NULL, &corgibl_data); | 124 | NULL, &corgibl_data); |
| 156 | if (IS_ERR (corgi_backlight_device)) | 125 | if (IS_ERR (corgi_backlight_device)) |
| 157 | return PTR_ERR (corgi_backlight_device); | 126 | return PTR_ERR (corgi_backlight_device); |
| 158 | 127 | ||
| 159 | corgibl_set_intensity(NULL, CORGI_DEFAULT_INTENSITY); | 128 | corgibl_data.power = FB_BLANK_UNBLANK; |
| 160 | corgibl_limit_intensity(0); | 129 | corgibl_data.brightness = machinfo->default_intensity; |
| 130 | corgibl_send_intensity(corgi_backlight_device); | ||
| 161 | 131 | ||
| 162 | printk("Corgi Backlight Driver Initialized.\n"); | 132 | printk("Corgi Backlight Driver Initialized.\n"); |
| 163 | return 0; | 133 | return 0; |
| @@ -167,8 +137,6 @@ static int corgibl_remove(struct platform_device *dev) | |||
| 167 | { | 137 | { |
| 168 | backlight_device_unregister(corgi_backlight_device); | 138 | backlight_device_unregister(corgi_backlight_device); |
| 169 | 139 | ||
| 170 | corgibl_set_intensity(NULL, 0); | ||
| 171 | |||
| 172 | printk("Corgi Backlight Driver Unloaded\n"); | 140 | printk("Corgi Backlight Driver Unloaded\n"); |
| 173 | return 0; | 141 | return 0; |
| 174 | } | 142 | } |
diff --git a/drivers/video/backlight/hp680_bl.c b/drivers/video/backlight/hp680_bl.c index 95da4c9ed1f1..a71e984c93d4 100644 --- a/drivers/video/backlight/hp680_bl.c +++ b/drivers/video/backlight/hp680_bl.c | |||
| @@ -13,7 +13,7 @@ | |||
| 13 | #include <linux/module.h> | 13 | #include <linux/module.h> |
| 14 | #include <linux/kernel.h> | 14 | #include <linux/kernel.h> |
| 15 | #include <linux/init.h> | 15 | #include <linux/init.h> |
| 16 | #include <linux/device.h> | 16 | #include <linux/platform_device.h> |
| 17 | #include <linux/spinlock.h> | 17 | #include <linux/spinlock.h> |
| 18 | #include <linux/fb.h> | 18 | #include <linux/fb.h> |
| 19 | #include <linux/backlight.h> | 19 | #include <linux/backlight.h> |
| @@ -25,66 +25,58 @@ | |||
| 25 | #define HP680_MAX_INTENSITY 255 | 25 | #define HP680_MAX_INTENSITY 255 |
| 26 | #define HP680_DEFAULT_INTENSITY 10 | 26 | #define HP680_DEFAULT_INTENSITY 10 |
| 27 | 27 | ||
| 28 | static int hp680bl_powermode = FB_BLANK_UNBLANK; | 28 | static int hp680bl_suspended; |
| 29 | static int current_intensity = 0; | 29 | static int current_intensity = 0; |
| 30 | static spinlock_t bl_lock = SPIN_LOCK_UNLOCKED; | 30 | static spinlock_t bl_lock = SPIN_LOCK_UNLOCKED; |
| 31 | static struct backlight_device *hp680_backlight_device; | ||
| 31 | 32 | ||
| 32 | static void hp680bl_send_intensity(int intensity) | 33 | static void hp680bl_send_intensity(struct backlight_device *bd) |
| 33 | { | 34 | { |
| 34 | unsigned long flags; | 35 | unsigned long flags; |
| 36 | u16 v; | ||
| 37 | int intensity = bd->props->brightness; | ||
| 35 | 38 | ||
| 36 | if (hp680bl_powermode != FB_BLANK_UNBLANK) | 39 | if (bd->props->power != FB_BLANK_UNBLANK) |
| 40 | intensity = 0; | ||
| 41 | if (bd->props->fb_blank != FB_BLANK_UNBLANK) | ||
| 42 | intensity = 0; | ||
| 43 | if (hp680bl_suspended) | ||
| 37 | intensity = 0; | 44 | intensity = 0; |
| 38 | 45 | ||
| 39 | spin_lock_irqsave(&bl_lock, flags); | 46 | spin_lock_irqsave(&bl_lock, flags); |
| 40 | sh_dac_output(255-(u8)intensity, DAC_LCD_BRIGHTNESS); | 47 | if (intensity && current_intensity == 0) { |
| 48 | sh_dac_enable(DAC_LCD_BRIGHTNESS); | ||
| 49 | v = inw(HD64461_GPBDR); | ||
| 50 | v &= ~HD64461_GPBDR_LCDOFF; | ||
| 51 | outw(v, HD64461_GPBDR); | ||
| 52 | sh_dac_output(255-(u8)intensity, DAC_LCD_BRIGHTNESS); | ||
| 53 | } else if (intensity == 0 && current_intensity != 0) { | ||
| 54 | sh_dac_output(255-(u8)intensity, DAC_LCD_BRIGHTNESS); | ||
| 55 | sh_dac_disable(DAC_LCD_BRIGHTNESS); | ||
| 56 | v = inw(HD64461_GPBDR); | ||
| 57 | v |= HD64461_GPBDR_LCDOFF; | ||
| 58 | outw(v, HD64461_GPBDR); | ||
| 59 | } else if (intensity) { | ||
| 60 | sh_dac_output(255-(u8)intensity, DAC_LCD_BRIGHTNESS); | ||
| 61 | } | ||
| 41 | spin_unlock_irqrestore(&bl_lock, flags); | 62 | spin_unlock_irqrestore(&bl_lock, flags); |
| 42 | } | ||
| 43 | 63 | ||
| 44 | static void hp680bl_blank(int blank) | 64 | current_intensity = intensity; |
| 45 | { | ||
| 46 | u16 v; | ||
| 47 | |||
| 48 | switch(blank) { | ||
| 49 | |||
| 50 | case FB_BLANK_NORMAL: | ||
| 51 | case FB_BLANK_VSYNC_SUSPEND: | ||
| 52 | case FB_BLANK_HSYNC_SUSPEND: | ||
| 53 | case FB_BLANK_POWERDOWN: | ||
| 54 | if (hp680bl_powermode == FB_BLANK_UNBLANK) { | ||
| 55 | hp680bl_send_intensity(0); | ||
| 56 | hp680bl_powermode = blank; | ||
| 57 | sh_dac_disable(DAC_LCD_BRIGHTNESS); | ||
| 58 | v = inw(HD64461_GPBDR); | ||
| 59 | v |= HD64461_GPBDR_LCDOFF; | ||
| 60 | outw(v, HD64461_GPBDR); | ||
| 61 | } | ||
| 62 | break; | ||
| 63 | case FB_BLANK_UNBLANK: | ||
| 64 | if (hp680bl_powermode != FB_BLANK_UNBLANK) { | ||
| 65 | sh_dac_enable(DAC_LCD_BRIGHTNESS); | ||
| 66 | v = inw(HD64461_GPBDR); | ||
| 67 | v &= ~HD64461_GPBDR_LCDOFF; | ||
| 68 | outw(v, HD64461_GPBDR); | ||
| 69 | hp680bl_powermode = blank; | ||
| 70 | hp680bl_send_intensity(current_intensity); | ||
| 71 | } | ||
| 72 | break; | ||
| 73 | } | ||
| 74 | } | 65 | } |
| 75 | 66 | ||
| 67 | |||
| 76 | #ifdef CONFIG_PM | 68 | #ifdef CONFIG_PM |
| 77 | static int hp680bl_suspend(struct device *dev, pm_message_t state, u32 level) | 69 | static int hp680bl_suspend(struct platform_device *dev, pm_message_t state) |
| 78 | { | 70 | { |
| 79 | if (level == SUSPEND_POWER_DOWN) | 71 | hp680bl_suspended = 1; |
| 80 | hp680bl_blank(FB_BLANK_POWERDOWN); | 72 | hp680bl_send_intensity(hp680_backlight_device); |
| 81 | return 0; | 73 | return 0; |
| 82 | } | 74 | } |
| 83 | 75 | ||
| 84 | static int hp680bl_resume(struct device *dev, u32 level) | 76 | static int hp680bl_resume(struct platform_device *dev) |
| 85 | { | 77 | { |
| 86 | if (level == RESUME_POWER_ON) | 78 | hp680bl_suspended = 0; |
| 87 | hp680bl_blank(FB_BLANK_UNBLANK); | 79 | hp680bl_send_intensity(hp680_backlight_device); |
| 88 | return 0; | 80 | return 0; |
| 89 | } | 81 | } |
| 90 | #else | 82 | #else |
| @@ -92,24 +84,9 @@ static int hp680bl_resume(struct device *dev, u32 level) | |||
| 92 | #define hp680bl_resume NULL | 84 | #define hp680bl_resume NULL |
| 93 | #endif | 85 | #endif |
| 94 | 86 | ||
| 95 | 87 | static int hp680bl_set_intensity(struct backlight_device *bd) | |
| 96 | static int hp680bl_set_power(struct backlight_device *bd, int state) | ||
| 97 | { | 88 | { |
| 98 | hp680bl_blank(state); | 89 | hp680bl_send_intensity(bd); |
| 99 | return 0; | ||
| 100 | } | ||
| 101 | |||
| 102 | static int hp680bl_get_power(struct backlight_device *bd) | ||
| 103 | { | ||
| 104 | return hp680bl_powermode; | ||
| 105 | } | ||
| 106 | |||
| 107 | static int hp680bl_set_intensity(struct backlight_device *bd, int intensity) | ||
| 108 | { | ||
| 109 | if (intensity > HP680_MAX_INTENSITY) | ||
| 110 | intensity = HP680_MAX_INTENSITY; | ||
| 111 | hp680bl_send_intensity(intensity); | ||
| 112 | current_intensity = intensity; | ||
| 113 | return 0; | 90 | return 0; |
| 114 | } | 91 | } |
| 115 | 92 | ||
| @@ -120,65 +97,67 @@ static int hp680bl_get_intensity(struct backlight_device *bd) | |||
| 120 | 97 | ||
| 121 | static struct backlight_properties hp680bl_data = { | 98 | static struct backlight_properties hp680bl_data = { |
| 122 | .owner = THIS_MODULE, | 99 | .owner = THIS_MODULE, |
| 123 | .get_power = hp680bl_get_power, | ||
| 124 | .set_power = hp680bl_set_power, | ||
| 125 | .max_brightness = HP680_MAX_INTENSITY, | 100 | .max_brightness = HP680_MAX_INTENSITY, |
| 126 | .get_brightness = hp680bl_get_intensity, | 101 | .get_brightness = hp680bl_get_intensity, |
| 127 | .set_brightness = hp680bl_set_intensity, | 102 | .update_status = hp680bl_set_intensity, |
| 128 | }; | 103 | }; |
| 129 | 104 | ||
| 130 | static struct backlight_device *hp680_backlight_device; | 105 | static int __init hp680bl_probe(struct platform_device *dev) |
| 131 | |||
| 132 | static int __init hp680bl_probe(struct device *dev) | ||
| 133 | { | 106 | { |
| 134 | hp680_backlight_device = backlight_device_register ("hp680-bl", | 107 | hp680_backlight_device = backlight_device_register ("hp680-bl", |
| 135 | NULL, &hp680bl_data); | 108 | NULL, &hp680bl_data); |
| 136 | if (IS_ERR (hp680_backlight_device)) | 109 | if (IS_ERR (hp680_backlight_device)) |
| 137 | return PTR_ERR (hp680_backlight_device); | 110 | return PTR_ERR (hp680_backlight_device); |
| 138 | 111 | ||
| 139 | hp680bl_set_intensity(NULL, HP680_DEFAULT_INTENSITY); | 112 | hp680_backlight_device->props->brightness = HP680_DEFAULT_INTENSITY; |
| 113 | hp680bl_send_intensity(hp680_backlight_device); | ||
| 140 | 114 | ||
| 141 | return 0; | 115 | return 0; |
| 142 | } | 116 | } |
| 143 | 117 | ||
| 144 | static int hp680bl_remove(struct device *dev) | 118 | static int hp680bl_remove(struct platform_device *dev) |
| 145 | { | 119 | { |
| 146 | backlight_device_unregister(hp680_backlight_device); | 120 | backlight_device_unregister(hp680_backlight_device); |
| 147 | 121 | ||
| 148 | return 0; | 122 | return 0; |
| 149 | } | 123 | } |
| 150 | 124 | ||
| 151 | static struct device_driver hp680bl_driver = { | 125 | static struct platform_driver hp680bl_driver = { |
| 152 | .name = "hp680-bl", | ||
| 153 | .bus = &platform_bus_type, | ||
| 154 | .probe = hp680bl_probe, | 126 | .probe = hp680bl_probe, |
| 155 | .remove = hp680bl_remove, | 127 | .remove = hp680bl_remove, |
| 156 | .suspend = hp680bl_suspend, | 128 | .suspend = hp680bl_suspend, |
| 157 | .resume = hp680bl_resume, | 129 | .resume = hp680bl_resume, |
| 130 | .driver = { | ||
| 131 | .name = "hp680-bl", | ||
| 132 | }, | ||
| 158 | }; | 133 | }; |
| 159 | 134 | ||
| 160 | static struct platform_device hp680bl_device = { | 135 | static struct platform_device *hp680bl_device; |
| 161 | .name = "hp680-bl", | ||
| 162 | .id = -1, | ||
| 163 | }; | ||
| 164 | 136 | ||
| 165 | static int __init hp680bl_init(void) | 137 | static int __init hp680bl_init(void) |
| 166 | { | 138 | { |
| 167 | int ret; | 139 | int ret; |
| 168 | 140 | ||
| 169 | ret=driver_register(&hp680bl_driver); | 141 | ret = platform_driver_register(&hp680bl_driver); |
| 170 | if (!ret) { | 142 | if (!ret) { |
| 171 | ret = platform_device_register(&hp680bl_device); | 143 | hp680bl_device = platform_device_alloc("hp680-bl", -1); |
| 172 | if (ret) | 144 | if (!hp680bl_device) |
| 173 | driver_unregister(&hp680bl_driver); | 145 | return -ENOMEM; |
| 146 | |||
| 147 | ret = platform_device_add(hp680bl_device); | ||
| 148 | |||
| 149 | if (ret) { | ||
| 150 | platform_device_put(hp680bl_device); | ||
| 151 | platform_driver_unregister(&hp680bl_driver); | ||
| 152 | } | ||
| 174 | } | 153 | } |
| 175 | return ret; | 154 | return ret; |
| 176 | } | 155 | } |
| 177 | 156 | ||
| 178 | static void __exit hp680bl_exit(void) | 157 | static void __exit hp680bl_exit(void) |
| 179 | { | 158 | { |
| 180 | platform_device_unregister(&hp680bl_device); | 159 | platform_device_unregister(hp680bl_device); |
| 181 | driver_unregister(&hp680bl_driver); | 160 | platform_driver_unregister(&hp680bl_driver); |
| 182 | } | 161 | } |
| 183 | 162 | ||
| 184 | module_init(hp680bl_init); | 163 | module_init(hp680bl_init); |
diff --git a/drivers/video/cfbimgblt.c b/drivers/video/cfbimgblt.c index 910e2338a27e..8ba6152db2fd 100644 --- a/drivers/video/cfbimgblt.c +++ b/drivers/video/cfbimgblt.c | |||
| @@ -169,7 +169,7 @@ static inline void slow_imageblit(const struct fb_image *image, struct fb_info * | |||
| 169 | 169 | ||
| 170 | while (j--) { | 170 | while (j--) { |
| 171 | l--; | 171 | l--; |
| 172 | color = (*s & 1 << (FB_BIT_NR(l))) ? fgcolor : bgcolor; | 172 | color = (*s & (1 << l)) ? fgcolor : bgcolor; |
| 173 | val |= FB_SHIFT_HIGH(color, shift); | 173 | val |= FB_SHIFT_HIGH(color, shift); |
| 174 | 174 | ||
| 175 | /* Did the bitshift spill bits to the next long? */ | 175 | /* Did the bitshift spill bits to the next long? */ |
diff --git a/drivers/video/console/fbcon.c b/drivers/video/console/fbcon.c index 041d06987861..ca020719d20b 100644 --- a/drivers/video/console/fbcon.c +++ b/drivers/video/console/fbcon.c | |||
| @@ -466,7 +466,7 @@ static int __init fb_console_setup(char *this_opt) | |||
| 466 | int i, j; | 466 | int i, j; |
| 467 | 467 | ||
| 468 | if (!this_opt || !*this_opt) | 468 | if (!this_opt || !*this_opt) |
| 469 | return 0; | 469 | return 1; |
| 470 | 470 | ||
| 471 | while ((options = strsep(&this_opt, ",")) != NULL) { | 471 | while ((options = strsep(&this_opt, ",")) != NULL) { |
| 472 | if (!strncmp(options, "font:", 5)) | 472 | if (!strncmp(options, "font:", 5)) |
| @@ -481,10 +481,10 @@ static int __init fb_console_setup(char *this_opt) | |||
| 481 | options++; | 481 | options++; |
| 482 | } | 482 | } |
| 483 | if (*options != ',') | 483 | if (*options != ',') |
| 484 | return 0; | 484 | return 1; |
| 485 | options++; | 485 | options++; |
| 486 | } else | 486 | } else |
| 487 | return 0; | 487 | return 1; |
| 488 | } | 488 | } |
| 489 | 489 | ||
| 490 | if (!strncmp(options, "map:", 4)) { | 490 | if (!strncmp(options, "map:", 4)) { |
| @@ -496,7 +496,7 @@ static int __init fb_console_setup(char *this_opt) | |||
| 496 | con2fb_map_boot[i] = | 496 | con2fb_map_boot[i] = |
| 497 | (options[j++]-'0') % FB_MAX; | 497 | (options[j++]-'0') % FB_MAX; |
| 498 | } | 498 | } |
| 499 | return 0; | 499 | return 1; |
| 500 | } | 500 | } |
| 501 | 501 | ||
| 502 | if (!strncmp(options, "vc:", 3)) { | 502 | if (!strncmp(options, "vc:", 3)) { |
| @@ -518,7 +518,7 @@ static int __init fb_console_setup(char *this_opt) | |||
| 518 | rotate = 0; | 518 | rotate = 0; |
| 519 | } | 519 | } |
| 520 | } | 520 | } |
| 521 | return 0; | 521 | return 1; |
| 522 | } | 522 | } |
| 523 | 523 | ||
| 524 | __setup("fbcon=", fb_console_setup); | 524 | __setup("fbcon=", fb_console_setup); |
| @@ -1142,6 +1142,7 @@ static void fbcon_init(struct vc_data *vc, int init) | |||
| 1142 | set_blitting_type(vc, info); | 1142 | set_blitting_type(vc, info); |
| 1143 | } | 1143 | } |
| 1144 | 1144 | ||
| 1145 | ops->p = &fb_display[fg_console]; | ||
| 1145 | } | 1146 | } |
| 1146 | 1147 | ||
| 1147 | static void fbcon_deinit(struct vc_data *vc) | 1148 | static void fbcon_deinit(struct vc_data *vc) |
diff --git a/drivers/video/console/sticore.c b/drivers/video/console/sticore.c index 0339f5640a78..74ac2acaf72c 100644 --- a/drivers/video/console/sticore.c +++ b/drivers/video/console/sticore.c | |||
| @@ -275,7 +275,7 @@ static int __init sti_setup(char *str) | |||
| 275 | if (str) | 275 | if (str) |
| 276 | strlcpy (default_sti_path, str, sizeof (default_sti_path)); | 276 | strlcpy (default_sti_path, str, sizeof (default_sti_path)); |
| 277 | 277 | ||
| 278 | return 0; | 278 | return 1; |
| 279 | } | 279 | } |
| 280 | 280 | ||
| 281 | /* Assuming the machine has multiple STI consoles (=graphic cards) which | 281 | /* Assuming the machine has multiple STI consoles (=graphic cards) which |
| @@ -321,7 +321,7 @@ static int __init sti_font_setup(char *str) | |||
| 321 | i++; | 321 | i++; |
| 322 | } | 322 | } |
| 323 | 323 | ||
| 324 | return 0; | 324 | return 1; |
| 325 | } | 325 | } |
| 326 | 326 | ||
| 327 | /* The optional linux kernel parameter "sti_font" defines which font | 327 | /* The optional linux kernel parameter "sti_font" defines which font |
| @@ -373,7 +373,7 @@ sti_dump_globcfg(struct sti_glob_cfg *glob_cfg, unsigned int sti_mem_request) | |||
| 373 | glob_cfg->save_addr)); | 373 | glob_cfg->save_addr)); |
| 374 | 374 | ||
| 375 | /* dump extended cfg */ | 375 | /* dump extended cfg */ |
| 376 | cfg = PTR_STI(glob_cfg->ext_ptr); | 376 | cfg = PTR_STI((unsigned long)glob_cfg->ext_ptr); |
| 377 | DPRINTK(( KERN_INFO | 377 | DPRINTK(( KERN_INFO |
| 378 | "monitor %d\n" | 378 | "monitor %d\n" |
| 379 | "in friendly mode: %d\n" | 379 | "in friendly mode: %d\n" |
| @@ -453,25 +453,11 @@ sti_init_glob_cfg(struct sti_struct *sti, | |||
| 453 | sti->regions_phys[i] = | 453 | sti->regions_phys[i] = |
| 454 | REGION_OFFSET_TO_PHYS(sti->regions[i], newhpa); | 454 | REGION_OFFSET_TO_PHYS(sti->regions[i], newhpa); |
| 455 | 455 | ||
| 456 | /* remap virtually */ | ||
| 457 | /* FIXME: add BTLB support if btlb==1 */ | ||
| 458 | len = sti->regions[i].region_desc.length * 4096; | 456 | len = sti->regions[i].region_desc.length * 4096; |
| 459 | |||
| 460 | /* XXX: Enabling IOREMAP debugging causes a crash, so we must be passing | ||
| 461 | * a virtual address to something expecting a physical address that doesn't | ||
| 462 | * go through a readX macro */ | ||
| 463 | #if 0 | ||
| 464 | if (len) | ||
| 465 | glob_cfg->region_ptrs[i] = (unsigned long) ( | ||
| 466 | sti->regions[i].region_desc.cache ? | ||
| 467 | ioremap(sti->regions_phys[i], len) : | ||
| 468 | ioremap_nocache(sti->regions_phys[i], len) ); | ||
| 469 | #else | ||
| 470 | if (len) | 457 | if (len) |
| 471 | glob_cfg->region_ptrs[i] = sti->regions_phys[i]; | 458 | glob_cfg->region_ptrs[i] = sti->regions_phys[i]; |
| 472 | #endif | ||
| 473 | 459 | ||
| 474 | DPRINTK(("region #%d: phys %08lx, virt %08x, len=%lukB, " | 460 | DPRINTK(("region #%d: phys %08lx, region_ptr %08x, len=%lukB, " |
| 475 | "btlb=%d, sysonly=%d, cache=%d, last=%d\n", | 461 | "btlb=%d, sysonly=%d, cache=%d, last=%d\n", |
| 476 | i, sti->regions_phys[i], glob_cfg->region_ptrs[i], | 462 | i, sti->regions_phys[i], glob_cfg->region_ptrs[i], |
| 477 | len/1024, | 463 | len/1024, |
diff --git a/drivers/video/fbmem.c b/drivers/video/fbmem.c index b1a8dca76430..944855b3e4af 100644 --- a/drivers/video/fbmem.c +++ b/drivers/video/fbmem.c | |||
| @@ -1588,7 +1588,7 @@ static int __init video_setup(char *options) | |||
| 1588 | } | 1588 | } |
| 1589 | } | 1589 | } |
| 1590 | 1590 | ||
| 1591 | return 0; | 1591 | return 1; |
| 1592 | } | 1592 | } |
| 1593 | __setup("video=", video_setup); | 1593 | __setup("video=", video_setup); |
| 1594 | #endif | 1594 | #endif |
diff --git a/drivers/video/pxafb.c b/drivers/video/pxafb.c index 53ad61f1038c..809fc5eefc15 100644 --- a/drivers/video/pxafb.c +++ b/drivers/video/pxafb.c | |||
| @@ -232,9 +232,9 @@ static int pxafb_check_var(struct fb_var_screeninfo *var, struct fb_info *info) | |||
| 232 | if (var->yres < MIN_YRES) | 232 | if (var->yres < MIN_YRES) |
| 233 | var->yres = MIN_YRES; | 233 | var->yres = MIN_YRES; |
| 234 | if (var->xres > fbi->max_xres) | 234 | if (var->xres > fbi->max_xres) |
| 235 | var->xres = fbi->max_xres; | 235 | return -EINVAL; |
| 236 | if (var->yres > fbi->max_yres) | 236 | if (var->yres > fbi->max_yres) |
| 237 | var->yres = fbi->max_yres; | 237 | return -EINVAL; |
| 238 | var->xres_virtual = | 238 | var->xres_virtual = |
| 239 | max(var->xres_virtual, var->xres); | 239 | max(var->xres_virtual, var->xres); |
| 240 | var->yres_virtual = | 240 | var->yres_virtual = |
| @@ -781,7 +781,7 @@ static void pxafb_disable_controller(struct pxafb_info *fbi) | |||
| 781 | LCCR0 &= ~LCCR0_LDM; /* Enable LCD Disable Done Interrupt */ | 781 | LCCR0 &= ~LCCR0_LDM; /* Enable LCD Disable Done Interrupt */ |
| 782 | LCCR0 |= LCCR0_DIS; /* Disable LCD Controller */ | 782 | LCCR0 |= LCCR0_DIS; /* Disable LCD Controller */ |
| 783 | 783 | ||
| 784 | schedule_timeout(20 * HZ / 1000); | 784 | schedule_timeout(200 * HZ / 1000); |
| 785 | remove_wait_queue(&fbi->ctrlr_wait, &wait); | 785 | remove_wait_queue(&fbi->ctrlr_wait, &wait); |
| 786 | 786 | ||
| 787 | /* disable LCD controller clock */ | 787 | /* disable LCD controller clock */ |
| @@ -1274,7 +1274,7 @@ int __init pxafb_probe(struct platform_device *dev) | |||
| 1274 | struct pxafb_mach_info *inf; | 1274 | struct pxafb_mach_info *inf; |
| 1275 | int ret; | 1275 | int ret; |
| 1276 | 1276 | ||
| 1277 | dev_dbg(dev, "pxafb_probe\n"); | 1277 | dev_dbg(&dev->dev, "pxafb_probe\n"); |
| 1278 | 1278 | ||
| 1279 | inf = dev->dev.platform_data; | 1279 | inf = dev->dev.platform_data; |
| 1280 | ret = -ENOMEM; | 1280 | ret = -ENOMEM; |
diff --git a/drivers/video/radeonfb.c b/drivers/video/radeonfb.c deleted file mode 100644 index afb6c2ead599..000000000000 --- a/drivers/video/radeonfb.c +++ /dev/null | |||
| @@ -1,3167 +0,0 @@ | |||
| 1 | /* | ||
| 2 | * drivers/video/radeonfb.c | ||
| 3 | * framebuffer driver for ATI Radeon chipset video boards | ||
| 4 | * | ||
| 5 | * Copyright 2000 Ani Joshi <ajoshi@kernel.crashing.org> | ||
| 6 | * | ||
| 7 | * | ||
| 8 | * ChangeLog: | ||
| 9 | * 2000-08-03 initial version 0.0.1 | ||
| 10 | * 2000-09-10 more bug fixes, public release 0.0.5 | ||
| 11 | * 2001-02-19 mode bug fixes, 0.0.7 | ||
| 12 | * 2001-07-05 fixed scrolling issues, engine initialization, | ||
| 13 | * and minor mode tweaking, 0.0.9 | ||
| 14 | * 2001-09-07 Radeon VE support, Nick Kurshev | ||
| 15 | * blanking, pan_display, and cmap fixes, 0.1.0 | ||
| 16 | * 2001-10-10 Radeon 7500 and 8500 support, and experimental | ||
| 17 | * flat panel support, 0.1.1 | ||
| 18 | * 2001-11-17 Radeon M6 (ppc) support, Daniel Berlin, 0.1.2 | ||
| 19 | * 2001-11-18 DFP fixes, Kevin Hendricks, 0.1.3 | ||
| 20 | * 2001-11-29 more cmap, backlight fixes, Benjamin Herrenschmidt | ||
| 21 | * 2002-01-18 DFP panel detection via BIOS, Michael Clark, 0.1.4 | ||
| 22 | * 2002-06-02 console switching, mode set fixes, accel fixes | ||
| 23 | * 2002-06-03 MTRR support, Peter Horton, 0.1.5 | ||
| 24 | * 2002-09-21 rv250, r300, m9 initial support, | ||
| 25 | * added mirror option, 0.1.6 | ||
| 26 | * | ||
| 27 | * Special thanks to ATI DevRel team for their hardware donations. | ||
| 28 | * | ||
| 29 | */ | ||
| 30 | |||
| 31 | |||
| 32 | #define RADEON_VERSION "0.1.6" | ||
| 33 | |||
| 34 | |||
| 35 | #include <linux/config.h> | ||
| 36 | #include <linux/module.h> | ||
| 37 | #include <linux/kernel.h> | ||
| 38 | #include <linux/errno.h> | ||
| 39 | #include <linux/string.h> | ||
| 40 | #include <linux/mm.h> | ||
| 41 | #include <linux/tty.h> | ||
| 42 | #include <linux/slab.h> | ||
| 43 | #include <linux/delay.h> | ||
| 44 | #include <linux/fb.h> | ||
| 45 | #include <linux/ioport.h> | ||
| 46 | #include <linux/init.h> | ||
| 47 | #include <linux/pci.h> | ||
| 48 | #include <linux/vmalloc.h> | ||
| 49 | |||
| 50 | #include <asm/io.h> | ||
| 51 | #include <asm/uaccess.h> | ||
| 52 | #if defined(__powerpc__) | ||
| 53 | #include <asm/prom.h> | ||
| 54 | #include <asm/pci-bridge.h> | ||
| 55 | #include "macmodes.h" | ||
| 56 | |||
| 57 | #ifdef CONFIG_NVRAM | ||
| 58 | #include <linux/nvram.h> | ||
| 59 | #endif | ||
| 60 | |||
| 61 | #ifdef CONFIG_PMAC_BACKLIGHT | ||
| 62 | #include <asm/backlight.h> | ||
| 63 | #endif | ||
| 64 | |||
| 65 | #ifdef CONFIG_BOOTX_TEXT | ||
| 66 | #include <asm/btext.h> | ||
| 67 | #endif | ||
| 68 | |||
| 69 | #ifdef CONFIG_ADB_PMU | ||
| 70 | #include <linux/adb.h> | ||
| 71 | #include <linux/pmu.h> | ||
| 72 | #endif | ||
| 73 | |||
| 74 | #endif /* __powerpc__ */ | ||
| 75 | |||
| 76 | #ifdef CONFIG_MTRR | ||
| 77 | #include <asm/mtrr.h> | ||
| 78 | #endif | ||
| 79 | |||
| 80 | #include <video/radeon.h> | ||
| 81 | #include <linux/radeonfb.h> | ||
| 82 | |||
| 83 | #define DEBUG 0 | ||
| 84 | |||
| 85 | #if DEBUG | ||
| 86 | #define RTRACE printk | ||
| 87 | #else | ||
| 88 | #define RTRACE if(0) printk | ||
| 89 | #endif | ||
| 90 | |||
| 91 | // XXX | ||
| 92 | #undef CONFIG_PMAC_PBOOK | ||
| 93 | |||
| 94 | |||
| 95 | enum radeon_chips { | ||
| 96 | RADEON_QD, | ||
| 97 | RADEON_QE, | ||
| 98 | RADEON_QF, | ||
| 99 | RADEON_QG, | ||
| 100 | RADEON_QY, | ||
| 101 | RADEON_QZ, | ||
| 102 | RADEON_LW, | ||
| 103 | RADEON_LX, | ||
| 104 | RADEON_LY, | ||
| 105 | RADEON_LZ, | ||
| 106 | RADEON_QL, | ||
| 107 | RADEON_QN, | ||
| 108 | RADEON_QO, | ||
| 109 | RADEON_Ql, | ||
| 110 | RADEON_BB, | ||
| 111 | RADEON_QW, | ||
| 112 | RADEON_QX, | ||
| 113 | RADEON_Id, | ||
| 114 | RADEON_Ie, | ||
| 115 | RADEON_If, | ||
| 116 | RADEON_Ig, | ||
| 117 | RADEON_Ya, | ||
| 118 | RADEON_Yd, | ||
| 119 | RADEON_Ld, | ||
| 120 | RADEON_Le, | ||
| 121 | RADEON_Lf, | ||
| 122 | RADEON_Lg, | ||
| 123 | RADEON_ND, | ||
| 124 | RADEON_NE, | ||
| 125 | RADEON_NF, | ||
| 126 | RADEON_NG, | ||
| 127 | RADEON_QM | ||
| 128 | }; | ||
| 129 | |||
| 130 | enum radeon_arch { | ||
| 131 | RADEON_R100, | ||
| 132 | RADEON_RV100, | ||
| 133 | RADEON_R200, | ||
| 134 | RADEON_RV200, | ||
| 135 | RADEON_RV250, | ||
| 136 | RADEON_R300, | ||
| 137 | RADEON_M6, | ||
| 138 | RADEON_M7, | ||
| 139 | RADEON_M9 | ||
| 140 | }; | ||
| 141 | |||
| 142 | static struct radeon_chip_info { | ||
| 143 | const char *name; | ||
| 144 | unsigned char arch; | ||
| 145 | } radeon_chip_info[] __devinitdata = { | ||
| 146 | { "QD", RADEON_R100 }, | ||
| 147 | { "QE", RADEON_R100 }, | ||
| 148 | { "QF", RADEON_R100 }, | ||
| 149 | { "QG", RADEON_R100 }, | ||
| 150 | { "VE QY", RADEON_RV100 }, | ||
| 151 | { "VE QZ", RADEON_RV100 }, | ||
| 152 | { "M7 LW", RADEON_M7 }, | ||
| 153 | { "M7 LX", RADEON_M7 }, | ||
| 154 | { "M6 LY", RADEON_M6 }, | ||
| 155 | { "M6 LZ", RADEON_M6 }, | ||
| 156 | { "8500 QL", RADEON_R200 }, | ||
| 157 | { "8500 QN", RADEON_R200 }, | ||
| 158 | { "8500 QO", RADEON_R200 }, | ||
| 159 | { "8500 Ql", RADEON_R200 }, | ||
| 160 | { "8500 BB", RADEON_R200 }, | ||
| 161 | { "7500 QW", RADEON_RV200 }, | ||
| 162 | { "7500 QX", RADEON_RV200 }, | ||
| 163 | { "9000 Id", RADEON_RV250 }, | ||
| 164 | { "9000 Ie", RADEON_RV250 }, | ||
| 165 | { "9000 If", RADEON_RV250 }, | ||
| 166 | { "9000 Ig", RADEON_RV250 }, | ||
| 167 | { "M9 Ld", RADEON_M9 }, | ||
| 168 | { "M9 Le", RADEON_M9 }, | ||
| 169 | { "M9 Lf", RADEON_M9 }, | ||
| 170 | { "M9 Lg", RADEON_M9 }, | ||
| 171 | { "9700 ND", RADEON_R300 }, | ||
| 172 | { "9700 NE", RADEON_R300 }, | ||
| 173 | { "9700 NF", RADEON_R300 }, | ||
| 174 | { "9700 NG", RADEON_R300 }, | ||
| 175 | { "9100 QM", RADEON_R200 } | ||
| 176 | }; | ||
| 177 | |||
| 178 | |||
| 179 | enum radeon_montype | ||
| 180 | { | ||
| 181 | MT_NONE, | ||
| 182 | MT_CRT, /* CRT */ | ||
| 183 | MT_LCD, /* LCD */ | ||
| 184 | MT_DFP, /* DVI */ | ||
| 185 | MT_CTV, /* composite TV */ | ||
| 186 | MT_STV /* S-Video out */ | ||
| 187 | }; | ||
| 188 | |||
| 189 | |||
| 190 | static struct pci_device_id radeonfb_pci_table[] = { | ||
| 191 | { PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_RADEON_QD, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_QD}, | ||
| 192 | { PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_RADEON_QE, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_QE}, | ||
| 193 | { PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_RADEON_QF, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_QF}, | ||
| 194 | { PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_RADEON_QG, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_QG}, | ||
| 195 | { PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_RADEON_QY, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_QY}, | ||
| 196 | { PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_RADEON_QZ, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_QZ}, | ||
| 197 | { PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_RADEON_LW, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_LW}, | ||
| 198 | { PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_RADEON_LX, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_LX}, | ||
| 199 | { PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_RADEON_LY, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_LY}, | ||
| 200 | { PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_RADEON_LZ, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_LZ}, | ||
| 201 | { PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_RADEON_QL, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_QL}, | ||
| 202 | { PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_RADEON_QN, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_QN}, | ||
| 203 | { PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_RADEON_QO, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_QO}, | ||
| 204 | { PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_RADEON_Ql, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_Ql}, | ||
| 205 | { PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_RADEON_BB, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_BB}, | ||
| 206 | { PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_RADEON_QW, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_QW}, | ||
| 207 | { PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_RADEON_QX, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_QX}, | ||
| 208 | { PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_RADEON_Id, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_Id}, | ||
| 209 | { PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_RADEON_Ie, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_Ie}, | ||
| 210 | { PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_RADEON_If, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_If}, | ||
| 211 | { PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_RADEON_Ig, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_Ig}, | ||
| 212 | { PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_RADEON_Ya, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_Ya}, | ||
| 213 | { PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_RADEON_Yd, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_Yd}, | ||
| 214 | { PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_RADEON_Ld, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_Ld}, | ||
| 215 | { PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_RADEON_Le, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_Le}, | ||
| 216 | { PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_RADEON_Lf, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_Lf}, | ||
| 217 | { PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_RADEON_Lg, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_Lg}, | ||
| 218 | { PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_RADEON_ND, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_ND}, | ||
| 219 | { PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_RADEON_NE, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_NE}, | ||
| 220 | { PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_RADEON_NF, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_NF}, | ||
| 221 | { PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_RADEON_NG, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_NG}, | ||
| 222 | { PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_RADEON_QM, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_QM}, | ||
| 223 | { 0, } | ||
| 224 | }; | ||
| 225 | MODULE_DEVICE_TABLE(pci, radeonfb_pci_table); | ||
| 226 | |||
| 227 | |||
| 228 | typedef struct { | ||
| 229 | u16 reg; | ||
| 230 | u32 val; | ||
| 231 | } reg_val; | ||
| 232 | |||
| 233 | |||
| 234 | /* these common regs are cleared before mode setting so they do not | ||
| 235 | * interfere with anything | ||
| 236 | */ | ||
| 237 | static reg_val common_regs[] = { | ||
| 238 | { OVR_CLR, 0 }, | ||
| 239 | { OVR_WID_LEFT_RIGHT, 0 }, | ||
| 240 | { OVR_WID_TOP_BOTTOM, 0 }, | ||
| 241 | { OV0_SCALE_CNTL, 0 }, | ||
| 242 | { SUBPIC_CNTL, 0 }, | ||
| 243 | { VIPH_CONTROL, 0 }, | ||
| 244 | { I2C_CNTL_1, 0 }, | ||
| 245 | { GEN_INT_CNTL, 0 }, | ||
| 246 | { CAP0_TRIG_CNTL, 0 }, | ||
| 247 | }; | ||
| 248 | |||
| 249 | static reg_val common_regs_m6[] = { | ||
| 250 | { OVR_CLR, 0 }, | ||
| 251 | { OVR_WID_LEFT_RIGHT, 0 }, | ||
| 252 | { OVR_WID_TOP_BOTTOM, 0 }, | ||
| 253 | { OV0_SCALE_CNTL, 0 }, | ||
| 254 | { SUBPIC_CNTL, 0 }, | ||
| 255 | { GEN_INT_CNTL, 0 }, | ||
| 256 | { CAP0_TRIG_CNTL, 0 } | ||
| 257 | }; | ||
| 258 | |||
| 259 | typedef struct { | ||
| 260 | u8 clock_chip_type; | ||
| 261 | u8 struct_size; | ||
| 262 | u8 accelerator_entry; | ||
| 263 | u8 VGA_entry; | ||
| 264 | u16 VGA_table_offset; | ||
| 265 | u16 POST_table_offset; | ||
| 266 | u16 XCLK; | ||
| 267 | u16 MCLK; | ||
| 268 | u8 num_PLL_blocks; | ||
| 269 | u8 size_PLL_blocks; | ||
| 270 | u16 PCLK_ref_freq; | ||
| 271 | u16 PCLK_ref_divider; | ||
| 272 | u32 PCLK_min_freq; | ||
| 273 | u32 PCLK_max_freq; | ||
| 274 | u16 MCLK_ref_freq; | ||
| 275 | u16 MCLK_ref_divider; | ||
| 276 | u32 MCLK_min_freq; | ||
| 277 | u32 MCLK_max_freq; | ||
| 278 | u16 XCLK_ref_freq; | ||
| 279 | u16 XCLK_ref_divider; | ||
| 280 | u32 XCLK_min_freq; | ||
| 281 | u32 XCLK_max_freq; | ||
| 282 | } __attribute__ ((packed)) PLL_BLOCK; | ||
| 283 | |||
| 284 | |||
| 285 | struct pll_info { | ||
| 286 | int ppll_max; | ||
| 287 | int ppll_min; | ||
| 288 | int xclk; | ||
| 289 | int ref_div; | ||
| 290 | int ref_clk; | ||
| 291 | }; | ||
| 292 | |||
| 293 | |||
| 294 | struct ram_info { | ||
| 295 | int ml; | ||
| 296 | int mb; | ||
| 297 | int trcd; | ||
| 298 | int trp; | ||
| 299 | int twr; | ||
| 300 | int cl; | ||
| 301 | int tr2w; | ||
| 302 | int loop_latency; | ||
| 303 | int rloop; | ||
| 304 | }; | ||
| 305 | |||
| 306 | |||
| 307 | struct radeon_regs { | ||
| 308 | /* CRTC regs */ | ||
| 309 | u32 crtc_h_total_disp; | ||
| 310 | u32 crtc_h_sync_strt_wid; | ||
| 311 | u32 crtc_v_total_disp; | ||
| 312 | u32 crtc_v_sync_strt_wid; | ||
| 313 | u32 crtc_pitch; | ||
| 314 | u32 crtc_gen_cntl; | ||
| 315 | u32 crtc_ext_cntl; | ||
| 316 | u32 dac_cntl; | ||
| 317 | |||
| 318 | u32 flags; | ||
| 319 | u32 pix_clock; | ||
| 320 | int xres, yres; | ||
| 321 | |||
| 322 | /* DDA regs */ | ||
| 323 | u32 dda_config; | ||
| 324 | u32 dda_on_off; | ||
| 325 | |||
| 326 | /* PLL regs */ | ||
| 327 | u32 ppll_div_3; | ||
| 328 | u32 ppll_ref_div; | ||
| 329 | u32 vclk_ecp_cntl; | ||
| 330 | |||
| 331 | /* Flat panel regs */ | ||
| 332 | u32 fp_crtc_h_total_disp; | ||
| 333 | u32 fp_crtc_v_total_disp; | ||
| 334 | u32 fp_gen_cntl; | ||
| 335 | u32 fp_h_sync_strt_wid; | ||
| 336 | u32 fp_horz_stretch; | ||
| 337 | u32 fp_panel_cntl; | ||
| 338 | u32 fp_v_sync_strt_wid; | ||
| 339 | u32 fp_vert_stretch; | ||
| 340 | u32 lvds_gen_cntl; | ||
| 341 | u32 lvds_pll_cntl; | ||
| 342 | u32 tmds_crc; | ||
| 343 | u32 tmds_transmitter_cntl; | ||
| 344 | |||
| 345 | #if defined(__BIG_ENDIAN) | ||
| 346 | u32 surface_cntl; | ||
| 347 | #endif | ||
| 348 | }; | ||
| 349 | |||
| 350 | |||
| 351 | struct radeonfb_info { | ||
| 352 | struct fb_info info; | ||
| 353 | |||
| 354 | struct radeon_regs state; | ||
| 355 | struct radeon_regs init_state; | ||
| 356 | |||
| 357 | char name[32]; | ||
| 358 | char ram_type[12]; | ||
| 359 | |||
| 360 | unsigned long mmio_base_phys; | ||
| 361 | unsigned long fb_base_phys; | ||
| 362 | |||
| 363 | void __iomem *mmio_base; | ||
| 364 | void __iomem *fb_base; | ||
| 365 | |||
| 366 | struct pci_dev *pdev; | ||
| 367 | |||
| 368 | unsigned char *EDID; | ||
| 369 | unsigned char __iomem *bios_seg; | ||
| 370 | |||
| 371 | u32 pseudo_palette[17]; | ||
| 372 | struct { u8 red, green, blue, pad; } palette[256]; | ||
| 373 | |||
| 374 | int chipset; | ||
| 375 | unsigned char arch; | ||
| 376 | int video_ram; | ||
| 377 | u8 rev; | ||
| 378 | int pitch, bpp, depth; | ||
| 379 | int xres, yres, pixclock; | ||
| 380 | int xres_virtual, yres_virtual; | ||
| 381 | u32 accel_flags; | ||
| 382 | |||
| 383 | int use_default_var; | ||
| 384 | int got_dfpinfo; | ||
| 385 | |||
| 386 | int hasCRTC2; | ||
| 387 | int crtDisp_type; | ||
| 388 | int dviDisp_type; | ||
| 389 | |||
| 390 | int panel_xres, panel_yres; | ||
| 391 | int clock; | ||
| 392 | int hOver_plus, hSync_width, hblank; | ||
| 393 | int vOver_plus, vSync_width, vblank; | ||
| 394 | int hAct_high, vAct_high, interlaced; | ||
| 395 | int synct, misc; | ||
| 396 | |||
| 397 | u32 dp_gui_master_cntl; | ||
| 398 | |||
| 399 | struct pll_info pll; | ||
| 400 | int pll_output_freq, post_div, fb_div; | ||
| 401 | |||
| 402 | struct ram_info ram; | ||
| 403 | |||
| 404 | int mtrr_hdl; | ||
| 405 | |||
| 406 | #ifdef CONFIG_PMAC_PBOOK | ||
| 407 | int pm_reg; | ||
| 408 | u32 save_regs[64]; | ||
| 409 | u32 mdll, mdll2; | ||
| 410 | #endif /* CONFIG_PMAC_PBOOK */ | ||
| 411 | int asleep; | ||
| 412 | |||
| 413 | struct radeonfb_info *next; | ||
| 414 | }; | ||
| 415 | |||
| 416 | |||
| 417 | static struct fb_var_screeninfo radeonfb_default_var = { | ||
| 418 | 640, 480, 640, 480, 0, 0, 8, 0, | ||
| 419 | {0, 6, 0}, {0, 6, 0}, {0, 6, 0}, {0, 0, 0}, | ||
| 420 | 0, 0, -1, -1, 0, 39721, 40, 24, 32, 11, 96, 2, | ||
| 421 | 0, FB_VMODE_NONINTERLACED | ||
| 422 | }; | ||
| 423 | |||
| 424 | /* | ||
| 425 | * IO macros | ||
| 426 | */ | ||
| 427 | |||
| 428 | #define INREG8(addr) readb((rinfo->mmio_base)+addr) | ||
| 429 | #define OUTREG8(addr,val) writeb(val, (rinfo->mmio_base)+addr) | ||
| 430 | #define INREG(addr) readl((rinfo->mmio_base)+addr) | ||
| 431 | #define OUTREG(addr,val) writel(val, (rinfo->mmio_base)+addr) | ||
| 432 | |||
| 433 | #define OUTPLL(addr,val) \ | ||
| 434 | do { \ | ||
| 435 | OUTREG8(CLOCK_CNTL_INDEX, (addr & 0x0000003f) | 0x00000080); \ | ||
| 436 | OUTREG(CLOCK_CNTL_DATA, val); \ | ||
| 437 | } while(0) | ||
| 438 | |||
| 439 | #define OUTPLLP(addr,val,mask) \ | ||
| 440 | do { \ | ||
| 441 | unsigned int _tmp = INPLL(addr); \ | ||
| 442 | _tmp &= (mask); \ | ||
| 443 | _tmp |= (val); \ | ||
| 444 | OUTPLL(addr, _tmp); \ | ||
| 445 | } while (0) | ||
| 446 | |||
| 447 | #define OUTREGP(addr,val,mask) \ | ||
| 448 | do { \ | ||
| 449 | unsigned int _tmp = INREG(addr); \ | ||
| 450 | _tmp &= (mask); \ | ||
| 451 | _tmp |= (val); \ | ||
| 452 | OUTREG(addr, _tmp); \ | ||
| 453 | } while (0) | ||
| 454 | |||
| 455 | |||
| 456 | static __inline__ u32 _INPLL(struct radeonfb_info *rinfo, u32 addr) | ||
| 457 | { | ||
| 458 | OUTREG8(CLOCK_CNTL_INDEX, addr & 0x0000003f); | ||
| 459 | return (INREG(CLOCK_CNTL_DATA)); | ||
| 460 | } | ||
| 461 | |||
| 462 | #define INPLL(addr) _INPLL(rinfo, addr) | ||
| 463 | |||
| 464 | #define PRIMARY_MONITOR(rinfo) ((rinfo->dviDisp_type != MT_NONE) && \ | ||
| 465 | (rinfo->dviDisp_type != MT_STV) && \ | ||
| 466 | (rinfo->dviDisp_type != MT_CTV) ? \ | ||
| 467 | rinfo->dviDisp_type : rinfo->crtDisp_type) | ||
| 468 | |||
| 469 | static char *GET_MON_NAME(int type) | ||
| 470 | { | ||
| 471 | char *pret = NULL; | ||
| 472 | |||
| 473 | switch (type) { | ||
| 474 | case MT_NONE: | ||
| 475 | pret = "no"; | ||
| 476 | break; | ||
| 477 | case MT_CRT: | ||
| 478 | pret = "CRT"; | ||
| 479 | break; | ||
| 480 | case MT_DFP: | ||
| 481 | pret = "DFP"; | ||
| 482 | break; | ||
| 483 | case MT_LCD: | ||
| 484 | pret = "LCD"; | ||
| 485 | break; | ||
| 486 | case MT_CTV: | ||
| 487 | pret = "CTV"; | ||
| 488 | break; | ||
| 489 | case MT_STV: | ||
| 490 | pret = "STV"; | ||
| 491 | break; | ||
| 492 | } | ||
| 493 | |||
| 494 | return pret; | ||
| 495 | } | ||
| 496 | |||
| 497 | |||
| 498 | /* | ||
| 499 | * 2D engine routines | ||
| 500 | */ | ||
| 501 | |||
| 502 | static __inline__ void radeon_engine_flush (struct radeonfb_info *rinfo) | ||
| 503 | { | ||
| 504 | int i; | ||
| 505 | |||
| 506 | /* initiate flush */ | ||
| 507 | OUTREGP(RB2D_DSTCACHE_CTLSTAT, RB2D_DC_FLUSH_ALL, | ||
| 508 | ~RB2D_DC_FLUSH_ALL); | ||
| 509 | |||
| 510 | for (i=0; i < 2000000; i++) { | ||
| 511 | if (!(INREG(RB2D_DSTCACHE_CTLSTAT) & RB2D_DC_BUSY)) | ||
| 512 | break; | ||
| 513 | } | ||
| 514 | } | ||
| 515 | |||
| 516 | |||
| 517 | static __inline__ void _radeon_fifo_wait (struct radeonfb_info *rinfo, int entries) | ||
| 518 | { | ||
| 519 | int i; | ||
| 520 | |||
| 521 | for (i=0; i<2000000; i++) | ||
| 522 | if ((INREG(RBBM_STATUS) & 0x7f) >= entries) | ||
| 523 | return; | ||
| 524 | } | ||
| 525 | |||
| 526 | |||
| 527 | static __inline__ void _radeon_engine_idle (struct radeonfb_info *rinfo) | ||
| 528 | { | ||
| 529 | int i; | ||
| 530 | |||
| 531 | /* ensure FIFO is empty before waiting for idle */ | ||
| 532 | _radeon_fifo_wait (rinfo, 64); | ||
| 533 | |||
| 534 | for (i=0; i<2000000; i++) { | ||
| 535 | if (((INREG(RBBM_STATUS) & GUI_ACTIVE)) == 0) { | ||
| 536 | radeon_engine_flush (rinfo); | ||
| 537 | return; | ||
| 538 | } | ||
| 539 | } | ||
| 540 | } | ||
| 541 | |||
| 542 | |||
| 543 | #define radeon_engine_idle() _radeon_engine_idle(rinfo) | ||
| 544 | #define radeon_fifo_wait(entries) _radeon_fifo_wait(rinfo,entries) | ||
| 545 | |||
| 546 | |||
| 547 | |||
| 548 | /* | ||
| 549 | * helper routines | ||
| 550 | */ | ||
| 551 | |||
| 552 | static __inline__ u32 radeon_get_dstbpp(u16 depth) | ||
| 553 | { | ||
| 554 | switch (depth) { | ||
| 555 | case 8: | ||
| 556 | return DST_8BPP; | ||
| 557 | case 15: | ||
| 558 | return DST_15BPP; | ||
| 559 | case 16: | ||
| 560 | return DST_16BPP; | ||
| 561 | case 32: | ||
| 562 | return DST_32BPP; | ||
| 563 | default: | ||
| 564 | return 0; | ||
| 565 | } | ||
| 566 | } | ||
| 567 | |||
| 568 | |||
| 569 | static inline int var_to_depth(const struct fb_var_screeninfo *var) | ||
| 570 | { | ||
| 571 | if (var->bits_per_pixel != 16) | ||
| 572 | return var->bits_per_pixel; | ||
| 573 | return (var->green.length == 6) ? 16 : 15; | ||
| 574 | } | ||
| 575 | |||
| 576 | |||
| 577 | static void _radeon_engine_reset(struct radeonfb_info *rinfo) | ||
| 578 | { | ||
| 579 | u32 clock_cntl_index, mclk_cntl, rbbm_soft_reset; | ||
| 580 | |||
| 581 | radeon_engine_flush (rinfo); | ||
| 582 | |||
| 583 | clock_cntl_index = INREG(CLOCK_CNTL_INDEX); | ||
| 584 | mclk_cntl = INPLL(MCLK_CNTL); | ||
| 585 | |||
| 586 | OUTPLL(MCLK_CNTL, (mclk_cntl | | ||
| 587 | FORCEON_MCLKA | | ||
| 588 | FORCEON_MCLKB | | ||
| 589 | FORCEON_YCLKA | | ||
| 590 | FORCEON_YCLKB | | ||
| 591 | FORCEON_MC | | ||
| 592 | FORCEON_AIC)); | ||
| 593 | rbbm_soft_reset = INREG(RBBM_SOFT_RESET); | ||
| 594 | |||
| 595 | OUTREG(RBBM_SOFT_RESET, rbbm_soft_reset | | ||
| 596 | SOFT_RESET_CP | | ||
| 597 | SOFT_RESET_HI | | ||
| 598 | SOFT_RESET_SE | | ||
| 599 | SOFT_RESET_RE | | ||
| 600 | SOFT_RESET_PP | | ||
| 601 | SOFT_RESET_E2 | | ||
| 602 | SOFT_RESET_RB); | ||
| 603 | INREG(RBBM_SOFT_RESET); | ||
| 604 | OUTREG(RBBM_SOFT_RESET, rbbm_soft_reset & (u32) | ||
| 605 | ~(SOFT_RESET_CP | | ||
| 606 | SOFT_RESET_HI | | ||
| 607 | SOFT_RESET_SE | | ||
| 608 | SOFT_RESET_RE | | ||
| 609 | SOFT_RESET_PP | | ||
| 610 | SOFT_RESET_E2 | | ||
| 611 | SOFT_RESET_RB)); | ||
| 612 | INREG(RBBM_SOFT_RESET); | ||
| 613 | |||
| 614 | OUTPLL(MCLK_CNTL, mclk_cntl); | ||
| 615 | OUTREG(CLOCK_CNTL_INDEX, clock_cntl_index); | ||
| 616 | OUTREG(RBBM_SOFT_RESET, rbbm_soft_reset); | ||
| 617 | |||
| 618 | return; | ||
| 619 | } | ||
| 620 | |||
| 621 | #define radeon_engine_reset() _radeon_engine_reset(rinfo) | ||
| 622 | |||
| 623 | |||
| 624 | static __inline__ int round_div(int num, int den) | ||
| 625 | { | ||
| 626 | return (num + (den / 2)) / den; | ||
| 627 | } | ||
| 628 | |||
| 629 | |||
| 630 | |||
| 631 | static __inline__ int min_bits_req(int val) | ||
| 632 | { | ||
| 633 | int bits_req = 0; | ||
| 634 | |||
| 635 | if (val == 0) | ||
| 636 | bits_req = 1; | ||
| 637 | |||
| 638 | while (val) { | ||
| 639 | val >>= 1; | ||
| 640 | bits_req++; | ||
| 641 | } | ||
| 642 | |||
| 643 | return (bits_req); | ||
| 644 | } | ||
| 645 | |||
| 646 | |||
| 647 | static __inline__ int _max(int val1, int val2) | ||
| 648 | { | ||
| 649 | if (val1 >= val2) | ||
| 650 | return val1; | ||
| 651 | else | ||
| 652 | return val2; | ||
| 653 | } | ||
| 654 | |||
| 655 | |||
| 656 | |||
| 657 | /* | ||
| 658 | * globals | ||
| 659 | */ | ||
| 660 | |||
| 661 | #ifndef MODULE | ||
| 662 | static char *mode_option; | ||
| 663 | #endif | ||
| 664 | |||
| 665 | static char noaccel = 0; | ||
| 666 | static char mirror = 0; | ||
| 667 | static int panel_yres = 0; | ||
| 668 | static char force_dfp = 0; | ||
| 669 | static struct radeonfb_info *board_list = NULL; | ||
| 670 | static char nomtrr = 0; | ||
| 671 | |||
| 672 | /* | ||
| 673 | * prototypes | ||
| 674 | */ | ||
| 675 | |||
| 676 | static void radeon_save_state (struct radeonfb_info *rinfo, | ||
| 677 | struct radeon_regs *save); | ||
| 678 | static void radeon_engine_init (struct radeonfb_info *rinfo); | ||
| 679 | static void radeon_write_mode (struct radeonfb_info *rinfo, | ||
| 680 | struct radeon_regs *mode); | ||
| 681 | static int __devinit radeon_set_fbinfo (struct radeonfb_info *rinfo); | ||
| 682 | static int __devinit radeon_init_disp (struct radeonfb_info *rinfo); | ||
| 683 | static int radeon_init_disp_var (struct radeonfb_info *rinfo, struct fb_var_screeninfo *var); | ||
| 684 | static void __iomem *radeon_find_rom(struct radeonfb_info *rinfo); | ||
| 685 | static void radeon_get_pllinfo(struct radeonfb_info *rinfo, void __iomem *bios_seg); | ||
| 686 | static void radeon_get_moninfo (struct radeonfb_info *rinfo); | ||
| 687 | static int radeon_get_dfpinfo (struct radeonfb_info *rinfo); | ||
| 688 | static int radeon_get_dfpinfo_BIOS(struct radeonfb_info *rinfo); | ||
| 689 | static void radeon_get_EDID(struct radeonfb_info *rinfo); | ||
| 690 | static int radeon_dfp_parse_EDID(struct radeonfb_info *rinfo); | ||
| 691 | static void radeon_update_default_var(struct radeonfb_info *rinfo); | ||
| 692 | |||
| 693 | #ifdef CONFIG_PPC_OF | ||
| 694 | |||
| 695 | static int radeon_read_OF (struct radeonfb_info *rinfo); | ||
| 696 | static int radeon_get_EDID_OF(struct radeonfb_info *rinfo); | ||
| 697 | extern struct device_node *pci_device_to_OF_node(struct pci_dev *dev); | ||
| 698 | |||
| 699 | #ifdef CONFIG_PMAC_PBOOK | ||
| 700 | int radeon_sleep_notify(struct pmu_sleep_notifier *self, int when); | ||
| 701 | static struct pmu_sleep_notifier radeon_sleep_notifier = { | ||
| 702 | radeon_sleep_notify, SLEEP_LEVEL_VIDEO, | ||
| 703 | }; | ||
| 704 | #endif /* CONFIG_PMAC_PBOOK */ | ||
| 705 | #ifdef CONFIG_PMAC_BACKLIGHT | ||
| 706 | static int radeon_set_backlight_enable(int on, int level, void *data); | ||
| 707 | static int radeon_set_backlight_level(int level, void *data); | ||
| 708 | static struct backlight_controller radeon_backlight_controller = { | ||
| 709 | radeon_set_backlight_enable, | ||
| 710 | radeon_set_backlight_level | ||
| 711 | }; | ||
| 712 | #endif /* CONFIG_PMAC_BACKLIGHT */ | ||
| 713 | |||
| 714 | #endif /* CONFIG_PPC_OF */ | ||
| 715 | |||
| 716 | |||
| 717 | static void __iomem *radeon_find_rom(struct radeonfb_info *rinfo) | ||
| 718 | { | ||
| 719 | #if defined(__i386__) | ||
| 720 | u32 segstart; | ||
| 721 | char __iomem *rom_base; | ||
| 722 | char __iomem *rom; | ||
| 723 | int stage; | ||
| 724 | int i,j; | ||
| 725 | char aty_rom_sig[] = "761295520"; | ||
| 726 | char *radeon_sig[] = { | ||
| 727 | "RG6", | ||
| 728 | "RADEON" | ||
| 729 | }; | ||
| 730 | |||
| 731 | for(segstart=0x000c0000; segstart<0x000f0000; segstart+=0x00001000) { | ||
| 732 | |||
| 733 | stage = 1; | ||
| 734 | |||
| 735 | rom_base = ioremap(segstart, 0x1000); | ||
| 736 | |||
| 737 | if ((*rom_base == 0x55) && (((*(rom_base + 1)) & 0xff) == 0xaa)) | ||
| 738 | stage = 2; | ||
| 739 | |||
| 740 | |||
| 741 | if (stage != 2) { | ||
| 742 | iounmap(rom_base); | ||
| 743 | continue; | ||
| 744 | } | ||
| 745 | |||
| 746 | rom = rom_base; | ||
| 747 | |||
| 748 | for (i = 0; (i < 128 - strlen(aty_rom_sig)) && (stage != 3); i++) { | ||
| 749 | if (aty_rom_sig[0] == *rom) | ||
| 750 | if (strncmp(aty_rom_sig, rom, | ||
| 751 | strlen(aty_rom_sig)) == 0) | ||
| 752 | stage = 3; | ||
| 753 | rom++; | ||
| 754 | } | ||
| 755 | if (stage != 3) { | ||
| 756 | iounmap(rom_base); | ||
| 757 | continue; | ||
| 758 | } | ||
| 759 | rom = rom_base; | ||
| 760 | |||
| 761 | for (i = 0; (i < 512) && (stage != 4); i++) { | ||
| 762 | for (j = 0; j < ARRAY_SIZE(radeon_sig); j++) { | ||
| 763 | if (radeon_sig[j][0] == *rom) | ||
| 764 | if (strncmp(radeon_sig[j], rom, | ||
| 765 | strlen(radeon_sig[j])) == 0) { | ||
| 766 | stage = 4; | ||
| 767 | break; | ||
| 768 | } | ||
| 769 | } | ||
| 770 | rom++; | ||
| 771 | } | ||
| 772 | if (stage != 4) { | ||
| 773 | iounmap(rom_base); | ||
| 774 | continue; | ||
| 775 | } | ||
| 776 | |||
| 777 | return rom_base; | ||
| 778 | } | ||
| 779 | #endif | ||
| 780 | return NULL; | ||
| 781 | } | ||
| 782 | |||
| 783 | |||
| 784 | |||
| 785 | |||
| 786 | static void radeon_get_pllinfo(struct radeonfb_info *rinfo, void __iomem *bios_seg) | ||
| 787 | { | ||
| 788 | void __iomem *bios_header; | ||
| 789 | void __iomem *header_ptr; | ||
| 790 | u16 bios_header_offset, pll_info_offset; | ||
| 791 | PLL_BLOCK pll; | ||
| 792 | |||
| 793 | if (bios_seg) { | ||
| 794 | bios_header = bios_seg + 0x48L; | ||
| 795 | header_ptr = bios_header; | ||
| 796 | |||
| 797 | bios_header_offset = readw(header_ptr); | ||
| 798 | bios_header = bios_seg + bios_header_offset; | ||
| 799 | bios_header += 0x30; | ||
| 800 | |||
| 801 | header_ptr = bios_header; | ||
| 802 | pll_info_offset = readw(header_ptr); | ||
| 803 | header_ptr = bios_seg + pll_info_offset; | ||
| 804 | |||
| 805 | memcpy_fromio(&pll, header_ptr, 50); | ||
| 806 | |||
| 807 | rinfo->pll.xclk = (u32)pll.XCLK; | ||
| 808 | rinfo->pll.ref_clk = (u32)pll.PCLK_ref_freq; | ||
| 809 | rinfo->pll.ref_div = (u32)pll.PCLK_ref_divider; | ||
| 810 | rinfo->pll.ppll_min = pll.PCLK_min_freq; | ||
| 811 | rinfo->pll.ppll_max = pll.PCLK_max_freq; | ||
| 812 | |||
| 813 | printk("radeonfb: ref_clk=%d, ref_div=%d, xclk=%d from BIOS\n", | ||
| 814 | rinfo->pll.ref_clk, rinfo->pll.ref_div, rinfo->pll.xclk); | ||
| 815 | } else { | ||
| 816 | #ifdef CONFIG_PPC_OF | ||
| 817 | if (radeon_read_OF(rinfo)) { | ||
| 818 | unsigned int tmp, Nx, M, ref_div, xclk; | ||
| 819 | |||
| 820 | tmp = INPLL(M_SPLL_REF_FB_DIV); | ||
| 821 | ref_div = INPLL(PPLL_REF_DIV) & 0x3ff; | ||
| 822 | |||
| 823 | Nx = (tmp & 0xff00) >> 8; | ||
| 824 | M = (tmp & 0xff); | ||
| 825 | xclk = ((((2 * Nx * rinfo->pll.ref_clk) + (M)) / | ||
| 826 | (2 * M))); | ||
| 827 | |||
| 828 | rinfo->pll.xclk = xclk; | ||
| 829 | rinfo->pll.ref_div = ref_div; | ||
| 830 | rinfo->pll.ppll_min = 12000; | ||
| 831 | rinfo->pll.ppll_max = 35000; | ||
| 832 | |||
| 833 | printk("radeonfb: ref_clk=%d, ref_div=%d, xclk=%d from OF\n", | ||
| 834 | rinfo->pll.ref_clk, rinfo->pll.ref_div, rinfo->pll.xclk); | ||
| 835 | |||
| 836 | return; | ||
| 837 | } | ||
| 838 | #endif | ||
| 839 | /* no BIOS or BIOS not found, use defaults */ | ||
| 840 | switch (rinfo->chipset) { | ||
| 841 | case PCI_DEVICE_ID_ATI_RADEON_QW: | ||
| 842 | case PCI_DEVICE_ID_ATI_RADEON_QX: | ||
| 843 | rinfo->pll.ppll_max = 35000; | ||
| 844 | rinfo->pll.ppll_min = 12000; | ||
| 845 | rinfo->pll.xclk = 23000; | ||
| 846 | rinfo->pll.ref_div = 12; | ||
| 847 | rinfo->pll.ref_clk = 2700; | ||
| 848 | break; | ||
| 849 | case PCI_DEVICE_ID_ATI_RADEON_QL: | ||
| 850 | case PCI_DEVICE_ID_ATI_RADEON_QN: | ||
| 851 | case PCI_DEVICE_ID_ATI_RADEON_QO: | ||
| 852 | case PCI_DEVICE_ID_ATI_RADEON_Ql: | ||
| 853 | case PCI_DEVICE_ID_ATI_RADEON_BB: | ||
| 854 | rinfo->pll.ppll_max = 35000; | ||
| 855 | rinfo->pll.ppll_min = 12000; | ||
| 856 | rinfo->pll.xclk = 27500; | ||
| 857 | rinfo->pll.ref_div = 12; | ||
| 858 | rinfo->pll.ref_clk = 2700; | ||
| 859 | break; | ||
| 860 | case PCI_DEVICE_ID_ATI_RADEON_Id: | ||
| 861 | case PCI_DEVICE_ID_ATI_RADEON_Ie: | ||
| 862 | case PCI_DEVICE_ID_ATI_RADEON_If: | ||
| 863 | case PCI_DEVICE_ID_ATI_RADEON_Ig: | ||
| 864 | rinfo->pll.ppll_max = 35000; | ||
| 865 | rinfo->pll.ppll_min = 12000; | ||
| 866 | rinfo->pll.xclk = 25000; | ||
| 867 | rinfo->pll.ref_div = 12; | ||
| 868 | rinfo->pll.ref_clk = 2700; | ||
| 869 | break; | ||
| 870 | case PCI_DEVICE_ID_ATI_RADEON_ND: | ||
| 871 | case PCI_DEVICE_ID_ATI_RADEON_NE: | ||
| 872 | case PCI_DEVICE_ID_ATI_RADEON_NF: | ||
| 873 | case PCI_DEVICE_ID_ATI_RADEON_NG: | ||
| 874 | rinfo->pll.ppll_max = 40000; | ||
| 875 | rinfo->pll.ppll_min = 20000; | ||
| 876 | rinfo->pll.xclk = 27000; | ||
| 877 | rinfo->pll.ref_div = 12; | ||
| 878 | rinfo->pll.ref_clk = 2700; | ||
| 879 | break; | ||
| 880 | case PCI_DEVICE_ID_ATI_RADEON_QD: | ||
| 881 | case PCI_DEVICE_ID_ATI_RADEON_QE: | ||
| 882 | case PCI_DEVICE_ID_ATI_RADEON_QF: | ||
| 883 | case PCI_DEVICE_ID_ATI_RADEON_QG: | ||
| 884 | default: | ||
| 885 | rinfo->pll.ppll_max = 35000; | ||
| 886 | rinfo->pll.ppll_min = 12000; | ||
| 887 | rinfo->pll.xclk = 16600; | ||
| 888 | rinfo->pll.ref_div = 67; | ||
| 889 | rinfo->pll.ref_clk = 2700; | ||
| 890 | break; | ||
| 891 | } | ||
| 892 | |||
| 893 | printk("radeonfb: ref_clk=%d, ref_div=%d, xclk=%d defaults\n", | ||
| 894 | rinfo->pll.ref_clk, rinfo->pll.ref_div, rinfo->pll.xclk); | ||
| 895 | } | ||
| 896 | } | ||
| 897 | |||
| 898 | |||
| 899 | static void radeon_get_moninfo (struct radeonfb_info *rinfo) | ||
| 900 | { | ||
| 901 | unsigned int tmp; | ||
| 902 | |||
| 903 | if (force_dfp) { | ||
| 904 | rinfo->dviDisp_type = MT_DFP; | ||
| 905 | return; | ||
| 906 | } | ||
| 907 | |||
| 908 | tmp = INREG(BIOS_4_SCRATCH); | ||
| 909 | printk(KERN_DEBUG "radeon_get_moninfo: bios 4 scratch = %x\n", tmp); | ||
| 910 | |||
| 911 | if (rinfo->hasCRTC2) { | ||
| 912 | /* primary DVI port */ | ||
| 913 | if (tmp & 0x08) | ||
| 914 | rinfo->dviDisp_type = MT_DFP; | ||
| 915 | else if (tmp & 0x4) | ||
| 916 | rinfo->dviDisp_type = MT_LCD; | ||
| 917 | else if (tmp & 0x200) | ||
| 918 | rinfo->dviDisp_type = MT_CRT; | ||
| 919 | else if (tmp & 0x10) | ||
| 920 | rinfo->dviDisp_type = MT_CTV; | ||
| 921 | else if (tmp & 0x20) | ||
| 922 | rinfo->dviDisp_type = MT_STV; | ||
| 923 | |||
| 924 | /* secondary CRT port */ | ||
| 925 | if (tmp & 0x2) | ||
| 926 | rinfo->crtDisp_type = MT_CRT; | ||
| 927 | else if (tmp & 0x800) | ||
| 928 | rinfo->crtDisp_type = MT_DFP; | ||
| 929 | else if (tmp & 0x400) | ||
| 930 | rinfo->crtDisp_type = MT_LCD; | ||
| 931 | else if (tmp & 0x1000) | ||
| 932 | rinfo->crtDisp_type = MT_CTV; | ||
| 933 | else if (tmp & 0x2000) | ||
| 934 | rinfo->crtDisp_type = MT_STV; | ||
| 935 | } else { | ||
| 936 | rinfo->dviDisp_type = MT_NONE; | ||
| 937 | |||
| 938 | tmp = INREG(FP_GEN_CNTL); | ||
| 939 | |||
| 940 | if (tmp & FP_EN_TMDS) | ||
| 941 | rinfo->crtDisp_type = MT_DFP; | ||
| 942 | else | ||
| 943 | rinfo->crtDisp_type = MT_CRT; | ||
| 944 | } | ||
| 945 | } | ||
| 946 | |||
| 947 | |||
| 948 | |||
| 949 | static void radeon_get_EDID(struct radeonfb_info *rinfo) | ||
| 950 | { | ||
| 951 | #ifdef CONFIG_PPC_OF | ||
| 952 | if (!radeon_get_EDID_OF(rinfo)) | ||
| 953 | RTRACE("radeonfb: could not retrieve EDID from OF\n"); | ||
| 954 | #else | ||
| 955 | /* XXX use other methods later */ | ||
| 956 | #endif | ||
| 957 | } | ||
| 958 | |||
| 959 | |||
| 960 | #ifdef CONFIG_PPC_OF | ||
| 961 | static int radeon_get_EDID_OF(struct radeonfb_info *rinfo) | ||
| 962 | { | ||
| 963 | struct device_node *dp; | ||
| 964 | unsigned char *pedid = NULL; | ||
| 965 | static char *propnames[] = { "DFP,EDID", "LCD,EDID", "EDID", "EDID1", NULL }; | ||
| 966 | int i; | ||
| 967 | |||
| 968 | dp = pci_device_to_OF_node(rinfo->pdev); | ||
| 969 | while (dp != NULL) { | ||
| 970 | for (i = 0; propnames[i] != NULL; ++i) { | ||
| 971 | pedid = (unsigned char *) | ||
| 972 | get_property(dp, propnames[i], NULL); | ||
| 973 | if (pedid != NULL) { | ||
| 974 | rinfo->EDID = pedid; | ||
| 975 | return 1; | ||
| 976 | } | ||
| 977 | } | ||
| 978 | dp = dp->child; | ||
| 979 | } | ||
| 980 | return 0; | ||
| 981 | } | ||
| 982 | #endif /* CONFIG_PPC_OF */ | ||
| 983 | |||
| 984 | |||
| 985 | static int radeon_dfp_parse_EDID(struct radeonfb_info *rinfo) | ||
| 986 | { | ||
| 987 | unsigned char *block = rinfo->EDID; | ||
| 988 | |||
| 989 | if (!block) | ||
| 990 | return 0; | ||
| 991 | |||
| 992 | /* jump to the detailed timing block section */ | ||
| 993 | block += 54; | ||
| 994 | |||
| 995 | rinfo->clock = (block[0] + (block[1] << 8)); | ||
| 996 | rinfo->panel_xres = (block[2] + ((block[4] & 0xf0) << 4)); | ||
| 997 | rinfo->hblank = (block[3] + ((block[4] & 0x0f) << 8)); | ||
| 998 | rinfo->panel_yres = (block[5] + ((block[7] & 0xf0) << 4)); | ||
| 999 | rinfo->vblank = (block[6] + ((block[7] & 0x0f) << 8)); | ||
| 1000 | rinfo->hOver_plus = (block[8] + ((block[11] & 0xc0) << 2)); | ||
| 1001 | rinfo->hSync_width = (block[9] + ((block[11] & 0x30) << 4)); | ||
| 1002 | rinfo->vOver_plus = ((block[10] >> 4) + ((block[11] & 0x0c) << 2)); | ||
| 1003 | rinfo->vSync_width = ((block[10] & 0x0f) + ((block[11] & 0x03) << 4)); | ||
| 1004 | rinfo->interlaced = ((block[17] & 0x80) >> 7); | ||
| 1005 | rinfo->synct = ((block[17] & 0x18) >> 3); | ||
| 1006 | rinfo->misc = ((block[17] & 0x06) >> 1); | ||
| 1007 | rinfo->hAct_high = rinfo->vAct_high = 0; | ||
| 1008 | if (rinfo->synct == 3) { | ||
| 1009 | if (rinfo->misc & 2) | ||
| 1010 | rinfo->hAct_high = 1; | ||
| 1011 | if (rinfo->misc & 1) | ||
| 1012 | rinfo->vAct_high = 1; | ||
| 1013 | } | ||
| 1014 | |||
| 1015 | printk("radeonfb: detected DFP panel size from EDID: %dx%d\n", | ||
| 1016 | rinfo->panel_xres, rinfo->panel_yres); | ||
| 1017 | |||
| 1018 | rinfo->got_dfpinfo = 1; | ||
| 1019 | |||
| 1020 | return 1; | ||
| 1021 | } | ||
| 1022 | |||
| 1023 | |||
| 1024 | static void radeon_update_default_var(struct radeonfb_info *rinfo) | ||
| 1025 | { | ||
| 1026 | struct fb_var_screeninfo *var = &radeonfb_default_var; | ||
| 1027 | |||
| 1028 | var->xres = rinfo->panel_xres; | ||
| 1029 | var->yres = rinfo->panel_yres; | ||
| 1030 | var->xres_virtual = rinfo->panel_xres; | ||
| 1031 | var->yres_virtual = rinfo->panel_yres; | ||
| 1032 | var->xoffset = var->yoffset = 0; | ||
| 1033 | var->bits_per_pixel = 8; | ||
| 1034 | var->pixclock = 100000000 / rinfo->clock; | ||
| 1035 | var->left_margin = (rinfo->hblank - rinfo->hOver_plus - rinfo->hSync_width); | ||
| 1036 | var->right_margin = rinfo->hOver_plus; | ||
| 1037 | var->upper_margin = (rinfo->vblank - rinfo->vOver_plus - rinfo->vSync_width); | ||
| 1038 | var->lower_margin = rinfo->vOver_plus; | ||
| 1039 | var->hsync_len = rinfo->hSync_width; | ||
| 1040 | var->vsync_len = rinfo->vSync_width; | ||
| 1041 | var->sync = 0; | ||
| 1042 | if (rinfo->synct == 3) { | ||
| 1043 | if (rinfo->hAct_high) | ||
| 1044 | var->sync |= FB_SYNC_HOR_HIGH_ACT; | ||
| 1045 | if (rinfo->vAct_high) | ||
| 1046 | var->sync |= FB_SYNC_VERT_HIGH_ACT; | ||
| 1047 | } | ||
| 1048 | |||
| 1049 | var->vmode = 0; | ||
| 1050 | if (rinfo->interlaced) | ||
| 1051 | var->vmode |= FB_VMODE_INTERLACED; | ||
| 1052 | |||
| 1053 | rinfo->use_default_var = 1; | ||
| 1054 | } | ||
| 1055 | |||
| 1056 | |||
| 1057 | static int radeon_get_dfpinfo_BIOS(struct radeonfb_info *rinfo) | ||
| 1058 | { | ||
| 1059 | char __iomem *fpbiosstart, *tmp, *tmp0; | ||
| 1060 | char stmp[30]; | ||
| 1061 | int i; | ||
| 1062 | |||
| 1063 | if (!rinfo->bios_seg) | ||
| 1064 | return 0; | ||
| 1065 | |||
| 1066 | if (!(fpbiosstart = rinfo->bios_seg + readw(rinfo->bios_seg + 0x48))) { | ||
| 1067 | printk("radeonfb: Failed to detect DFP panel info using BIOS\n"); | ||
| 1068 | return 0; | ||
| 1069 | } | ||
| 1070 | |||
| 1071 | if (!(tmp = rinfo->bios_seg + readw(fpbiosstart + 0x40))) { | ||
| 1072 | printk("radeonfb: Failed to detect DFP panel info using BIOS\n"); | ||
| 1073 | return 0; | ||
| 1074 | } | ||
| 1075 | |||
| 1076 | for(i=0; i<24; i++) | ||
| 1077 | stmp[i] = readb(tmp+i+1); | ||
| 1078 | stmp[24] = 0; | ||
| 1079 | printk("radeonfb: panel ID string: %s\n", stmp); | ||
| 1080 | rinfo->panel_xres = readw(tmp + 25); | ||
| 1081 | rinfo->panel_yres = readw(tmp + 27); | ||
| 1082 | printk("radeonfb: detected DFP panel size from BIOS: %dx%d\n", | ||
| 1083 | rinfo->panel_xres, rinfo->panel_yres); | ||
| 1084 | |||
| 1085 | for(i=0; i<32; i++) { | ||
| 1086 | tmp0 = rinfo->bios_seg + readw(tmp+64+i*2); | ||
| 1087 | if (tmp0 == 0) | ||
| 1088 | break; | ||
| 1089 | if ((readw(tmp0) == rinfo->panel_xres) && | ||
| 1090 | (readw(tmp0+2) == rinfo->panel_yres)) { | ||
| 1091 | rinfo->hblank = (readw(tmp0+17) - readw(tmp0+19)) * 8; | ||
| 1092 | rinfo->hOver_plus = ((readw(tmp0+21) - readw(tmp0+19) -1) * 8) & 0x7fff; | ||
| 1093 | rinfo->hSync_width = readb(tmp0+23) * 8; | ||
| 1094 | rinfo->vblank = readw(tmp0+24) - readw(tmp0+26); | ||
| 1095 | rinfo->vOver_plus = (readw(tmp0+28) & 0x7ff) - readw(tmp0+26); | ||
| 1096 | rinfo->vSync_width = (readw(tmp0+28) & 0xf800) >> 11; | ||
| 1097 | rinfo->clock = readw(tmp0+9); | ||
| 1098 | |||
| 1099 | rinfo->got_dfpinfo = 1; | ||
| 1100 | return 1; | ||
| 1101 | } | ||
| 1102 | } | ||
| 1103 | |||
| 1104 | return 0; | ||
| 1105 | } | ||
| 1106 | |||
| 1107 | |||
| 1108 | |||
| 1109 | static int radeon_get_dfpinfo (struct radeonfb_info *rinfo) | ||
| 1110 | { | ||
| 1111 | unsigned int tmp; | ||
| 1112 | unsigned short a, b; | ||
| 1113 | |||
| 1114 | if (radeon_get_dfpinfo_BIOS(rinfo)) | ||
| 1115 | radeon_update_default_var(rinfo); | ||
| 1116 | |||
| 1117 | if (radeon_dfp_parse_EDID(rinfo)) | ||
| 1118 | radeon_update_default_var(rinfo); | ||
| 1119 | |||
| 1120 | if (!rinfo->got_dfpinfo) { | ||
| 1121 | /* | ||
| 1122 | * it seems all else has failed now and we | ||
| 1123 | * resort to probing registers for our DFP info | ||
| 1124 | */ | ||
| 1125 | if (panel_yres) { | ||
| 1126 | rinfo->panel_yres = panel_yres; | ||
| 1127 | } else { | ||
| 1128 | tmp = INREG(FP_VERT_STRETCH); | ||
| 1129 | tmp &= 0x00fff000; | ||
| 1130 | rinfo->panel_yres = (unsigned short)(tmp >> 0x0c) + 1; | ||
| 1131 | } | ||
| 1132 | |||
| 1133 | switch (rinfo->panel_yres) { | ||
| 1134 | case 480: | ||
| 1135 | rinfo->panel_xres = 640; | ||
| 1136 | break; | ||
| 1137 | case 600: | ||
| 1138 | rinfo->panel_xres = 800; | ||
| 1139 | break; | ||
| 1140 | case 768: | ||
| 1141 | #if defined(__powerpc__) | ||
| 1142 | if (rinfo->dviDisp_type == MT_LCD) | ||
| 1143 | rinfo->panel_xres = 1152; | ||
| 1144 | else | ||
| 1145 | #endif | ||
| 1146 | rinfo->panel_xres = 1024; | ||
| 1147 | break; | ||
| 1148 | case 1024: | ||
| 1149 | rinfo->panel_xres = 1280; | ||
| 1150 | break; | ||
| 1151 | case 1050: | ||
| 1152 | rinfo->panel_xres = 1400; | ||
| 1153 | break; | ||
| 1154 | case 1200: | ||
| 1155 | rinfo->panel_xres = 1600; | ||
| 1156 | break; | ||
| 1157 | default: | ||
| 1158 | printk("radeonfb: Failed to detect DFP panel size\n"); | ||
| 1159 | return 0; | ||
| 1160 | } | ||
| 1161 | |||
| 1162 | printk("radeonfb: detected DFP panel size from registers: %dx%d\n", | ||
| 1163 | rinfo->panel_xres, rinfo->panel_yres); | ||
| 1164 | |||
| 1165 | tmp = INREG(FP_CRTC_H_TOTAL_DISP); | ||
| 1166 | a = (tmp & FP_CRTC_H_TOTAL_MASK) + 4; | ||
| 1167 | b = (tmp & 0x01ff0000) >> FP_CRTC_H_DISP_SHIFT; | ||
| 1168 | rinfo->hblank = (a - b + 1) * 8; | ||
| 1169 | |||
| 1170 | tmp = INREG(FP_H_SYNC_STRT_WID); | ||
| 1171 | rinfo->hOver_plus = (unsigned short) ((tmp & FP_H_SYNC_STRT_CHAR_MASK) >> | ||
| 1172 | FP_H_SYNC_STRT_CHAR_SHIFT) - b - 1; | ||
| 1173 | rinfo->hOver_plus *= 8; | ||
| 1174 | rinfo->hSync_width = (unsigned short) ((tmp & FP_H_SYNC_WID_MASK) >> | ||
| 1175 | FP_H_SYNC_WID_SHIFT); | ||
| 1176 | rinfo->hSync_width *= 8; | ||
| 1177 | tmp = INREG(FP_CRTC_V_TOTAL_DISP); | ||
| 1178 | a = (tmp & FP_CRTC_V_TOTAL_MASK) + 1; | ||
| 1179 | b = (tmp & FP_CRTC_V_DISP_MASK) >> FP_CRTC_V_DISP_SHIFT; | ||
| 1180 | rinfo->vblank = a - b /* + 24 */ ; | ||
| 1181 | |||
| 1182 | tmp = INREG(FP_V_SYNC_STRT_WID); | ||
| 1183 | rinfo->vOver_plus = (unsigned short) (tmp & FP_V_SYNC_STRT_MASK) | ||
| 1184 | - b + 1; | ||
| 1185 | rinfo->vSync_width = (unsigned short) ((tmp & FP_V_SYNC_WID_MASK) >> | ||
| 1186 | FP_V_SYNC_WID_SHIFT); | ||
| 1187 | |||
| 1188 | return 1; | ||
| 1189 | } | ||
| 1190 | |||
| 1191 | return 1; | ||
| 1192 | } | ||
| 1193 | |||
| 1194 | |||
| 1195 | #ifdef CONFIG_PPC_OF | ||
| 1196 | static int radeon_read_OF (struct radeonfb_info *rinfo) | ||
| 1197 | { | ||
| 1198 | struct device_node *dp; | ||
| 1199 | unsigned int *xtal; | ||
| 1200 | |||
| 1201 | dp = pci_device_to_OF_node(rinfo->pdev); | ||
| 1202 | |||
| 1203 | xtal = (unsigned int *) get_property(dp, "ATY,RefCLK", NULL); | ||
| 1204 | |||
| 1205 | rinfo->pll.ref_clk = *xtal / 10; | ||
| 1206 | |||
| 1207 | if (*xtal) | ||
| 1208 | return 1; | ||
| 1209 | else | ||
| 1210 | return 0; | ||
| 1211 | } | ||
| 1212 | #endif | ||
| 1213 | |||
| 1214 | |||
| 1215 | static void radeon_engine_init (struct radeonfb_info *rinfo) | ||
| 1216 | { | ||
| 1217 | u32 temp; | ||
| 1218 | |||
| 1219 | /* disable 3D engine */ | ||
| 1220 | OUTREG(RB3D_CNTL, 0); | ||
| 1221 | |||
| 1222 | radeon_engine_reset (); | ||
| 1223 | |||
| 1224 | radeon_fifo_wait (1); | ||
| 1225 | OUTREG(RB2D_DSTCACHE_MODE, 0); | ||
| 1226 | |||
| 1227 | radeon_fifo_wait (1); | ||
| 1228 | temp = INREG(DEFAULT_PITCH_OFFSET); | ||
| 1229 | OUTREG(DEFAULT_PITCH_OFFSET, ((temp & 0xc0000000) | | ||
| 1230 | (rinfo->pitch << 0x16))); | ||
| 1231 | |||
| 1232 | radeon_fifo_wait (1); | ||
| 1233 | OUTREGP(DP_DATATYPE, 0, ~HOST_BIG_ENDIAN_EN); | ||
| 1234 | |||
| 1235 | radeon_fifo_wait (1); | ||
| 1236 | OUTREG(DEFAULT_SC_BOTTOM_RIGHT, (DEFAULT_SC_RIGHT_MAX | | ||
| 1237 | DEFAULT_SC_BOTTOM_MAX)); | ||
| 1238 | |||
| 1239 | temp = radeon_get_dstbpp(rinfo->depth); | ||
| 1240 | rinfo->dp_gui_master_cntl = ((temp << 8) | GMC_CLR_CMP_CNTL_DIS); | ||
| 1241 | radeon_fifo_wait (1); | ||
| 1242 | OUTREG(DP_GUI_MASTER_CNTL, (rinfo->dp_gui_master_cntl | | ||
| 1243 | GMC_BRUSH_SOLID_COLOR | | ||
| 1244 | GMC_SRC_DATATYPE_COLOR)); | ||
| 1245 | |||
| 1246 | radeon_fifo_wait (7); | ||
| 1247 | |||
| 1248 | /* clear line drawing regs */ | ||
| 1249 | OUTREG(DST_LINE_START, 0); | ||
| 1250 | OUTREG(DST_LINE_END, 0); | ||
| 1251 | |||
| 1252 | /* set brush color regs */ | ||
| 1253 | OUTREG(DP_BRUSH_FRGD_CLR, 0xffffffff); | ||
| 1254 | OUTREG(DP_BRUSH_BKGD_CLR, 0x00000000); | ||
| 1255 | |||
| 1256 | /* set source color regs */ | ||
| 1257 | OUTREG(DP_SRC_FRGD_CLR, 0xffffffff); | ||
| 1258 | OUTREG(DP_SRC_BKGD_CLR, 0x00000000); | ||
| 1259 | |||
| 1260 | /* default write mask */ | ||
| 1261 | OUTREG(DP_WRITE_MSK, 0xffffffff); | ||
| 1262 | |||
| 1263 | radeon_engine_idle (); | ||
| 1264 | } | ||
| 1265 | |||
| 1266 | |||
| 1267 | static int __devinit radeon_init_disp (struct radeonfb_info *rinfo) | ||
| 1268 | { | ||
| 1269 | struct fb_info *info = &rinfo->info; | ||
| 1270 | struct fb_var_screeninfo var; | ||
| 1271 | |||
| 1272 | var = radeonfb_default_var; | ||
| 1273 | if ((radeon_init_disp_var(rinfo, &var)) < 0) | ||
| 1274 | return -1; | ||
| 1275 | |||
| 1276 | rinfo->depth = var_to_depth(&var); | ||
| 1277 | rinfo->bpp = var.bits_per_pixel; | ||
| 1278 | |||
| 1279 | info->var = var; | ||
| 1280 | fb_alloc_cmap(&info->cmap, 256, 0); | ||
| 1281 | |||
| 1282 | var.activate = FB_ACTIVATE_NOW; | ||
| 1283 | return 0; | ||
| 1284 | } | ||
| 1285 | |||
| 1286 | |||
| 1287 | static int radeon_init_disp_var (struct radeonfb_info *rinfo, | ||
| 1288 | struct fb_var_screeninfo *var) | ||
| 1289 | { | ||
| 1290 | #ifndef MODULE | ||
| 1291 | if (mode_option) | ||
| 1292 | fb_find_mode (var, &rinfo->info, mode_option, | ||
| 1293 | NULL, 0, NULL, 8); | ||
| 1294 | else | ||
| 1295 | #endif | ||
| 1296 | if (rinfo->use_default_var) | ||
| 1297 | /* We will use the modified default far */ | ||
| 1298 | *var = radeonfb_default_var; | ||
| 1299 | else | ||
| 1300 | |||
| 1301 | fb_find_mode (var, &rinfo->info, "640x480-8@60", | ||
| 1302 | NULL, 0, NULL, 0); | ||
| 1303 | |||
| 1304 | if (noaccel) | ||
| 1305 | var->accel_flags &= ~FB_ACCELF_TEXT; | ||
| 1306 | else | ||
| 1307 | var->accel_flags |= FB_ACCELF_TEXT; | ||
| 1308 | |||
| 1309 | return 0; | ||
| 1310 | } | ||
| 1311 | |||
| 1312 | |||
| 1313 | static int radeon_do_maximize(struct radeonfb_info *rinfo, | ||
| 1314 | struct fb_var_screeninfo *var, | ||
| 1315 | struct fb_var_screeninfo *v, | ||
| 1316 | int nom, int den) | ||
| 1317 | { | ||
| 1318 | static struct { | ||
| 1319 | int xres, yres; | ||
| 1320 | } modes[] = { | ||
| 1321 | {1600, 1280}, | ||
| 1322 | {1280, 1024}, | ||
| 1323 | {1024, 768}, | ||
| 1324 | {800, 600}, | ||
| 1325 | {640, 480}, | ||
| 1326 | {-1, -1} | ||
| 1327 | }; | ||
| 1328 | int i; | ||
| 1329 | |||
| 1330 | /* use highest possible virtual resolution */ | ||
| 1331 | if (v->xres_virtual == -1 && v->yres_virtual == -1) { | ||
| 1332 | printk("radeonfb: using max available virtual resolution\n"); | ||
| 1333 | for (i=0; modes[i].xres != -1; i++) { | ||
| 1334 | if (modes[i].xres * nom / den * modes[i].yres < | ||
| 1335 | rinfo->video_ram / 2) | ||
| 1336 | break; | ||
| 1337 | } | ||
| 1338 | if (modes[i].xres == -1) { | ||
| 1339 | printk("radeonfb: could not find virtual resolution that fits into video memory!\n"); | ||
| 1340 | return -EINVAL; | ||
| 1341 | } | ||
| 1342 | v->xres_virtual = modes[i].xres; | ||
| 1343 | v->yres_virtual = modes[i].yres; | ||
| 1344 | |||
| 1345 | printk("radeonfb: virtual resolution set to max of %dx%d\n", | ||
| 1346 | v->xres_virtual, v->yres_virtual); | ||
| 1347 | } else if (v->xres_virtual == -1) { | ||
| 1348 | v->xres_virtual = (rinfo->video_ram * den / | ||
| 1349 | (nom * v->yres_virtual * 2)) & ~15; | ||
| 1350 | } else if (v->yres_virtual == -1) { | ||
| 1351 | v->xres_virtual = (v->xres_virtual + 15) & ~15; | ||
| 1352 | v->yres_virtual = rinfo->video_ram * den / | ||
| 1353 | (nom * v->xres_virtual *2); | ||
| 1354 | } else { | ||
| 1355 | if (v->xres_virtual * nom / den * v->yres_virtual > | ||
| 1356 | rinfo->video_ram) { | ||
| 1357 | return -EINVAL; | ||
| 1358 | } | ||
| 1359 | } | ||
| 1360 | |||
| 1361 | if (v->xres_virtual * nom / den >= 8192) { | ||
| 1362 | v->xres_virtual = 8192 * den / nom - 16; | ||
| 1363 | } | ||
| 1364 | |||
| 1365 | if (v->xres_virtual < v->xres) | ||
| 1366 | return -EINVAL; | ||
| 1367 | |||
| 1368 | if (v->yres_virtual < v->yres) | ||
| 1369 | return -EINVAL; | ||
| 1370 | |||
| 1371 | return 0; | ||
| 1372 | } | ||
| 1373 | |||
| 1374 | |||
| 1375 | static int radeonfb_check_var (struct fb_var_screeninfo *var, struct fb_info *info) | ||
| 1376 | { | ||
| 1377 | struct radeonfb_info *rinfo = (struct radeonfb_info *) info->par; | ||
| 1378 | struct fb_var_screeninfo v; | ||
| 1379 | int nom, den; | ||
| 1380 | |||
| 1381 | memcpy (&v, var, sizeof (v)); | ||
| 1382 | |||
| 1383 | switch (v.bits_per_pixel) { | ||
| 1384 | case 0 ... 8: | ||
| 1385 | v.bits_per_pixel = 8; | ||
| 1386 | break; | ||
| 1387 | case 9 ... 16: | ||
| 1388 | v.bits_per_pixel = 16; | ||
| 1389 | break; | ||
| 1390 | case 17 ... 24: | ||
| 1391 | #if 0 /* Doesn't seem to work */ | ||
| 1392 | v.bits_per_pixel = 24; | ||
| 1393 | break; | ||
| 1394 | #endif | ||
| 1395 | return -EINVAL; | ||
| 1396 | case 25 ... 32: | ||
| 1397 | v.bits_per_pixel = 32; | ||
| 1398 | break; | ||
| 1399 | default: | ||
| 1400 | return -EINVAL; | ||
| 1401 | } | ||
| 1402 | |||
| 1403 | switch (var_to_depth(&v)) { | ||
| 1404 | case 8: | ||
| 1405 | nom = den = 1; | ||
| 1406 | v.red.offset = v.green.offset = v.blue.offset = 0; | ||
| 1407 | v.red.length = v.green.length = v.blue.length = 8; | ||
| 1408 | v.transp.offset = v.transp.length = 0; | ||
| 1409 | break; | ||
| 1410 | case 15: | ||
| 1411 | nom = 2; | ||
| 1412 | den = 1; | ||
| 1413 | v.red.offset = 10; | ||
| 1414 | v.green.offset = 5; | ||
| 1415 | v.blue.offset = 0; | ||
| 1416 | v.red.length = v.green.length = v.blue.length = 5; | ||
| 1417 | v.transp.offset = v.transp.length = 0; | ||
| 1418 | break; | ||
| 1419 | case 16: | ||
| 1420 | nom = 2; | ||
| 1421 | den = 1; | ||
| 1422 | v.red.offset = 11; | ||
| 1423 | v.green.offset = 5; | ||
| 1424 | v.blue.offset = 0; | ||
| 1425 | v.red.length = 5; | ||
| 1426 | v.green.length = 6; | ||
| 1427 | v.blue.length = 5; | ||
| 1428 | v.transp.offset = v.transp.length = 0; | ||
| 1429 | break; | ||
| 1430 | case 24: | ||
| 1431 | nom = 4; | ||
| 1432 | den = 1; | ||
| 1433 | v.red.offset = 16; | ||
| 1434 | v.green.offset = 8; | ||
| 1435 | v.blue.offset = 0; | ||
| 1436 | v.red.length = v.blue.length = v.green.length = 8; | ||
| 1437 | v.transp.offset = v.transp.length = 0; | ||
| 1438 | break; | ||
| 1439 | case 32: | ||
| 1440 | nom = 4; | ||
| 1441 | den = 1; | ||
| 1442 | v.red.offset = 16; | ||
| 1443 | v.green.offset = 8; | ||
| 1444 | v.blue.offset = 0; | ||
| 1445 | v.red.length = v.blue.length = v.green.length = 8; | ||
| 1446 | v.transp.offset = 24; | ||
| 1447 | v.transp.length = 8; | ||
| 1448 | break; | ||
| 1449 | default: | ||
| 1450 | printk ("radeonfb: mode %dx%dx%d rejected, color depth invalid\n", | ||
| 1451 | var->xres, var->yres, var->bits_per_pixel); | ||
| 1452 | return -EINVAL; | ||
| 1453 | } | ||
| 1454 | |||
| 1455 | if (radeon_do_maximize(rinfo, var, &v, nom, den) < 0) | ||
| 1456 | return -EINVAL; | ||
| 1457 | |||
| 1458 | if (v.xoffset < 0) | ||
| 1459 | v.xoffset = 0; | ||
| 1460 | if (v.yoffset < 0) | ||
| 1461 | v.yoffset = 0; | ||
| 1462 | |||
| 1463 | if (v.xoffset > v.xres_virtual - v.xres) | ||
| 1464 | v.xoffset = v.xres_virtual - v.xres - 1; | ||
| 1465 | |||
| 1466 | if (v.yoffset > v.yres_virtual - v.yres) | ||
| 1467 | v.yoffset = v.yres_virtual - v.yres - 1; | ||
| 1468 | |||
| 1469 | v.red.msb_right = v.green.msb_right = v.blue.msb_right = | ||
| 1470 | v.transp.offset = v.transp.length = | ||
| 1471 | v.transp.msb_right = 0; | ||
| 1472 | |||
| 1473 | if (noaccel) | ||
| 1474 | v.accel_flags = 0; | ||
| 1475 | |||
| 1476 | memcpy(var, &v, sizeof(v)); | ||
| 1477 | |||
| 1478 | return 0; | ||
| 1479 | } | ||
| 1480 | |||
| 1481 | |||
| 1482 | static int radeonfb_pan_display (struct fb_var_screeninfo *var, | ||
| 1483 | struct fb_info *info) | ||
| 1484 | { | ||
| 1485 | struct radeonfb_info *rinfo = (struct radeonfb_info *) info; | ||
| 1486 | |||
| 1487 | if ((var->xoffset + var->xres > var->xres_virtual) | ||
| 1488 | || (var->yoffset + var->yres > var->yres_virtual)) | ||
| 1489 | return -EINVAL; | ||
| 1490 | |||
| 1491 | if (rinfo->asleep) | ||
| 1492 | return 0; | ||
| 1493 | |||
| 1494 | OUTREG(CRTC_OFFSET, ((var->yoffset * var->xres_virtual + var->xoffset) | ||
| 1495 | * var->bits_per_pixel / 8) & ~7); | ||
| 1496 | return 0; | ||
| 1497 | } | ||
| 1498 | |||
| 1499 | |||
| 1500 | static int radeonfb_ioctl (struct fb_info *info, unsigned int cmd, | ||
| 1501 | unsigned long arg) | ||
| 1502 | { | ||
| 1503 | struct radeonfb_info *rinfo = (struct radeonfb_info *) info; | ||
| 1504 | unsigned int tmp; | ||
| 1505 | u32 value = 0; | ||
| 1506 | int rc; | ||
| 1507 | |||
| 1508 | switch (cmd) { | ||
| 1509 | /* | ||
| 1510 | * TODO: set mirror accordingly for non-Mobility chipsets with 2 CRTC's | ||
| 1511 | */ | ||
| 1512 | case FBIO_RADEON_SET_MIRROR: | ||
| 1513 | switch (rinfo->arch) { | ||
| 1514 | case RADEON_R100: | ||
| 1515 | case RADEON_RV100: | ||
| 1516 | case RADEON_R200: | ||
| 1517 | case RADEON_RV200: | ||
| 1518 | case RADEON_RV250: | ||
| 1519 | case RADEON_R300: | ||
| 1520 | return -EINVAL; | ||
| 1521 | default: | ||
| 1522 | /* RADEON M6, RADEON_M7, RADEON_M9 */ | ||
| 1523 | break; | ||
| 1524 | } | ||
| 1525 | |||
| 1526 | rc = get_user(value, (__u32 __user *)arg); | ||
| 1527 | |||
| 1528 | if (rc) | ||
| 1529 | return rc; | ||
| 1530 | |||
| 1531 | if (value & 0x01) { | ||
| 1532 | tmp = INREG(LVDS_GEN_CNTL); | ||
| 1533 | |||
| 1534 | tmp |= (LVDS_ON | LVDS_BLON); | ||
| 1535 | } else { | ||
| 1536 | tmp = INREG(LVDS_GEN_CNTL); | ||
| 1537 | |||
| 1538 | tmp &= ~(LVDS_ON | LVDS_BLON); | ||
| 1539 | } | ||
| 1540 | |||
| 1541 | OUTREG(LVDS_GEN_CNTL, tmp); | ||
| 1542 | |||
| 1543 | if (value & 0x02) { | ||
| 1544 | tmp = INREG(CRTC_EXT_CNTL); | ||
| 1545 | tmp |= CRTC_CRT_ON; | ||
| 1546 | |||
| 1547 | mirror = 1; | ||
| 1548 | } else { | ||
| 1549 | tmp = INREG(CRTC_EXT_CNTL); | ||
| 1550 | tmp &= ~CRTC_CRT_ON; | ||
| 1551 | |||
| 1552 | mirror = 0; | ||
| 1553 | } | ||
| 1554 | |||
| 1555 | OUTREG(CRTC_EXT_CNTL, tmp); | ||
| 1556 | |||
| 1557 | break; | ||
| 1558 | case FBIO_RADEON_GET_MIRROR: | ||
| 1559 | switch (rinfo->arch) { | ||
| 1560 | case RADEON_R100: | ||
| 1561 | case RADEON_RV100: | ||
| 1562 | case RADEON_R200: | ||
| 1563 | case RADEON_RV200: | ||
| 1564 | case RADEON_RV250: | ||
| 1565 | case RADEON_R300: | ||
| 1566 | return -EINVAL; | ||
| 1567 | default: | ||
| 1568 | /* RADEON M6, RADEON_M7, RADEON_M9 */ | ||
| 1569 | break; | ||
| 1570 | } | ||
| 1571 | |||
| 1572 | tmp = INREG(LVDS_GEN_CNTL); | ||
| 1573 | if ((LVDS_ON | LVDS_BLON) & tmp) | ||
| 1574 | value |= 0x01; | ||
| 1575 | |||
| 1576 | tmp = INREG(CRTC_EXT_CNTL); | ||
| 1577 | if (CRTC_CRT_ON & tmp) | ||
| 1578 | value |= 0x02; | ||
| 1579 | |||
| 1580 | return put_user(value, (__u32 __user *)arg); | ||
| 1581 | default: | ||
| 1582 | return -EINVAL; | ||
| 1583 | } | ||
| 1584 | |||
| 1585 | return -EINVAL; | ||
| 1586 | } | ||
| 1587 | |||
| 1588 | |||
| 1589 | static int radeonfb_blank (int blank, struct fb_info *info) | ||
| 1590 | { | ||
| 1591 | struct radeonfb_info *rinfo = (struct radeonfb_info *) info; | ||
| 1592 | u32 val = INREG(CRTC_EXT_CNTL); | ||
| 1593 | u32 val2 = INREG(LVDS_GEN_CNTL); | ||
| 1594 | |||
| 1595 | if (rinfo->asleep) | ||
| 1596 | return 0; | ||
| 1597 | |||
| 1598 | #ifdef CONFIG_PMAC_BACKLIGHT | ||
| 1599 | if (rinfo->dviDisp_type == MT_LCD && machine_is(powermac)) { | ||
| 1600 | set_backlight_enable(!blank); | ||
| 1601 | return 0; | ||
| 1602 | } | ||
| 1603 | #endif | ||
| 1604 | |||
| 1605 | /* reset it */ | ||
| 1606 | val &= ~(CRTC_DISPLAY_DIS | CRTC_HSYNC_DIS | | ||
| 1607 | CRTC_VSYNC_DIS); | ||
| 1608 | val2 &= ~(LVDS_DISPLAY_DIS); | ||
| 1609 | |||
| 1610 | switch (blank) { | ||
| 1611 | case FB_BLANK_UNBLANK: | ||
| 1612 | case FB_BLANK_NORMAL: | ||
| 1613 | break; | ||
| 1614 | case FB_BLANK_VSYNC_SUSPEND: | ||
| 1615 | val |= (CRTC_DISPLAY_DIS | CRTC_VSYNC_DIS); | ||
| 1616 | break; | ||
| 1617 | case FB_BLANK_HSYNC_SUSPEND: | ||
| 1618 | val |= (CRTC_DISPLAY_DIS | CRTC_HSYNC_DIS); | ||
| 1619 | break; | ||
| 1620 | case FB_BLANK_POWERDOWN: | ||
| 1621 | val |= (CRTC_DISPLAY_DIS | CRTC_VSYNC_DIS | | ||
| 1622 | CRTC_HSYNC_DIS); | ||
| 1623 | val2 |= (LVDS_DISPLAY_DIS); | ||
| 1624 | break; | ||
| 1625 | } | ||
| 1626 | |||
| 1627 | switch (rinfo->dviDisp_type) { | ||
| 1628 | case MT_LCD: | ||
| 1629 | OUTREG(LVDS_GEN_CNTL, val2); | ||
| 1630 | break; | ||
| 1631 | case MT_CRT: | ||
| 1632 | default: | ||
| 1633 | OUTREG(CRTC_EXT_CNTL, val); | ||
| 1634 | break; | ||
| 1635 | } | ||
| 1636 | |||
| 1637 | /* let fbcon do a soft blank for us */ | ||
| 1638 | return (blank == FB_BLANK_NORMAL) ? 1 : 0; | ||
| 1639 | } | ||
| 1640 | |||
| 1641 | |||
| 1642 | static int radeonfb_setcolreg (unsigned regno, unsigned red, unsigned green, | ||
| 1643 | unsigned blue, unsigned transp, struct fb_info *info) | ||
| 1644 | { | ||
| 1645 | struct radeonfb_info *rinfo = (struct radeonfb_info *) info; | ||
| 1646 | u32 pindex, vclk_cntl; | ||
| 1647 | unsigned int i; | ||
| 1648 | |||
| 1649 | if (regno > 255) | ||
| 1650 | return 1; | ||
| 1651 | |||
| 1652 | red >>= 8; | ||
| 1653 | green >>= 8; | ||
| 1654 | blue >>= 8; | ||
| 1655 | rinfo->palette[regno].red = red; | ||
| 1656 | rinfo->palette[regno].green = green; | ||
| 1657 | rinfo->palette[regno].blue = blue; | ||
| 1658 | |||
| 1659 | /* default */ | ||
| 1660 | pindex = regno; | ||
| 1661 | |||
| 1662 | if (!rinfo->asleep) { | ||
| 1663 | vclk_cntl = INPLL(VCLK_ECP_CNTL); | ||
| 1664 | OUTPLL(VCLK_ECP_CNTL, vclk_cntl & ~PIXCLK_DAC_ALWAYS_ONb); | ||
| 1665 | |||
| 1666 | if (rinfo->bpp == 16) { | ||
| 1667 | pindex = regno * 8; | ||
| 1668 | |||
| 1669 | if (rinfo->depth == 16 && regno > 63) | ||
| 1670 | return 1; | ||
| 1671 | if (rinfo->depth == 15 && regno > 31) | ||
| 1672 | return 1; | ||
| 1673 | |||
| 1674 | /* For 565, the green component is mixed one order below */ | ||
| 1675 | if (rinfo->depth == 16) { | ||
| 1676 | OUTREG(PALETTE_INDEX, pindex>>1); | ||
| 1677 | OUTREG(PALETTE_DATA, (rinfo->palette[regno>>1].red << 16) | | ||
| 1678 | (green << 8) | (rinfo->palette[regno>>1].blue)); | ||
| 1679 | green = rinfo->palette[regno<<1].green; | ||
| 1680 | } | ||
| 1681 | } | ||
| 1682 | |||
| 1683 | if (rinfo->depth != 16 || regno < 32) { | ||
| 1684 | OUTREG(PALETTE_INDEX, pindex); | ||
| 1685 | OUTREG(PALETTE_DATA, (red << 16) | (green << 8) | blue); | ||
| 1686 | } | ||
| 1687 | |||
| 1688 | OUTPLL(VCLK_ECP_CNTL, vclk_cntl); | ||
| 1689 | } | ||
| 1690 | if (regno < 16) { | ||
| 1691 | switch (rinfo->depth) { | ||
| 1692 | case 15: | ||
| 1693 | ((u16 *) (info->pseudo_palette))[regno] = | ||
| 1694 | (regno << 10) | (regno << 5) | regno; | ||
| 1695 | break; | ||
| 1696 | case 16: | ||
| 1697 | ((u16 *) (info->pseudo_palette))[regno] = | ||
| 1698 | (regno << 11) | (regno << 6) | regno; | ||
| 1699 | break; | ||
| 1700 | case 24: | ||
| 1701 | ((u32 *) (info->pseudo_palette))[regno] = | ||
| 1702 | (regno << 16) | (regno << 8) | regno; | ||
| 1703 | break; | ||
| 1704 | case 32: | ||
| 1705 | i = (regno << 8) | regno; | ||
| 1706 | ((u32 *) (info->pseudo_palette))[regno] = | ||
| 1707 | (i << 16) | i; | ||
| 1708 | break; | ||
| 1709 | } | ||
| 1710 | } | ||
| 1711 | return 0; | ||
| 1712 | } | ||
| 1713 | |||
| 1714 | |||
| 1715 | |||
| 1716 | static void radeon_save_state (struct radeonfb_info *rinfo, | ||
| 1717 | struct radeon_regs *save) | ||
| 1718 | { | ||
| 1719 | /* CRTC regs */ | ||
| 1720 | save->crtc_gen_cntl = INREG(CRTC_GEN_CNTL); | ||
| 1721 | save->crtc_ext_cntl = INREG(CRTC_EXT_CNTL); | ||
| 1722 | save->dac_cntl = INREG(DAC_CNTL); | ||
| 1723 | save->crtc_h_total_disp = INREG(CRTC_H_TOTAL_DISP); | ||
| 1724 | save->crtc_h_sync_strt_wid = INREG(CRTC_H_SYNC_STRT_WID); | ||
| 1725 | save->crtc_v_total_disp = INREG(CRTC_V_TOTAL_DISP); | ||
| 1726 | save->crtc_v_sync_strt_wid = INREG(CRTC_V_SYNC_STRT_WID); | ||
| 1727 | save->crtc_pitch = INREG(CRTC_PITCH); | ||
| 1728 | #if defined(__BIG_ENDIAN) | ||
| 1729 | save->surface_cntl = INREG(SURFACE_CNTL); | ||
| 1730 | #endif | ||
| 1731 | |||
| 1732 | /* FP regs */ | ||
| 1733 | save->fp_crtc_h_total_disp = INREG(FP_CRTC_H_TOTAL_DISP); | ||
| 1734 | save->fp_crtc_v_total_disp = INREG(FP_CRTC_V_TOTAL_DISP); | ||
| 1735 | save->fp_gen_cntl = INREG(FP_GEN_CNTL); | ||
| 1736 | save->fp_h_sync_strt_wid = INREG(FP_H_SYNC_STRT_WID); | ||
| 1737 | save->fp_horz_stretch = INREG(FP_HORZ_STRETCH); | ||
| 1738 | save->fp_v_sync_strt_wid = INREG(FP_V_SYNC_STRT_WID); | ||
| 1739 | save->fp_vert_stretch = INREG(FP_VERT_STRETCH); | ||
| 1740 | save->lvds_gen_cntl = INREG(LVDS_GEN_CNTL); | ||
| 1741 | save->lvds_pll_cntl = INREG(LVDS_PLL_CNTL); | ||
| 1742 | save->tmds_crc = INREG(TMDS_CRC); | ||
| 1743 | save->tmds_transmitter_cntl = INREG(TMDS_TRANSMITTER_CNTL); | ||
| 1744 | save->vclk_ecp_cntl = INPLL(VCLK_ECP_CNTL); | ||
| 1745 | } | ||
| 1746 | |||
| 1747 | |||
| 1748 | |||
| 1749 | static int radeonfb_set_par (struct fb_info *info) | ||
| 1750 | { | ||
| 1751 | struct radeonfb_info *rinfo = (struct radeonfb_info *)info->par; | ||
| 1752 | struct fb_var_screeninfo *mode = &info->var; | ||
| 1753 | struct radeon_regs newmode; | ||
| 1754 | int hTotal, vTotal, hSyncStart, hSyncEnd, | ||
| 1755 | hSyncPol, vSyncStart, vSyncEnd, vSyncPol, cSync; | ||
| 1756 | u8 hsync_adj_tab[] = {0, 0x12, 9, 9, 6, 5}; | ||
| 1757 | u8 hsync_fudge_fp[] = {2, 2, 0, 0, 5, 5}; | ||
| 1758 | u32 dotClock = 1000000000 / mode->pixclock, | ||
| 1759 | sync, h_sync_pol, v_sync_pol; | ||
| 1760 | int freq = dotClock / 10; /* x 100 */ | ||
| 1761 | int xclk_freq, vclk_freq, xclk_per_trans, xclk_per_trans_precise; | ||
| 1762 | int useable_precision, roff, ron; | ||
| 1763 | int min_bits, format = 0; | ||
| 1764 | int hsync_start, hsync_fudge, bytpp, hsync_wid, vsync_wid; | ||
| 1765 | int primary_mon = PRIMARY_MONITOR(rinfo); | ||
| 1766 | int depth = var_to_depth(mode); | ||
| 1767 | int accel = (mode->accel_flags & FB_ACCELF_TEXT) != 0; | ||
| 1768 | |||
| 1769 | rinfo->xres = mode->xres; | ||
| 1770 | rinfo->yres = mode->yres; | ||
| 1771 | rinfo->xres_virtual = mode->xres_virtual; | ||
| 1772 | rinfo->yres_virtual = mode->yres_virtual; | ||
| 1773 | rinfo->pixclock = mode->pixclock; | ||
| 1774 | |||
| 1775 | hSyncStart = mode->xres + mode->right_margin; | ||
| 1776 | hSyncEnd = hSyncStart + mode->hsync_len; | ||
| 1777 | hTotal = hSyncEnd + mode->left_margin; | ||
| 1778 | |||
| 1779 | vSyncStart = mode->yres + mode->lower_margin; | ||
| 1780 | vSyncEnd = vSyncStart + mode->vsync_len; | ||
| 1781 | vTotal = vSyncEnd + mode->upper_margin; | ||
| 1782 | |||
| 1783 | if ((primary_mon == MT_DFP) || (primary_mon == MT_LCD)) { | ||
| 1784 | if (rinfo->panel_xres < mode->xres) | ||
| 1785 | rinfo->xres = mode->xres = rinfo->panel_xres; | ||
| 1786 | if (rinfo->panel_yres < mode->yres) | ||
| 1787 | rinfo->yres = mode->yres = rinfo->panel_yres; | ||
| 1788 | |||
| 1789 | hTotal = mode->xres + rinfo->hblank; | ||
| 1790 | hSyncStart = mode->xres + rinfo->hOver_plus; | ||
| 1791 | hSyncEnd = hSyncStart + rinfo->hSync_width; | ||
| 1792 | |||
| 1793 | vTotal = mode->yres + rinfo->vblank; | ||
| 1794 | vSyncStart = mode->yres + rinfo->vOver_plus; | ||
| 1795 | vSyncEnd = vSyncStart + rinfo->vSync_width; | ||
| 1796 | } | ||
| 1797 | |||
| 1798 | sync = mode->sync; | ||
| 1799 | h_sync_pol = sync & FB_SYNC_HOR_HIGH_ACT ? 0 : 1; | ||
| 1800 | v_sync_pol = sync & FB_SYNC_VERT_HIGH_ACT ? 0 : 1; | ||
| 1801 | |||
| 1802 | RTRACE("hStart = %d, hEnd = %d, hTotal = %d\n", | ||
| 1803 | hSyncStart, hSyncEnd, hTotal); | ||
| 1804 | RTRACE("vStart = %d, vEnd = %d, vTotal = %d\n", | ||
| 1805 | vSyncStart, vSyncEnd, vTotal); | ||
| 1806 | |||
| 1807 | hsync_wid = (hSyncEnd - hSyncStart) / 8; | ||
| 1808 | vsync_wid = vSyncEnd - vSyncStart; | ||
| 1809 | if (hsync_wid == 0) | ||
| 1810 | hsync_wid = 1; | ||
| 1811 | else if (hsync_wid > 0x3f) /* max */ | ||
| 1812 | hsync_wid = 0x3f; | ||
| 1813 | |||
| 1814 | if (vsync_wid == 0) | ||
| 1815 | vsync_wid = 1; | ||
| 1816 | else if (vsync_wid > 0x1f) /* max */ | ||
| 1817 | vsync_wid = 0x1f; | ||
| 1818 | |||
| 1819 | hSyncPol = mode->sync & FB_SYNC_HOR_HIGH_ACT ? 0 : 1; | ||
| 1820 | vSyncPol = mode->sync & FB_SYNC_VERT_HIGH_ACT ? 0 : 1; | ||
| 1821 | |||
| 1822 | cSync = mode->sync & FB_SYNC_COMP_HIGH_ACT ? (1 << 4) : 0; | ||
| 1823 | |||
| 1824 | format = radeon_get_dstbpp(depth); | ||
| 1825 | bytpp = mode->bits_per_pixel >> 3; | ||
| 1826 | |||
| 1827 | if ((primary_mon == MT_DFP) || (primary_mon == MT_LCD)) | ||
| 1828 | hsync_fudge = hsync_fudge_fp[format-1]; | ||
| 1829 | else | ||
| 1830 | hsync_fudge = hsync_adj_tab[format-1]; | ||
| 1831 | |||
| 1832 | hsync_start = hSyncStart - 8 + hsync_fudge; | ||
| 1833 | |||
| 1834 | newmode.crtc_gen_cntl = CRTC_EXT_DISP_EN | CRTC_EN | | ||
| 1835 | (format << 8); | ||
| 1836 | |||
| 1837 | if ((primary_mon == MT_DFP) || (primary_mon == MT_LCD)) { | ||
| 1838 | newmode.crtc_ext_cntl = VGA_ATI_LINEAR | XCRT_CNT_EN; | ||
| 1839 | if (mirror) | ||
| 1840 | newmode.crtc_ext_cntl |= CRTC_CRT_ON; | ||
| 1841 | |||
| 1842 | newmode.crtc_gen_cntl &= ~(CRTC_DBL_SCAN_EN | | ||
| 1843 | CRTC_INTERLACE_EN); | ||
| 1844 | } else { | ||
| 1845 | newmode.crtc_ext_cntl = VGA_ATI_LINEAR | XCRT_CNT_EN | | ||
| 1846 | CRTC_CRT_ON; | ||
| 1847 | } | ||
| 1848 | |||
| 1849 | newmode.dac_cntl = /* INREG(DAC_CNTL) | */ DAC_MASK_ALL | DAC_VGA_ADR_EN | | ||
| 1850 | DAC_8BIT_EN; | ||
| 1851 | |||
| 1852 | newmode.crtc_h_total_disp = ((((hTotal / 8) - 1) & 0x3ff) | | ||
| 1853 | (((mode->xres / 8) - 1) << 16)); | ||
| 1854 | |||
| 1855 | newmode.crtc_h_sync_strt_wid = ((hsync_start & 0x1fff) | | ||
| 1856 | (hsync_wid << 16) | (h_sync_pol << 23)); | ||
| 1857 | |||
| 1858 | newmode.crtc_v_total_disp = ((vTotal - 1) & 0xffff) | | ||
| 1859 | ((mode->yres - 1) << 16); | ||
| 1860 | |||
| 1861 | newmode.crtc_v_sync_strt_wid = (((vSyncStart - 1) & 0xfff) | | ||
| 1862 | (vsync_wid << 16) | (v_sync_pol << 23)); | ||
| 1863 | |||
| 1864 | if (accel) { | ||
| 1865 | /* We first calculate the engine pitch */ | ||
| 1866 | rinfo->pitch = ((mode->xres_virtual * ((mode->bits_per_pixel + 1) / 8) + 0x3f) | ||
| 1867 | & ~(0x3f)) >> 6; | ||
| 1868 | |||
| 1869 | /* Then, re-multiply it to get the CRTC pitch */ | ||
| 1870 | newmode.crtc_pitch = (rinfo->pitch << 3) / ((mode->bits_per_pixel + 1) / 8); | ||
| 1871 | } else | ||
| 1872 | newmode.crtc_pitch = (mode->xres_virtual >> 3); | ||
| 1873 | newmode.crtc_pitch |= (newmode.crtc_pitch << 16); | ||
| 1874 | |||
| 1875 | #if defined(__BIG_ENDIAN) | ||
| 1876 | /* | ||
| 1877 | * It looks like recent chips have a problem with SURFACE_CNTL, | ||
| 1878 | * setting SURF_TRANSLATION_DIS completely disables the | ||
| 1879 | * swapper as well, so we leave it unset now. | ||
| 1880 | */ | ||
| 1881 | newmode.surface_cntl = 0; | ||
| 1882 | |||
| 1883 | /* Setup swapping on both apertures, though we currently | ||
| 1884 | * only use aperture 0, enabling swapper on aperture 1 | ||
| 1885 | * won't harm | ||
| 1886 | */ | ||
| 1887 | switch (mode->bits_per_pixel) { | ||
| 1888 | case 16: | ||
| 1889 | newmode.surface_cntl |= NONSURF_AP0_SWP_16BPP; | ||
| 1890 | newmode.surface_cntl |= NONSURF_AP1_SWP_16BPP; | ||
| 1891 | break; | ||
| 1892 | case 24: | ||
| 1893 | case 32: | ||
| 1894 | newmode.surface_cntl |= NONSURF_AP0_SWP_32BPP; | ||
| 1895 | newmode.surface_cntl |= NONSURF_AP1_SWP_32BPP; | ||
| 1896 | break; | ||
| 1897 | } | ||
| 1898 | #endif | ||
| 1899 | |||
| 1900 | rinfo->pitch = ((mode->xres_virtual * ((mode->bits_per_pixel + 1) / 8) + 0x3f) | ||
| 1901 | & ~(0x3f)) / 64; | ||
| 1902 | |||
| 1903 | RTRACE("h_total_disp = 0x%x\t hsync_strt_wid = 0x%x\n", | ||
| 1904 | newmode.crtc_h_total_disp, newmode.crtc_h_sync_strt_wid); | ||
| 1905 | RTRACE("v_total_disp = 0x%x\t vsync_strt_wid = 0x%x\n", | ||
| 1906 | newmode.crtc_v_total_disp, newmode.crtc_v_sync_strt_wid); | ||
| 1907 | |||
| 1908 | newmode.xres = mode->xres; | ||
| 1909 | newmode.yres = mode->yres; | ||
| 1910 | |||
| 1911 | rinfo->bpp = mode->bits_per_pixel; | ||
| 1912 | rinfo->depth = depth; | ||
| 1913 | |||
| 1914 | if (freq > rinfo->pll.ppll_max) | ||
| 1915 | freq = rinfo->pll.ppll_max; | ||
| 1916 | if (freq*12 < rinfo->pll.ppll_min) | ||
| 1917 | freq = rinfo->pll.ppll_min / 12; | ||
| 1918 | |||
| 1919 | { | ||
| 1920 | struct { | ||
| 1921 | int divider; | ||
| 1922 | int bitvalue; | ||
| 1923 | } *post_div, | ||
| 1924 | post_divs[] = { | ||
| 1925 | { 1, 0 }, | ||
| 1926 | { 2, 1 }, | ||
| 1927 | { 4, 2 }, | ||
| 1928 | { 8, 3 }, | ||
| 1929 | { 3, 4 }, | ||
| 1930 | { 16, 5 }, | ||
| 1931 | { 6, 6 }, | ||
| 1932 | { 12, 7 }, | ||
| 1933 | { 0, 0 }, | ||
| 1934 | }; | ||
| 1935 | |||
| 1936 | for (post_div = &post_divs[0]; post_div->divider; ++post_div) { | ||
| 1937 | rinfo->pll_output_freq = post_div->divider * freq; | ||
| 1938 | if (rinfo->pll_output_freq >= rinfo->pll.ppll_min && | ||
| 1939 | rinfo->pll_output_freq <= rinfo->pll.ppll_max) | ||
| 1940 | break; | ||
| 1941 | } | ||
| 1942 | |||
| 1943 | rinfo->post_div = post_div->divider; | ||
| 1944 | rinfo->fb_div = round_div(rinfo->pll.ref_div*rinfo->pll_output_freq, | ||
| 1945 | rinfo->pll.ref_clk); | ||
| 1946 | newmode.ppll_ref_div = rinfo->pll.ref_div; | ||
| 1947 | newmode.ppll_div_3 = rinfo->fb_div | (post_div->bitvalue << 16); | ||
| 1948 | } | ||
| 1949 | newmode.vclk_ecp_cntl = rinfo->init_state.vclk_ecp_cntl; | ||
| 1950 | |||
| 1951 | #ifdef CONFIG_PPC_OF | ||
| 1952 | /* Gross hack for iBook with M7 until I find out a proper fix */ | ||
| 1953 | if (machine_is_compatible("PowerBook4,3") && rinfo->arch == RADEON_M7) | ||
| 1954 | newmode.ppll_div_3 = 0x000600ad; | ||
| 1955 | #endif /* CONFIG_PPC_OF */ | ||
| 1956 | |||
| 1957 | RTRACE("post div = 0x%x\n", rinfo->post_div); | ||
| 1958 | RTRACE("fb_div = 0x%x\n", rinfo->fb_div); | ||
| 1959 | RTRACE("ppll_div_3 = 0x%x\n", newmode.ppll_div_3); | ||
| 1960 | |||
| 1961 | /* DDA */ | ||
| 1962 | vclk_freq = round_div(rinfo->pll.ref_clk * rinfo->fb_div, | ||
| 1963 | rinfo->pll.ref_div * rinfo->post_div); | ||
| 1964 | xclk_freq = rinfo->pll.xclk; | ||
| 1965 | |||
| 1966 | xclk_per_trans = round_div(xclk_freq * 128, vclk_freq * mode->bits_per_pixel); | ||
| 1967 | |||
| 1968 | min_bits = min_bits_req(xclk_per_trans); | ||
| 1969 | useable_precision = min_bits + 1; | ||
| 1970 | |||
| 1971 | xclk_per_trans_precise = round_div((xclk_freq * 128) << (11 - useable_precision), | ||
| 1972 | vclk_freq * mode->bits_per_pixel); | ||
| 1973 | |||
| 1974 | ron = (4 * rinfo->ram.mb + 3 * _max(rinfo->ram.trcd - 2, 0) + | ||
| 1975 | 2 * rinfo->ram.trp + rinfo->ram.twr + rinfo->ram.cl + rinfo->ram.tr2w + | ||
| 1976 | xclk_per_trans) << (11 - useable_precision); | ||
| 1977 | roff = xclk_per_trans_precise * (32 - 4); | ||
| 1978 | |||
| 1979 | RTRACE("ron = %d, roff = %d\n", ron, roff); | ||
| 1980 | RTRACE("vclk_freq = %d, per = %d\n", vclk_freq, xclk_per_trans_precise); | ||
| 1981 | |||
| 1982 | if ((ron + rinfo->ram.rloop) >= roff) { | ||
| 1983 | printk("radeonfb: error ron out of range\n"); | ||
| 1984 | return -EINVAL; | ||
| 1985 | } | ||
| 1986 | |||
| 1987 | newmode.dda_config = (xclk_per_trans_precise | | ||
| 1988 | (useable_precision << 16) | | ||
| 1989 | (rinfo->ram.rloop << 20)); | ||
| 1990 | newmode.dda_on_off = (ron << 16) | roff; | ||
| 1991 | |||
| 1992 | if ((primary_mon == MT_DFP) || (primary_mon == MT_LCD)) { | ||
| 1993 | unsigned int hRatio, vRatio; | ||
| 1994 | |||
| 1995 | /* We force the pixel clock to be always enabled. Allowing it | ||
| 1996 | * to be power managed during blanking would save power, but has | ||
| 1997 | * nasty interactions with the 2D engine & sleep code that haven't | ||
| 1998 | * been solved yet. --BenH | ||
| 1999 | */ | ||
| 2000 | newmode.vclk_ecp_cntl &= ~PIXCLK_DAC_ALWAYS_ONb; | ||
| 2001 | |||
| 2002 | if (mode->xres > rinfo->panel_xres) | ||
| 2003 | mode->xres = rinfo->panel_xres; | ||
| 2004 | if (mode->yres > rinfo->panel_yres) | ||
| 2005 | mode->yres = rinfo->panel_yres; | ||
| 2006 | |||
| 2007 | newmode.fp_horz_stretch = (((rinfo->panel_xres / 8) - 1) | ||
| 2008 | << HORZ_PANEL_SHIFT); | ||
| 2009 | newmode.fp_vert_stretch = ((rinfo->panel_yres - 1) | ||
| 2010 | << VERT_PANEL_SHIFT); | ||
| 2011 | |||
| 2012 | if (mode->xres != rinfo->panel_xres) { | ||
| 2013 | hRatio = round_div(mode->xres * HORZ_STRETCH_RATIO_MAX, | ||
| 2014 | rinfo->panel_xres); | ||
| 2015 | newmode.fp_horz_stretch = (((((unsigned long)hRatio) & HORZ_STRETCH_RATIO_MASK)) | | ||
| 2016 | (newmode.fp_horz_stretch & | ||
| 2017 | (HORZ_PANEL_SIZE | HORZ_FP_LOOP_STRETCH | | ||
| 2018 | HORZ_AUTO_RATIO_INC))); | ||
| 2019 | newmode.fp_horz_stretch |= (HORZ_STRETCH_BLEND | | ||
| 2020 | HORZ_STRETCH_ENABLE); | ||
| 2021 | } | ||
| 2022 | newmode.fp_horz_stretch &= ~HORZ_AUTO_RATIO; | ||
| 2023 | |||
| 2024 | if (mode->yres != rinfo->panel_yres) { | ||
| 2025 | vRatio = round_div(mode->yres * VERT_STRETCH_RATIO_MAX, | ||
| 2026 | rinfo->panel_yres); | ||
| 2027 | newmode.fp_vert_stretch = (((((unsigned long)vRatio) & VERT_STRETCH_RATIO_MASK)) | | ||
| 2028 | (newmode.fp_vert_stretch & | ||
| 2029 | (VERT_PANEL_SIZE | VERT_STRETCH_RESERVED))); | ||
| 2030 | newmode.fp_vert_stretch |= (VERT_STRETCH_BLEND | | ||
| 2031 | VERT_STRETCH_ENABLE); | ||
| 2032 | } | ||
| 2033 | newmode.fp_vert_stretch &= ~VERT_AUTO_RATIO_EN; | ||
| 2034 | |||
| 2035 | newmode.fp_gen_cntl = (rinfo->init_state.fp_gen_cntl & (u32) | ||
| 2036 | ~(FP_SEL_CRTC2 | | ||
| 2037 | FP_RMX_HVSYNC_CONTROL_EN | | ||
| 2038 | FP_DFP_SYNC_SEL | | ||
| 2039 | FP_CRT_SYNC_SEL | | ||
| 2040 | FP_CRTC_LOCK_8DOT | | ||
| 2041 | FP_USE_SHADOW_EN | | ||
| 2042 | FP_CRTC_USE_SHADOW_VEND | | ||
| 2043 | FP_CRT_SYNC_ALT)); | ||
| 2044 | |||
| 2045 | newmode.fp_gen_cntl |= (FP_CRTC_DONT_SHADOW_VPAR | | ||
| 2046 | FP_CRTC_DONT_SHADOW_HEND); | ||
| 2047 | |||
| 2048 | newmode.lvds_gen_cntl = rinfo->init_state.lvds_gen_cntl; | ||
| 2049 | newmode.lvds_pll_cntl = rinfo->init_state.lvds_pll_cntl; | ||
| 2050 | newmode.tmds_crc = rinfo->init_state.tmds_crc; | ||
| 2051 | newmode.tmds_transmitter_cntl = rinfo->init_state.tmds_transmitter_cntl; | ||
| 2052 | |||
| 2053 | if (primary_mon == MT_LCD) { | ||
| 2054 | newmode.lvds_gen_cntl |= (LVDS_ON | LVDS_BLON); | ||
| 2055 | newmode.fp_gen_cntl &= ~(FP_FPON | FP_TMDS_EN); | ||
| 2056 | } else { | ||
| 2057 | /* DFP */ | ||
| 2058 | newmode.fp_gen_cntl |= (FP_FPON | FP_TMDS_EN); | ||
| 2059 | newmode.tmds_transmitter_cntl = (TMDS_RAN_PAT_RST | | ||
| 2060 | TMDS_ICHCSEL | TMDS_PLL_EN) & | ||
| 2061 | ~(TMDS_PLLRST); | ||
| 2062 | newmode.crtc_ext_cntl &= ~CRTC_CRT_ON; | ||
| 2063 | } | ||
| 2064 | |||
| 2065 | newmode.fp_crtc_h_total_disp = (((rinfo->hblank / 8) & 0x3ff) | | ||
| 2066 | (((mode->xres / 8) - 1) << 16)); | ||
| 2067 | newmode.fp_crtc_v_total_disp = (rinfo->vblank & 0xffff) | | ||
| 2068 | ((mode->yres - 1) << 16); | ||
| 2069 | newmode.fp_h_sync_strt_wid = ((rinfo->hOver_plus & 0x1fff) | | ||
| 2070 | (hsync_wid << 16) | (h_sync_pol << 23)); | ||
| 2071 | newmode.fp_v_sync_strt_wid = ((rinfo->vOver_plus & 0xfff) | | ||
| 2072 | (vsync_wid << 16) | (v_sync_pol << 23)); | ||
| 2073 | } | ||
| 2074 | |||
| 2075 | /* do it! */ | ||
| 2076 | if (!rinfo->asleep) { | ||
| 2077 | radeon_write_mode (rinfo, &newmode); | ||
| 2078 | /* (re)initialize the engine */ | ||
| 2079 | if (noaccel) | ||
| 2080 | radeon_engine_init (rinfo); | ||
| 2081 | |||
| 2082 | } | ||
| 2083 | /* Update fix */ | ||
| 2084 | if (accel) | ||
| 2085 | info->fix.line_length = rinfo->pitch*64; | ||
| 2086 | else | ||
| 2087 | info->fix.line_length = mode->xres_virtual * ((mode->bits_per_pixel + 1) / 8); | ||
| 2088 | info->fix.visual = rinfo->depth == 8 ? FB_VISUAL_PSEUDOCOLOR : FB_VISUAL_DIRECTCOLOR; | ||
| 2089 | |||
| 2090 | #ifdef CONFIG_BOOTX_TEXT | ||
| 2091 | /* Update debug text engine */ | ||
| 2092 | btext_update_display(rinfo->fb_base_phys, mode->xres, mode->yres, | ||
| 2093 | rinfo->depth, info->fix.line_length); | ||
| 2094 | #endif | ||
| 2095 | |||
| 2096 | return 0; | ||
| 2097 | } | ||
| 2098 | |||
| 2099 | |||
| 2100 | static void radeon_write_mode (struct radeonfb_info *rinfo, | ||
| 2101 | struct radeon_regs *mode) | ||
| 2102 | { | ||
| 2103 | int i; | ||
| 2104 | int primary_mon = PRIMARY_MONITOR(rinfo); | ||
| 2105 | |||
| 2106 | radeonfb_blank(VESA_POWERDOWN, (struct fb_info *)rinfo); | ||
| 2107 | |||
| 2108 | |||
| 2109 | if (rinfo->arch == RADEON_M6) { | ||
| 2110 | for (i=0; i<7; i++) | ||
| 2111 | OUTREG(common_regs_m6[i].reg, common_regs_m6[i].val); | ||
| 2112 | } else { | ||
| 2113 | for (i=0; i<9; i++) | ||
| 2114 | OUTREG(common_regs[i].reg, common_regs[i].val); | ||
| 2115 | } | ||
| 2116 | |||
| 2117 | OUTREG(CRTC_GEN_CNTL, mode->crtc_gen_cntl); | ||
| 2118 | OUTREGP(CRTC_EXT_CNTL, mode->crtc_ext_cntl, | ||
| 2119 | CRTC_HSYNC_DIS | CRTC_VSYNC_DIS | CRTC_DISPLAY_DIS); | ||
| 2120 | OUTREGP(DAC_CNTL, mode->dac_cntl, DAC_RANGE_CNTL | DAC_BLANKING); | ||
| 2121 | OUTREG(CRTC_H_TOTAL_DISP, mode->crtc_h_total_disp); | ||
| 2122 | OUTREG(CRTC_H_SYNC_STRT_WID, mode->crtc_h_sync_strt_wid); | ||
| 2123 | OUTREG(CRTC_V_TOTAL_DISP, mode->crtc_v_total_disp); | ||
| 2124 | OUTREG(CRTC_V_SYNC_STRT_WID, mode->crtc_v_sync_strt_wid); | ||
| 2125 | OUTREG(CRTC_OFFSET, 0); | ||
| 2126 | OUTREG(CRTC_OFFSET_CNTL, 0); | ||
| 2127 | OUTREG(CRTC_PITCH, mode->crtc_pitch); | ||
| 2128 | |||
| 2129 | #if defined(__BIG_ENDIAN) | ||
| 2130 | OUTREG(SURFACE_CNTL, mode->surface_cntl); | ||
| 2131 | #endif | ||
| 2132 | |||
| 2133 | while ((INREG(CLOCK_CNTL_INDEX) & PPLL_DIV_SEL_MASK) != | ||
| 2134 | PPLL_DIV_SEL_MASK) { | ||
| 2135 | OUTREGP(CLOCK_CNTL_INDEX, PPLL_DIV_SEL_MASK, 0xffff); | ||
| 2136 | } | ||
| 2137 | |||
| 2138 | OUTPLLP(PPLL_CNTL, PPLL_RESET, 0xffff); | ||
| 2139 | |||
| 2140 | while ((INPLL(PPLL_REF_DIV) & PPLL_REF_DIV_MASK) != | ||
| 2141 | (mode->ppll_ref_div & PPLL_REF_DIV_MASK)) { | ||
| 2142 | OUTPLLP(PPLL_REF_DIV, mode->ppll_ref_div, ~PPLL_REF_DIV_MASK); | ||
| 2143 | } | ||
| 2144 | |||
| 2145 | while ((INPLL(PPLL_DIV_3) & PPLL_FB3_DIV_MASK) != | ||
| 2146 | (mode->ppll_div_3 & PPLL_FB3_DIV_MASK)) { | ||
| 2147 | OUTPLLP(PPLL_DIV_3, mode->ppll_div_3, ~PPLL_FB3_DIV_MASK); | ||
| 2148 | } | ||
| 2149 | |||
| 2150 | while ((INPLL(PPLL_DIV_3) & PPLL_POST3_DIV_MASK) != | ||
| 2151 | (mode->ppll_div_3 & PPLL_POST3_DIV_MASK)) { | ||
| 2152 | OUTPLLP(PPLL_DIV_3, mode->ppll_div_3, ~PPLL_POST3_DIV_MASK); | ||
| 2153 | } | ||
| 2154 | |||
| 2155 | OUTPLL(HTOTAL_CNTL, 0); | ||
| 2156 | |||
| 2157 | OUTPLLP(PPLL_CNTL, 0, ~PPLL_RESET); | ||
| 2158 | |||
| 2159 | // OUTREG(DDA_CONFIG, mode->dda_config); | ||
| 2160 | // OUTREG(DDA_ON_OFF, mode->dda_on_off); | ||
| 2161 | |||
| 2162 | if ((primary_mon == MT_DFP) || (primary_mon == MT_LCD)) { | ||
| 2163 | OUTREG(FP_CRTC_H_TOTAL_DISP, mode->fp_crtc_h_total_disp); | ||
| 2164 | OUTREG(FP_CRTC_V_TOTAL_DISP, mode->fp_crtc_v_total_disp); | ||
| 2165 | OUTREG(FP_H_SYNC_STRT_WID, mode->fp_h_sync_strt_wid); | ||
| 2166 | OUTREG(FP_V_SYNC_STRT_WID, mode->fp_v_sync_strt_wid); | ||
| 2167 | OUTREG(FP_HORZ_STRETCH, mode->fp_horz_stretch); | ||
| 2168 | OUTREG(FP_VERT_STRETCH, mode->fp_vert_stretch); | ||
| 2169 | OUTREG(FP_GEN_CNTL, mode->fp_gen_cntl); | ||
| 2170 | OUTREG(TMDS_CRC, mode->tmds_crc); | ||
| 2171 | OUTREG(TMDS_TRANSMITTER_CNTL, mode->tmds_transmitter_cntl); | ||
| 2172 | |||
| 2173 | if (primary_mon == MT_LCD) { | ||
| 2174 | unsigned int tmp = INREG(LVDS_GEN_CNTL); | ||
| 2175 | |||
| 2176 | mode->lvds_gen_cntl &= ~LVDS_STATE_MASK; | ||
| 2177 | mode->lvds_gen_cntl |= (rinfo->init_state.lvds_gen_cntl & LVDS_STATE_MASK); | ||
| 2178 | |||
| 2179 | if ((tmp & (LVDS_ON | LVDS_BLON)) == | ||
| 2180 | (mode->lvds_gen_cntl & (LVDS_ON | LVDS_BLON))) { | ||
| 2181 | OUTREG(LVDS_GEN_CNTL, mode->lvds_gen_cntl); | ||
| 2182 | } else { | ||
| 2183 | if (mode->lvds_gen_cntl & (LVDS_ON | LVDS_BLON)) { | ||
| 2184 | udelay(1000); | ||
| 2185 | OUTREG(LVDS_GEN_CNTL, mode->lvds_gen_cntl); | ||
| 2186 | } else { | ||
| 2187 | OUTREG(LVDS_GEN_CNTL, mode->lvds_gen_cntl | | ||
| 2188 | LVDS_BLON); | ||
| 2189 | udelay(1000); | ||
| 2190 | OUTREG(LVDS_GEN_CNTL, mode->lvds_gen_cntl); | ||
| 2191 | } | ||
| 2192 | } | ||
| 2193 | } | ||
| 2194 | } | ||
| 2195 | |||
| 2196 | radeonfb_blank(VESA_NO_BLANKING, (struct fb_info *)rinfo); | ||
| 2197 | |||
| 2198 | OUTPLL(VCLK_ECP_CNTL, mode->vclk_ecp_cntl); | ||
| 2199 | |||
| 2200 | return; | ||
| 2201 | } | ||
| 2202 | |||
| 2203 | static struct fb_ops radeonfb_ops = { | ||
| 2204 | .owner = THIS_MODULE, | ||
| 2205 | .fb_check_var = radeonfb_check_var, | ||
| 2206 | .fb_set_par = radeonfb_set_par, | ||
| 2207 | .fb_setcolreg = radeonfb_setcolreg, | ||
| 2208 | .fb_pan_display = radeonfb_pan_display, | ||
| 2209 | .fb_blank = radeonfb_blank, | ||
| 2210 | .fb_ioctl = radeonfb_ioctl, | ||
| 2211 | #if 0 | ||
| 2212 | .fb_fillrect = radeonfb_fillrect, | ||
| 2213 | .fb_copyarea = radeonfb_copyarea, | ||
| 2214 | .fb_imageblit = radeonfb_imageblit, | ||
| 2215 | .fb_rasterimg = radeonfb_rasterimg, | ||
| 2216 | #else | ||
| 2217 | .fb_fillrect = cfb_fillrect, | ||
| 2218 | .fb_copyarea = cfb_copyarea, | ||
| 2219 | .fb_imageblit = cfb_imageblit, | ||
| 2220 | #endif | ||
| 2221 | }; | ||
| 2222 | |||
| 2223 | |||
| 2224 | static int __devinit radeon_set_fbinfo (struct radeonfb_info *rinfo) | ||
| 2225 | { | ||
| 2226 | struct fb_info *info; | ||
| 2227 | |||
| 2228 | info = &rinfo->info; | ||
| 2229 | |||
| 2230 | info->par = rinfo; | ||
| 2231 | info->pseudo_palette = rinfo->pseudo_palette; | ||
| 2232 | info->flags = FBINFO_DEFAULT | FBINFO_HWACCEL_YPAN; | ||
| 2233 | info->fbops = &radeonfb_ops; | ||
| 2234 | info->screen_base = rinfo->fb_base; | ||
| 2235 | |||
| 2236 | /* Fill fix common fields */ | ||
| 2237 | strlcpy(info->fix.id, rinfo->name, sizeof(info->fix.id)); | ||
| 2238 | info->fix.smem_start = rinfo->fb_base_phys; | ||
| 2239 | info->fix.smem_len = rinfo->video_ram; | ||
| 2240 | info->fix.type = FB_TYPE_PACKED_PIXELS; | ||
| 2241 | info->fix.visual = FB_VISUAL_PSEUDOCOLOR; | ||
| 2242 | info->fix.xpanstep = 8; | ||
| 2243 | info->fix.ypanstep = 1; | ||
| 2244 | info->fix.ywrapstep = 0; | ||
| 2245 | info->fix.type_aux = 0; | ||
| 2246 | info->fix.mmio_start = rinfo->mmio_base_phys; | ||
| 2247 | info->fix.mmio_len = RADEON_REGSIZE; | ||
| 2248 | if (noaccel) | ||
| 2249 | info->fix.accel = FB_ACCEL_NONE; | ||
| 2250 | else | ||
| 2251 | info->fix.accel = FB_ACCEL_ATI_RADEON; | ||
| 2252 | |||
| 2253 | if (radeon_init_disp (rinfo) < 0) | ||
| 2254 | return -1; | ||
| 2255 | |||
| 2256 | return 0; | ||
| 2257 | } | ||
| 2258 | |||
| 2259 | |||
| 2260 | #ifdef CONFIG_PMAC_BACKLIGHT | ||
| 2261 | |||
| 2262 | /* TODO: Dbl check these tables, we don't go up to full ON backlight | ||
| 2263 | * in these, possibly because we noticed MacOS doesn't, but I'd prefer | ||
| 2264 | * having some more official numbers from ATI | ||
| 2265 | */ | ||
| 2266 | static int backlight_conv_m6[] = { | ||
| 2267 | 0xff, 0xc0, 0xb5, 0xaa, 0x9f, 0x94, 0x89, 0x7e, | ||
| 2268 | 0x73, 0x68, 0x5d, 0x52, 0x47, 0x3c, 0x31, 0x24 | ||
| 2269 | }; | ||
| 2270 | static int backlight_conv_m7[] = { | ||
| 2271 | 0x00, 0x3f, 0x4a, 0x55, 0x60, 0x6b, 0x76, 0x81, | ||
| 2272 | 0x8c, 0x97, 0xa2, 0xad, 0xb8, 0xc3, 0xce, 0xd9 | ||
| 2273 | }; | ||
| 2274 | |||
| 2275 | #define BACKLIGHT_LVDS_OFF | ||
| 2276 | #undef BACKLIGHT_DAC_OFF | ||
| 2277 | |||
| 2278 | /* We turn off the LCD completely instead of just dimming the backlight. | ||
| 2279 | * This provides some greater power saving and the display is useless | ||
| 2280 | * without backlight anyway. | ||
| 2281 | */ | ||
| 2282 | |||
| 2283 | static int radeon_set_backlight_enable(int on, int level, void *data) | ||
| 2284 | { | ||
| 2285 | struct radeonfb_info *rinfo = (struct radeonfb_info *)data; | ||
| 2286 | unsigned int lvds_gen_cntl = INREG(LVDS_GEN_CNTL); | ||
| 2287 | int* conv_table; | ||
| 2288 | |||
| 2289 | /* Pardon me for that hack... maybe some day we can figure | ||
| 2290 | * out in what direction backlight should work on a given | ||
| 2291 | * panel ? | ||
| 2292 | */ | ||
| 2293 | if ((rinfo->arch == RADEON_M7 || rinfo->arch == RADEON_M9) | ||
| 2294 | && !machine_is_compatible("PowerBook4,3")) | ||
| 2295 | conv_table = backlight_conv_m7; | ||
| 2296 | else | ||
| 2297 | conv_table = backlight_conv_m6; | ||
| 2298 | |||
| 2299 | lvds_gen_cntl |= (LVDS_BL_MOD_EN | LVDS_BLON); | ||
| 2300 | if (on && (level > BACKLIGHT_OFF)) { | ||
| 2301 | lvds_gen_cntl |= LVDS_DIGON; | ||
| 2302 | if (!(lvds_gen_cntl & LVDS_ON)) { | ||
| 2303 | lvds_gen_cntl &= ~LVDS_BLON; | ||
| 2304 | OUTREG(LVDS_GEN_CNTL, lvds_gen_cntl); | ||
| 2305 | (void)INREG(LVDS_GEN_CNTL); | ||
| 2306 | mdelay(10); | ||
| 2307 | lvds_gen_cntl |= LVDS_BLON; | ||
| 2308 | OUTREG(LVDS_GEN_CNTL, lvds_gen_cntl); | ||
| 2309 | } | ||
| 2310 | lvds_gen_cntl &= ~LVDS_BL_MOD_LEVEL_MASK; | ||
| 2311 | lvds_gen_cntl |= (conv_table[level] << | ||
| 2312 | LVDS_BL_MOD_LEVEL_SHIFT); | ||
| 2313 | lvds_gen_cntl |= (LVDS_ON | LVDS_EN); | ||
| 2314 | lvds_gen_cntl &= ~LVDS_DISPLAY_DIS; | ||
| 2315 | } else { | ||
| 2316 | lvds_gen_cntl &= ~LVDS_BL_MOD_LEVEL_MASK; | ||
| 2317 | lvds_gen_cntl |= (conv_table[0] << | ||
| 2318 | LVDS_BL_MOD_LEVEL_SHIFT); | ||
| 2319 | lvds_gen_cntl |= LVDS_DISPLAY_DIS; | ||
| 2320 | OUTREG(LVDS_GEN_CNTL, lvds_gen_cntl); | ||
| 2321 | udelay(10); | ||
| 2322 | lvds_gen_cntl &= ~(LVDS_ON | LVDS_EN | LVDS_BLON | LVDS_DIGON); | ||
| 2323 | } | ||
| 2324 | |||
| 2325 | OUTREG(LVDS_GEN_CNTL, lvds_gen_cntl); | ||
| 2326 | rinfo->init_state.lvds_gen_cntl &= ~LVDS_STATE_MASK; | ||
| 2327 | rinfo->init_state.lvds_gen_cntl |= (lvds_gen_cntl & LVDS_STATE_MASK); | ||
| 2328 | |||
| 2329 | return 0; | ||
| 2330 | } | ||
| 2331 | |||
| 2332 | static int radeon_set_backlight_level(int level, void *data) | ||
| 2333 | { | ||
| 2334 | return radeon_set_backlight_enable(1, level, data); | ||
| 2335 | } | ||
| 2336 | #endif /* CONFIG_PMAC_BACKLIGHT */ | ||
| 2337 | |||
| 2338 | |||
| 2339 | #ifdef CONFIG_PMAC_PBOOK | ||
| 2340 | |||
| 2341 | static u32 dbg_clk; | ||
| 2342 | |||
| 2343 | /* | ||
| 2344 | * Radeon M6 Power Management code. This code currently only supports | ||
| 2345 | * the mobile chips, it's based from some informations provided by ATI | ||
| 2346 | * along with hours of tracing of MacOS drivers | ||
| 2347 | */ | ||
| 2348 | |||
| 2349 | static void radeon_pm_save_regs(struct radeonfb_info *rinfo) | ||
| 2350 | { | ||
| 2351 | rinfo->save_regs[0] = INPLL(PLL_PWRMGT_CNTL); | ||
| 2352 | rinfo->save_regs[1] = INPLL(CLK_PWRMGT_CNTL); | ||
| 2353 | rinfo->save_regs[2] = INPLL(MCLK_CNTL); | ||
| 2354 | rinfo->save_regs[3] = INPLL(SCLK_CNTL); | ||
| 2355 | rinfo->save_regs[4] = INPLL(CLK_PIN_CNTL); | ||
| 2356 | rinfo->save_regs[5] = INPLL(VCLK_ECP_CNTL); | ||
| 2357 | rinfo->save_regs[6] = INPLL(PIXCLKS_CNTL); | ||
| 2358 | rinfo->save_regs[7] = INPLL(MCLK_MISC); | ||
| 2359 | rinfo->save_regs[8] = INPLL(P2PLL_CNTL); | ||
| 2360 | |||
| 2361 | rinfo->save_regs[9] = INREG(DISP_MISC_CNTL); | ||
| 2362 | rinfo->save_regs[10] = INREG(DISP_PWR_MAN); | ||
| 2363 | rinfo->save_regs[11] = INREG(LVDS_GEN_CNTL); | ||
| 2364 | rinfo->save_regs[12] = INREG(LVDS_PLL_CNTL); | ||
| 2365 | rinfo->save_regs[13] = INREG(TV_DAC_CNTL); | ||
| 2366 | rinfo->save_regs[14] = INREG(BUS_CNTL1); | ||
| 2367 | rinfo->save_regs[15] = INREG(CRTC_OFFSET_CNTL); | ||
| 2368 | rinfo->save_regs[16] = INREG(AGP_CNTL); | ||
| 2369 | rinfo->save_regs[17] = (INREG(CRTC_GEN_CNTL) & 0xfdffffff) | 0x04000000; | ||
| 2370 | rinfo->save_regs[18] = (INREG(CRTC2_GEN_CNTL) & 0xfdffffff) | 0x04000000; | ||
| 2371 | rinfo->save_regs[19] = INREG(GPIOPAD_A); | ||
| 2372 | rinfo->save_regs[20] = INREG(GPIOPAD_EN); | ||
| 2373 | rinfo->save_regs[21] = INREG(GPIOPAD_MASK); | ||
| 2374 | rinfo->save_regs[22] = INREG(ZV_LCDPAD_A); | ||
| 2375 | rinfo->save_regs[23] = INREG(ZV_LCDPAD_EN); | ||
| 2376 | rinfo->save_regs[24] = INREG(ZV_LCDPAD_MASK); | ||
| 2377 | rinfo->save_regs[25] = INREG(GPIO_VGA_DDC); | ||
| 2378 | rinfo->save_regs[26] = INREG(GPIO_DVI_DDC); | ||
| 2379 | rinfo->save_regs[27] = INREG(GPIO_MONID); | ||
| 2380 | rinfo->save_regs[28] = INREG(GPIO_CRT2_DDC); | ||
| 2381 | |||
| 2382 | rinfo->save_regs[29] = INREG(SURFACE_CNTL); | ||
| 2383 | rinfo->save_regs[30] = INREG(MC_FB_LOCATION); | ||
| 2384 | rinfo->save_regs[31] = INREG(DISPLAY_BASE_ADDR); | ||
| 2385 | rinfo->save_regs[32] = INREG(MC_AGP_LOCATION); | ||
| 2386 | rinfo->save_regs[33] = INREG(CRTC2_DISPLAY_BASE_ADDR); | ||
| 2387 | } | ||
| 2388 | |||
| 2389 | static void radeon_pm_restore_regs(struct radeonfb_info *rinfo) | ||
| 2390 | { | ||
| 2391 | OUTPLL(P2PLL_CNTL, rinfo->save_regs[8] & 0xFFFFFFFE); /* First */ | ||
| 2392 | |||
| 2393 | OUTPLL(PLL_PWRMGT_CNTL, rinfo->save_regs[0]); | ||
| 2394 | OUTPLL(CLK_PWRMGT_CNTL, rinfo->save_regs[1]); | ||
| 2395 | OUTPLL(MCLK_CNTL, rinfo->save_regs[2]); | ||
| 2396 | OUTPLL(SCLK_CNTL, rinfo->save_regs[3]); | ||
| 2397 | OUTPLL(CLK_PIN_CNTL, rinfo->save_regs[4]); | ||
| 2398 | OUTPLL(VCLK_ECP_CNTL, rinfo->save_regs[5]); | ||
| 2399 | OUTPLL(PIXCLKS_CNTL, rinfo->save_regs[6]); | ||
| 2400 | OUTPLL(MCLK_MISC, rinfo->save_regs[7]); | ||
| 2401 | |||
| 2402 | OUTREG(DISP_MISC_CNTL, rinfo->save_regs[9]); | ||
| 2403 | OUTREG(DISP_PWR_MAN, rinfo->save_regs[10]); | ||
| 2404 | OUTREG(LVDS_GEN_CNTL, rinfo->save_regs[11]); | ||
| 2405 | OUTREG(LVDS_PLL_CNTL,rinfo->save_regs[12]); | ||
| 2406 | OUTREG(TV_DAC_CNTL, rinfo->save_regs[13]); | ||
| 2407 | OUTREG(BUS_CNTL1, rinfo->save_regs[14]); | ||
| 2408 | OUTREG(CRTC_OFFSET_CNTL, rinfo->save_regs[15]); | ||
| 2409 | OUTREG(AGP_CNTL, rinfo->save_regs[16]); | ||
| 2410 | OUTREG(CRTC_GEN_CNTL, rinfo->save_regs[17]); | ||
| 2411 | OUTREG(CRTC2_GEN_CNTL, rinfo->save_regs[18]); | ||
| 2412 | |||
| 2413 | // wait VBL before that one ? | ||
| 2414 | OUTPLL(P2PLL_CNTL, rinfo->save_regs[8]); | ||
| 2415 | |||
| 2416 | OUTREG(GPIOPAD_A, rinfo->save_regs[19]); | ||
| 2417 | OUTREG(GPIOPAD_EN, rinfo->save_regs[20]); | ||
| 2418 | OUTREG(GPIOPAD_MASK, rinfo->save_regs[21]); | ||
| 2419 | OUTREG(ZV_LCDPAD_A, rinfo->save_regs[22]); | ||
| 2420 | OUTREG(ZV_LCDPAD_EN, rinfo->save_regs[23]); | ||
| 2421 | OUTREG(ZV_LCDPAD_MASK, rinfo->save_regs[24]); | ||
| 2422 | OUTREG(GPIO_VGA_DDC, rinfo->save_regs[25]); | ||
| 2423 | OUTREG(GPIO_DVI_DDC, rinfo->save_regs[26]); | ||
| 2424 | OUTREG(GPIO_MONID, rinfo->save_regs[27]); | ||
| 2425 | OUTREG(GPIO_CRT2_DDC, rinfo->save_regs[28]); | ||
| 2426 | } | ||
| 2427 | |||
| 2428 | static void radeon_pm_disable_iopad(struct radeonfb_info *rinfo) | ||
| 2429 | { | ||
| 2430 | OUTREG(GPIOPAD_MASK, 0x0001ffff); | ||
| 2431 | OUTREG(GPIOPAD_EN, 0x00000400); | ||
| 2432 | OUTREG(GPIOPAD_A, 0x00000000); | ||
| 2433 | OUTREG(ZV_LCDPAD_MASK, 0x00000000); | ||
| 2434 | OUTREG(ZV_LCDPAD_EN, 0x00000000); | ||
| 2435 | OUTREG(ZV_LCDPAD_A, 0x00000000); | ||
| 2436 | OUTREG(GPIO_VGA_DDC, 0x00030000); | ||
| 2437 | OUTREG(GPIO_DVI_DDC, 0x00000000); | ||
| 2438 | OUTREG(GPIO_MONID, 0x00030000); | ||
| 2439 | OUTREG(GPIO_CRT2_DDC, 0x00000000); | ||
| 2440 | } | ||
| 2441 | |||
| 2442 | static void radeon_pm_program_v2clk(struct radeonfb_info *rinfo) | ||
| 2443 | { | ||
| 2444 | // | ||
| 2445 | // u32 reg; | ||
| 2446 | // | ||
| 2447 | // OUTPLL(P2PLL_REF_DIV, 0x0c); | ||
| 2448 | // | ||
| 2449 | // .../... figure out what macos does here | ||
| 2450 | } | ||
| 2451 | |||
| 2452 | static void radeon_pm_low_current(struct radeonfb_info *rinfo) | ||
| 2453 | { | ||
| 2454 | u32 reg; | ||
| 2455 | |||
| 2456 | reg = INREG(BUS_CNTL1); | ||
| 2457 | reg &= ~BUS_CNTL1_MOBILE_PLATFORM_SEL_MASK; | ||
| 2458 | reg |= BUS_CNTL1_AGPCLK_VALID | (1<<BUS_CNTL1_MOBILE_PLATFORM_SEL_SHIFT); | ||
| 2459 | OUTREG(BUS_CNTL1, reg); | ||
| 2460 | |||
| 2461 | reg = INPLL(PLL_PWRMGT_CNTL); | ||
| 2462 | reg |= PLL_PWRMGT_CNTL_SPLL_TURNOFF | PLL_PWRMGT_CNTL_PPLL_TURNOFF | | ||
| 2463 | PLL_PWRMGT_CNTL_P2PLL_TURNOFF | PLL_PWRMGT_CNTL_TVPLL_TURNOFF; | ||
| 2464 | reg &= ~PLL_PWRMGT_CNTL_SU_MCLK_USE_BCLK; | ||
| 2465 | reg &= ~PLL_PWRMGT_CNTL_MOBILE_SU; | ||
| 2466 | OUTPLL(PLL_PWRMGT_CNTL, reg); | ||
| 2467 | |||
| 2468 | // reg = INPLL(TV_PLL_CNTL1); | ||
| 2469 | // reg |= TV_PLL_CNTL1__TVPLL_RESET | TV_PLL_CNTL1__TVPLL_SLEEP; | ||
| 2470 | // OUTPLL(TV_PLL_CNTL1, reg); | ||
| 2471 | |||
| 2472 | reg = INREG(TV_DAC_CNTL); | ||
| 2473 | reg &= ~(TV_DAC_CNTL_BGADJ_MASK |TV_DAC_CNTL_DACADJ_MASK); | ||
| 2474 | reg |=TV_DAC_CNTL_BGSLEEP | TV_DAC_CNTL_RDACPD | TV_DAC_CNTL_GDACPD | | ||
| 2475 | TV_DAC_CNTL_BDACPD | | ||
| 2476 | (8<<TV_DAC_CNTL_BGADJ__SHIFT) | (8<<TV_DAC_CNTL_DACADJ__SHIFT); | ||
| 2477 | OUTREG(TV_DAC_CNTL, reg); | ||
| 2478 | |||
| 2479 | reg = INREG(TMDS_TRANSMITTER_CNTL); | ||
| 2480 | reg &= ~(TMDS_PLL_EN |TMDS_PLLRST); | ||
| 2481 | OUTREG(TMDS_TRANSMITTER_CNTL, reg); | ||
| 2482 | |||
| 2483 | // lvds_pll_cntl = regr32(g, LVDS_PLL_CNTL); | ||
| 2484 | // lvds_pll_cntl &= ~LVDS_PLL_CNTL__LVDS_PLL_EN; | ||
| 2485 | // lvds_pll_cntl |= LVDS_PLL_CNTL__LVDS_PLL_RESET; | ||
| 2486 | // regw32(g, LVDS_PLL_CNTL, lvds_pll_cntl); | ||
| 2487 | |||
| 2488 | reg = INREG(DAC_CNTL); | ||
| 2489 | reg &= ~DAC_CMP_EN; | ||
| 2490 | OUTREG(DAC_CNTL, reg); | ||
| 2491 | |||
| 2492 | reg = INREG(DAC_CNTL2); | ||
| 2493 | reg &= ~DAC2_CMP_EN; | ||
| 2494 | OUTREG(DAC_CNTL2, reg); | ||
| 2495 | |||
| 2496 | reg = INREG(TV_DAC_CNTL); | ||
| 2497 | reg &= ~TV_DAC_CNTL_DETECT; | ||
| 2498 | OUTREG(TV_DAC_CNTL, reg); | ||
| 2499 | } | ||
| 2500 | |||
| 2501 | static void radeon_pm_setup_for_suspend(struct radeonfb_info *rinfo) | ||
| 2502 | { | ||
| 2503 | /* This code is disabled. It does what is in the pm_init | ||
| 2504 | * function of the MacOS driver code ATI sent me. However, | ||
| 2505 | * it doesn't fix my sleep problem, and is causing other issues | ||
| 2506 | * on wakeup (bascially the machine dying when switching consoles | ||
| 2507 | * I haven't had time to investigate this yet | ||
| 2508 | */ | ||
| 2509 | #if 0 | ||
| 2510 | u32 disp_misc_cntl; | ||
| 2511 | u32 disp_pwr_man; | ||
| 2512 | u32 temp; | ||
| 2513 | |||
| 2514 | // set SPLL, MPLL, PPLL, P2PLL, TVPLL, SCLK, MCLK, PCLK, P2CLK, | ||
| 2515 | // TCLK and TEST_MODE to 0 | ||
| 2516 | temp = INPLL(CLK_PWRMGT_CNTL); | ||
| 2517 | OUTPLL(CLK_PWRMGT_CNTL , temp & ~0xc00002ff); | ||
| 2518 | |||
| 2519 | // Turn on Power Management | ||
| 2520 | temp = INPLL(CLK_PWRMGT_CNTL); | ||
| 2521 | OUTPLL(CLK_PWRMGT_CNTL , temp | 0x00000400); | ||
| 2522 | |||
| 2523 | // Turn off display clock if using mobile chips | ||
| 2524 | temp = INPLL(CLK_PWRMGT_CNTL); | ||
| 2525 | OUTREG(CLK_PWRMGT_CNTL , temp | 0x00100000); | ||
| 2526 | |||
| 2527 | // Force PIXCLK_ALWAYS_ON and PIXCLK_DAC_ALWAYS_ON | ||
| 2528 | temp = INPLL(VCLK_ECP_CNTL); | ||
| 2529 | OUTPLL(VCLK_ECP_CNTL, temp & ~0x000000c0); | ||
| 2530 | |||
| 2531 | // Force ECP_FORCE_ON to 1 | ||
| 2532 | temp = INPLL(VCLK_ECP_CNTL); | ||
| 2533 | OUTPLL(VCLK_ECP_CNTL, temp | 0x00040000); | ||
| 2534 | |||
| 2535 | // Force PIXCLK_BLEND_ALWAYS_ON and PIXCLK_GV_ALWAYS_ON | ||
| 2536 | temp = INPLL(PIXCLKS_CNTL); | ||
| 2537 | OUTPLL(PIXCLKS_CNTL, temp & ~0x00001800); | ||
| 2538 | |||
| 2539 | // Forcing SCLK_CNTL to ON | ||
| 2540 | OUTPLL(SCLK_CNTL, (INPLL(SCLK_CNTL)& 0x00000007) | 0xffff8000 ); | ||
| 2541 | |||
| 2542 | // Set PM control over XTALIN pad | ||
| 2543 | temp = INPLL(CLK_PIN_CNTL); | ||
| 2544 | OUTPLL(CLK_PIN_CNTL, temp | 0x00080000); | ||
| 2545 | |||
| 2546 | // Force MCLK and YCLK and MC as dynamic | ||
| 2547 | temp = INPLL(MCLK_CNTL); | ||
| 2548 | OUTPLL(MCLK_CNTL, temp & 0xffeaffff); | ||
| 2549 | |||
| 2550 | // PLL_TURNOFF | ||
| 2551 | temp = INPLL(PLL_PWRMGT_CNTL); | ||
| 2552 | OUTPLL(PLL_PWRMGT_CNTL, temp | 0x0000001f); | ||
| 2553 | |||
| 2554 | // set MOBILE_SU to 1 if M6 or DDR64 is detected | ||
| 2555 | temp = INPLL(PLL_PWRMGT_CNTL); | ||
| 2556 | OUTPLL(PLL_PWRMGT_CNTL, temp | 0x00010000); | ||
| 2557 | |||
| 2558 | // select PM access mode (PM_MODE_SEL) (use ACPI mode) | ||
| 2559 | // temp = INPLL(PLL_PWRMGT_CNTL); | ||
| 2560 | // OUTPLL(PLL_PWRMGT_CNTL, temp | 0x00002000); | ||
| 2561 | temp = INPLL(PLL_PWRMGT_CNTL); | ||
| 2562 | OUTPLL(PLL_PWRMGT_CNTL, temp & ~0x00002000); | ||
| 2563 | |||
| 2564 | // set DISP_MISC_CNTL register | ||
| 2565 | disp_misc_cntl = INREG(DISP_MISC_CNTL); | ||
| 2566 | disp_misc_cntl &= ~( DISP_MISC_CNTL_SOFT_RESET_GRPH_PP | | ||
| 2567 | DISP_MISC_CNTL_SOFT_RESET_SUBPIC_PP | | ||
| 2568 | DISP_MISC_CNTL_SOFT_RESET_OV0_PP | | ||
| 2569 | DISP_MISC_CNTL_SOFT_RESET_GRPH_SCLK | | ||
| 2570 | DISP_MISC_CNTL_SOFT_RESET_SUBPIC_SCLK | | ||
| 2571 | DISP_MISC_CNTL_SOFT_RESET_OV0_SCLK | | ||
| 2572 | DISP_MISC_CNTL_SOFT_RESET_GRPH2_PP | | ||
| 2573 | DISP_MISC_CNTL_SOFT_RESET_GRPH2_SCLK | | ||
| 2574 | DISP_MISC_CNTL_SOFT_RESET_LVDS | | ||
| 2575 | DISP_MISC_CNTL_SOFT_RESET_TMDS | | ||
| 2576 | DISP_MISC_CNTL_SOFT_RESET_DIG_TMDS | | ||
| 2577 | DISP_MISC_CNTL_SOFT_RESET_TV); | ||
| 2578 | OUTREG(DISP_MISC_CNTL, disp_misc_cntl); | ||
| 2579 | |||
| 2580 | // set DISP_PWR_MAN register | ||
| 2581 | disp_pwr_man = INREG(DISP_PWR_MAN); | ||
| 2582 | // clau - 9.29.2000 - changes made to bit23:18 to set to 1 as requested by George | ||
| 2583 | disp_pwr_man |= (DISP_PWR_MAN_DIG_TMDS_ENABLE_RST | | ||
| 2584 | DISP_PWR_MAN_TV_ENABLE_RST | | ||
| 2585 | // DISP_PWR_MAN_AUTO_PWRUP_EN | | ||
| 2586 | DISP_PWR_MAN_DISP_D3_GRPH_RST | | ||
| 2587 | DISP_PWR_MAN_DISP_D3_SUBPIC_RST | | ||
| 2588 | DISP_PWR_MAN_DISP_D3_OV0_RST | | ||
| 2589 | DISP_PWR_MAN_DISP_D1D2_GRPH_RST | | ||
| 2590 | DISP_PWR_MAN_DISP_D1D2_SUBPIC_RST | | ||
| 2591 | DISP_PWR_MAN_DISP_D1D2_OV0_RST); | ||
| 2592 | disp_pwr_man &= ~(DISP_PWR_MAN_DISP_PWR_MAN_D3_CRTC_EN | | ||
| 2593 | DISP_PWR_MAN_DISP2_PWR_MAN_D3_CRTC2_EN| | ||
| 2594 | DISP_PWR_MAN_DISP_D3_RST | | ||
| 2595 | DISP_PWR_MAN_DISP_D3_REG_RST); | ||
| 2596 | OUTREG(DISP_PWR_MAN, disp_pwr_man); | ||
| 2597 | |||
| 2598 | // clau - 10.24.2000 | ||
| 2599 | // - add in setting for BUS_CNTL1 b27:26 = 0x01 and b31 = 0x1 | ||
| 2600 | // - add in setting for AGP_CNTL b7:0 = 0x20 | ||
| 2601 | // - add in setting for DVI_DDC_DATA_OUT_EN b17:16 = 0x0 | ||
| 2602 | |||
| 2603 | // the following settings (two lines) are applied at a later part of this function, only on mobile platform | ||
| 2604 | // requres -mobile flag | ||
| 2605 | OUTREG(BUS_CNTL1, (INREG(BUS_CNTL1) & 0xf3ffffff) | 0x04000000); | ||
| 2606 | OUTREG(BUS_CNTL1, INREG(BUS_CNTL1) | 0x80000000); | ||
| 2607 | OUTREG(AGP_CNTL, (INREG(AGP_CNTL) & 0xffffff00) | 0x20); | ||
| 2608 | OUTREG(GPIO_DVI_DDC, INREG(GPIO_DVI_DDC) & 0xfffcffff); | ||
| 2609 | |||
| 2610 | // yulee - 12.12.2000 | ||
| 2611 | // A12 only | ||
| 2612 | // EN_MCLK_TRISTATE_IN_SUSPEND@MCLK_MISC = 1 | ||
| 2613 | // ACCESS_REGS_IN_SUSPEND@CLK_PIN_CNTL = 0 | ||
| 2614 | // only on mobile platform | ||
| 2615 | OUTPLL(MCLK_MISC, INPLL(MCLK_MISC) | 0x00040000 ); | ||
| 2616 | |||
| 2617 | // yulee -12.12.2000 | ||
| 2618 | // AGPCLK_VALID@BUS_CNTL1 = 1 | ||
| 2619 | // MOBILE_PLATFORM_SEL@BUS_CNTL1 = 01 | ||
| 2620 | // CRTC_STEREO_SYNC_OUT_EN@CRTC_OFFSET_CNTL = 0 | ||
| 2621 | // CG_CLK_TO_OUTPIN@CLK_PIN_CNTL = 0 | ||
| 2622 | // only on mobile platform | ||
| 2623 | OUTPLL(CLK_PIN_CNTL, INPLL(CLK_PIN_CNTL ) & 0xFFFFF7FF ); | ||
| 2624 | OUTREG(BUS_CNTL1, (INREG(BUS_CNTL1 ) & 0xF3FFFFFF) | 0x84000000 ); | ||
| 2625 | OUTREG(CRTC_OFFSET_CNTL, INREG(CRTC_OFFSET_CNTL ) & 0xFFEFFFFF ); | ||
| 2626 | |||
| 2627 | mdelay(100); | ||
| 2628 | #endif | ||
| 2629 | |||
| 2630 | /* Disable CRTCs */ | ||
| 2631 | OUTREG(CRTC_GEN_CNTL, (INREG(CRTC_GEN_CNTL) & ~CRTC_EN) | CRTC_DISP_REQ_EN_B); | ||
| 2632 | OUTREG(CRTC2_GEN_CNTL, (INREG(CRTC2_GEN_CNTL) & ~CRTC2_EN) | CRTC2_DISP_REQ_EN_B); | ||
| 2633 | (void)INREG(CRTC2_GEN_CNTL); | ||
| 2634 | mdelay(17); | ||
| 2635 | } | ||
| 2636 | |||
| 2637 | static void radeon_set_suspend(struct radeonfb_info *rinfo, int suspend) | ||
| 2638 | { | ||
| 2639 | u16 pwr_cmd; | ||
| 2640 | |||
| 2641 | if (!rinfo->pm_reg) | ||
| 2642 | return; | ||
| 2643 | |||
| 2644 | /* Set the chip into appropriate suspend mode (we use D2, | ||
| 2645 | * D3 would require a compete re-initialization of the chip, | ||
| 2646 | * including PCI config registers, clocks, AGP conf, ...) | ||
| 2647 | */ | ||
| 2648 | if (suspend) { | ||
| 2649 | /* According to ATI, we should program V2CLK here, I have | ||
| 2650 | * to verify what's up exactly | ||
| 2651 | */ | ||
| 2652 | /* Save some registers */ | ||
| 2653 | radeon_pm_save_regs(rinfo); | ||
| 2654 | |||
| 2655 | /* Check that on M7 too, might work might not. M7 may also | ||
| 2656 | * need explicit enabling of PM | ||
| 2657 | */ | ||
| 2658 | if (rinfo->arch == RADEON_M6) { | ||
| 2659 | /* Program V2CLK */ | ||
| 2660 | radeon_pm_program_v2clk(rinfo); | ||
| 2661 | |||
| 2662 | /* Disable IO PADs */ | ||
| 2663 | radeon_pm_disable_iopad(rinfo); | ||
| 2664 | |||
| 2665 | /* Set low current */ | ||
| 2666 | radeon_pm_low_current(rinfo); | ||
| 2667 | |||
| 2668 | /* Prepare chip for power management */ | ||
| 2669 | radeon_pm_setup_for_suspend(rinfo); | ||
| 2670 | |||
| 2671 | /* Reset the MDLL */ | ||
| 2672 | OUTPLL(MDLL_CKO, INPLL(MDLL_CKO) | MCKOA_RESET); | ||
| 2673 | (void)INPLL(MDLL_RDCKA); | ||
| 2674 | OUTPLL(MDLL_CKO, INPLL(MDLL_CKO) & ~MCKOA_RESET); | ||
| 2675 | (void)INPLL(MDLL_RDCKA); | ||
| 2676 | } | ||
| 2677 | |||
| 2678 | /* Switch PCI power managment to D2. */ | ||
| 2679 | for (;;) { | ||
| 2680 | pci_read_config_word( | ||
| 2681 | rinfo->pdev, rinfo->pm_reg+PCI_PM_CTRL, | ||
| 2682 | &pwr_cmd); | ||
| 2683 | if (pwr_cmd & 2) | ||
| 2684 | break; | ||
| 2685 | pci_write_config_word( | ||
| 2686 | rinfo->pdev, rinfo->pm_reg+PCI_PM_CTRL, | ||
| 2687 | (pwr_cmd & ~PCI_PM_CTRL_STATE_MASK) | 2); | ||
| 2688 | mdelay(500); | ||
| 2689 | } | ||
| 2690 | } else { | ||
| 2691 | /* Switch back PCI powermanagment to D0 */ | ||
| 2692 | mdelay(200); | ||
| 2693 | pci_write_config_word(rinfo->pdev, rinfo->pm_reg+PCI_PM_CTRL, 0); | ||
| 2694 | mdelay(500); | ||
| 2695 | |||
| 2696 | dbg_clk = INPLL(1); | ||
| 2697 | |||
| 2698 | /* Do we need that on M7 ? */ | ||
| 2699 | if (rinfo->arch == RADEON_M6) { | ||
| 2700 | /* Restore the MDLL */ | ||
| 2701 | OUTPLL(MDLL_CKO, INPLL(MDLL_CKO) & ~MCKOA_RESET); | ||
| 2702 | (void)INPLL(MDLL_CKO); | ||
| 2703 | } | ||
| 2704 | |||
| 2705 | /* Restore some registers */ | ||
| 2706 | radeon_pm_restore_regs(rinfo); | ||
| 2707 | } | ||
| 2708 | } | ||
| 2709 | |||
| 2710 | /* | ||
| 2711 | * Save the contents of the framebuffer when we go to sleep, | ||
| 2712 | * and restore it when we wake up again. | ||
| 2713 | */ | ||
| 2714 | |||
| 2715 | int radeon_sleep_notify(struct pmu_sleep_notifier *self, int when) | ||
| 2716 | { | ||
| 2717 | struct radeonfb_info *rinfo; | ||
| 2718 | |||
| 2719 | for (rinfo = board_list; rinfo != NULL; rinfo = rinfo->next) { | ||
| 2720 | struct fb_fix_screeninfo fix; | ||
| 2721 | int nb; | ||
| 2722 | struct display *disp; | ||
| 2723 | |||
| 2724 | disp = (rinfo->currcon < 0) ? rinfo->info.disp : &fb_display[rinfo->currcon]; | ||
| 2725 | |||
| 2726 | switch (rinfo->arch) { | ||
| 2727 | case RADEON_M6: | ||
| 2728 | case RADEON_M7: | ||
| 2729 | case RADEON_M9: | ||
| 2730 | break; | ||
| 2731 | default: | ||
| 2732 | return PBOOK_SLEEP_REFUSE; | ||
| 2733 | } | ||
| 2734 | |||
| 2735 | radeonfb_get_fix(&fix, fg_console, (struct fb_info *)rinfo); | ||
| 2736 | nb = fb_display[fg_console].var.yres * fix.line_length; | ||
| 2737 | |||
| 2738 | switch (when) { | ||
| 2739 | case PBOOK_SLEEP_NOW: | ||
| 2740 | acquire_console_sem(); | ||
| 2741 | disp->dispsw = &fbcon_dummy; | ||
| 2742 | |||
| 2743 | if (!noaccel) { | ||
| 2744 | /* Make sure engine is reset */ | ||
| 2745 | radeon_engine_reset(); | ||
| 2746 | radeon_engine_idle(); | ||
| 2747 | } | ||
| 2748 | |||
| 2749 | /* Blank display and LCD */ | ||
| 2750 | radeonfb_blank(VESA_POWERDOWN+1, | ||
| 2751 | (struct fb_info *)rinfo); | ||
| 2752 | |||
| 2753 | /* Sleep */ | ||
| 2754 | rinfo->asleep = 1; | ||
| 2755 | radeon_set_suspend(rinfo, 1); | ||
| 2756 | release_console_sem(); | ||
| 2757 | |||
| 2758 | break; | ||
| 2759 | case PBOOK_WAKE: | ||
| 2760 | acquire_console_sem(); | ||
| 2761 | /* Wakeup */ | ||
| 2762 | radeon_set_suspend(rinfo, 0); | ||
| 2763 | |||
| 2764 | if (!noaccel) | ||
| 2765 | radeon_engine_init(rinfo); | ||
| 2766 | rinfo->asleep = 0; | ||
| 2767 | radeon_set_dispsw(rinfo, disp); | ||
| 2768 | radeon_load_video_mode(rinfo, &disp->var); | ||
| 2769 | do_install_cmap(rinfo->currcon < 0 ? 0 : rinfo->currcon, | ||
| 2770 | (struct fb_info *)rinfo); | ||
| 2771 | |||
| 2772 | radeonfb_blank(0, (struct fb_info *)rinfo); | ||
| 2773 | release_console_sem(); | ||
| 2774 | printk("CLK_PIN_CNTL on wakeup was: %08x\n", dbg_clk); | ||
| 2775 | break; | ||
| 2776 | } | ||
| 2777 | } | ||
| 2778 | |||
| 2779 | return PBOOK_SLEEP_OK; | ||
| 2780 | } | ||
| 2781 | |||
| 2782 | #endif /* CONFIG_PMAC_PBOOK */ | ||
| 2783 | |||
| 2784 | static int radeonfb_pci_register (struct pci_dev *pdev, | ||
| 2785 | const struct pci_device_id *ent) | ||
| 2786 | { | ||
| 2787 | struct radeonfb_info *rinfo; | ||
| 2788 | struct radeon_chip_info *rci = &radeon_chip_info[ent->driver_data]; | ||
| 2789 | u32 tmp; | ||
| 2790 | |||
| 2791 | RTRACE("radeonfb_pci_register BEGIN\n"); | ||
| 2792 | |||
| 2793 | /* Enable device in PCI config */ | ||
| 2794 | if (pci_enable_device(pdev) != 0) { | ||
| 2795 | printk(KERN_ERR "radeonfb: Cannot enable PCI device\n"); | ||
| 2796 | return -ENODEV; | ||
| 2797 | } | ||
| 2798 | |||
| 2799 | rinfo = kmalloc (sizeof (struct radeonfb_info), GFP_KERNEL); | ||
| 2800 | if (!rinfo) { | ||
| 2801 | printk ("radeonfb: could not allocate memory\n"); | ||
| 2802 | return -ENODEV; | ||
| 2803 | } | ||
| 2804 | |||
| 2805 | memset (rinfo, 0, sizeof (struct radeonfb_info)); | ||
| 2806 | //info = &rinfo->info; | ||
| 2807 | rinfo->pdev = pdev; | ||
| 2808 | strcpy(rinfo->name, rci->name); | ||
| 2809 | rinfo->arch = rci->arch; | ||
| 2810 | |||
| 2811 | /* Set base addrs */ | ||
| 2812 | rinfo->fb_base_phys = pci_resource_start (pdev, 0); | ||
| 2813 | rinfo->mmio_base_phys = pci_resource_start (pdev, 2); | ||
| 2814 | |||
| 2815 | /* request the mem regions */ | ||
| 2816 | if (!request_mem_region (rinfo->fb_base_phys, | ||
| 2817 | pci_resource_len(pdev, 0), "radeonfb")) { | ||
| 2818 | printk ("radeonfb: cannot reserve FB region\n"); | ||
| 2819 | kfree (rinfo); | ||
| 2820 | return -ENODEV; | ||
| 2821 | } | ||
| 2822 | |||
| 2823 | if (!request_mem_region (rinfo->mmio_base_phys, | ||
| 2824 | pci_resource_len(pdev, 2), "radeonfb")) { | ||
| 2825 | printk ("radeonfb: cannot reserve MMIO region\n"); | ||
| 2826 | release_mem_region (rinfo->fb_base_phys, | ||
| 2827 | pci_resource_len(pdev, 0)); | ||
| 2828 | kfree (rinfo); | ||
| 2829 | return -ENODEV; | ||
| 2830 | } | ||
| 2831 | |||
| 2832 | /* map the regions */ | ||
| 2833 | rinfo->mmio_base = ioremap (rinfo->mmio_base_phys, RADEON_REGSIZE); | ||
| 2834 | if (!rinfo->mmio_base) { | ||
| 2835 | printk ("radeonfb: cannot map MMIO\n"); | ||
| 2836 | release_mem_region (rinfo->mmio_base_phys, | ||
| 2837 | pci_resource_len(pdev, 2)); | ||
| 2838 | release_mem_region (rinfo->fb_base_phys, | ||
| 2839 | pci_resource_len(pdev, 0)); | ||
| 2840 | kfree (rinfo); | ||
| 2841 | return -ENODEV; | ||
| 2842 | } | ||
| 2843 | |||
| 2844 | rinfo->chipset = pdev->device; | ||
| 2845 | |||
| 2846 | switch (rinfo->arch) { | ||
| 2847 | case RADEON_R100: | ||
| 2848 | rinfo->hasCRTC2 = 0; | ||
| 2849 | break; | ||
| 2850 | default: | ||
| 2851 | /* all the rest have it */ | ||
| 2852 | rinfo->hasCRTC2 = 1; | ||
| 2853 | break; | ||
| 2854 | } | ||
| 2855 | #if 0 | ||
| 2856 | if (rinfo->arch == RADEON_M7) { | ||
| 2857 | /* | ||
| 2858 | * Noticed some errors in accel with M7, will have to work these out... | ||
| 2859 | */ | ||
| 2860 | noaccel = 1; | ||
| 2861 | } | ||
| 2862 | #endif | ||
| 2863 | if (mirror) | ||
| 2864 | printk("radeonfb: mirroring display to CRT\n"); | ||
| 2865 | |||
| 2866 | /* framebuffer size */ | ||
| 2867 | tmp = INREG(CONFIG_MEMSIZE); | ||
| 2868 | |||
| 2869 | /* mem size is bits [28:0], mask off the rest */ | ||
| 2870 | rinfo->video_ram = tmp & CONFIG_MEMSIZE_MASK; | ||
| 2871 | |||
| 2872 | /* ram type */ | ||
| 2873 | tmp = INREG(MEM_SDRAM_MODE_REG); | ||
| 2874 | switch ((MEM_CFG_TYPE & tmp) >> 30) { | ||
| 2875 | case 0: | ||
| 2876 | /* SDR SGRAM (2:1) */ | ||
| 2877 | strcpy(rinfo->ram_type, "SDR SGRAM"); | ||
| 2878 | rinfo->ram.ml = 4; | ||
| 2879 | rinfo->ram.mb = 4; | ||
| 2880 | rinfo->ram.trcd = 1; | ||
| 2881 | rinfo->ram.trp = 2; | ||
| 2882 | rinfo->ram.twr = 1; | ||
| 2883 | rinfo->ram.cl = 2; | ||
| 2884 | rinfo->ram.loop_latency = 16; | ||
| 2885 | rinfo->ram.rloop = 16; | ||
| 2886 | |||
| 2887 | break; | ||
| 2888 | case 1: | ||
| 2889 | /* DDR SGRAM */ | ||
| 2890 | strcpy(rinfo->ram_type, "DDR SGRAM"); | ||
| 2891 | rinfo->ram.ml = 4; | ||
| 2892 | rinfo->ram.mb = 4; | ||
| 2893 | rinfo->ram.trcd = 3; | ||
| 2894 | rinfo->ram.trp = 3; | ||
| 2895 | rinfo->ram.twr = 2; | ||
| 2896 | rinfo->ram.cl = 3; | ||
| 2897 | rinfo->ram.tr2w = 1; | ||
| 2898 | rinfo->ram.loop_latency = 16; | ||
| 2899 | rinfo->ram.rloop = 16; | ||
| 2900 | |||
| 2901 | break; | ||
| 2902 | default: | ||
| 2903 | /* 64-bit SDR SGRAM */ | ||
| 2904 | strcpy(rinfo->ram_type, "SDR SGRAM 64"); | ||
| 2905 | rinfo->ram.ml = 4; | ||
| 2906 | rinfo->ram.mb = 8; | ||
| 2907 | rinfo->ram.trcd = 3; | ||
| 2908 | rinfo->ram.trp = 3; | ||
| 2909 | rinfo->ram.twr = 1; | ||
| 2910 | rinfo->ram.cl = 3; | ||
| 2911 | rinfo->ram.tr2w = 1; | ||
| 2912 | rinfo->ram.loop_latency = 17; | ||
| 2913 | rinfo->ram.rloop = 17; | ||
| 2914 | |||
| 2915 | break; | ||
| 2916 | } | ||
| 2917 | |||
| 2918 | rinfo->bios_seg = radeon_find_rom(rinfo); | ||
| 2919 | radeon_get_pllinfo(rinfo, rinfo->bios_seg); | ||
| 2920 | |||
| 2921 | /* | ||
| 2922 | * Hack to get around some busted production M6's | ||
| 2923 | * reporting no ram | ||
| 2924 | */ | ||
| 2925 | if (rinfo->video_ram == 0) { | ||
| 2926 | switch (pdev->device) { | ||
| 2927 | case PCI_DEVICE_ID_ATI_RADEON_LY: | ||
| 2928 | case PCI_DEVICE_ID_ATI_RADEON_LZ: | ||
| 2929 | rinfo->video_ram = 8192 * 1024; | ||
| 2930 | break; | ||
| 2931 | default: | ||
| 2932 | break; | ||
| 2933 | } | ||
| 2934 | } | ||
| 2935 | |||
| 2936 | |||
| 2937 | RTRACE("radeonfb: probed %s %dk videoram\n", (rinfo->ram_type), (rinfo->video_ram/1024)); | ||
| 2938 | |||
| 2939 | #if !defined(__powerpc__) | ||
| 2940 | radeon_get_moninfo(rinfo); | ||
| 2941 | #else | ||
| 2942 | switch (pdev->device) { | ||
| 2943 | case PCI_DEVICE_ID_ATI_RADEON_LW: | ||
| 2944 | case PCI_DEVICE_ID_ATI_RADEON_LX: | ||
| 2945 | case PCI_DEVICE_ID_ATI_RADEON_LY: | ||
| 2946 | case PCI_DEVICE_ID_ATI_RADEON_LZ: | ||
| 2947 | rinfo->dviDisp_type = MT_LCD; | ||
| 2948 | break; | ||
| 2949 | default: | ||
| 2950 | radeon_get_moninfo(rinfo); | ||
| 2951 | break; | ||
| 2952 | } | ||
| 2953 | #endif | ||
| 2954 | |||
| 2955 | radeon_get_EDID(rinfo); | ||
| 2956 | |||
| 2957 | if ((rinfo->dviDisp_type == MT_DFP) || (rinfo->dviDisp_type == MT_LCD) || | ||
| 2958 | (rinfo->crtDisp_type == MT_DFP)) { | ||
| 2959 | if (!radeon_get_dfpinfo(rinfo)) { | ||
| 2960 | iounmap(rinfo->mmio_base); | ||
| 2961 | release_mem_region (rinfo->mmio_base_phys, | ||
| 2962 | pci_resource_len(pdev, 2)); | ||
| 2963 | release_mem_region (rinfo->fb_base_phys, | ||
| 2964 | pci_resource_len(pdev, 0)); | ||
| 2965 | kfree (rinfo); | ||
| 2966 | return -ENODEV; | ||
| 2967 | } | ||
| 2968 | } | ||
| 2969 | |||
| 2970 | rinfo->fb_base = ioremap (rinfo->fb_base_phys, rinfo->video_ram); | ||
| 2971 | if (!rinfo->fb_base) { | ||
| 2972 | printk ("radeonfb: cannot map FB\n"); | ||
| 2973 | iounmap(rinfo->mmio_base); | ||
| 2974 | release_mem_region (rinfo->mmio_base_phys, | ||
| 2975 | pci_resource_len(pdev, 2)); | ||
| 2976 | release_mem_region (rinfo->fb_base_phys, | ||
| 2977 | pci_resource_len(pdev, 0)); | ||
| 2978 | kfree (rinfo); | ||
| 2979 | return -ENODEV; | ||
| 2980 | } | ||
| 2981 | |||
| 2982 | /* I SHOULD FIX THAT CRAP ! I should probably mimmic XFree DRI | ||
| 2983 | * driver setup here. | ||
| 2984 | * | ||
| 2985 | * On PPC, OF based cards setup the internal memory | ||
| 2986 | * mapping in strange ways. We change it so that the | ||
| 2987 | * framebuffer is mapped at 0 and given half of the card's | ||
| 2988 | * address space (2Gb). AGP is mapped high (0xe0000000) and | ||
| 2989 | * can use up to 512Mb. Once DRI is fully implemented, we | ||
| 2990 | * will have to setup the PCI remapper to remap the agp_special_page | ||
| 2991 | * memory page somewhere between those regions so that the card | ||
| 2992 | * use a normal PCI bus master cycle to access the ring read ptr. | ||
| 2993 | * --BenH. | ||
| 2994 | */ | ||
| 2995 | #ifdef CONFIG_ALL_PPC | ||
| 2996 | if (rinfo->hasCRTC2) | ||
| 2997 | OUTREG(CRTC2_GEN_CNTL, | ||
| 2998 | (INREG(CRTC2_GEN_CNTL) & ~CRTC2_EN) | CRTC2_DISP_REQ_EN_B); | ||
| 2999 | OUTREG(CRTC_EXT_CNTL, INREG(CRTC_EXT_CNTL) | CRTC_DISPLAY_DIS); | ||
| 3000 | OUTREG(MC_FB_LOCATION, 0x7fff0000); | ||
| 3001 | OUTREG(MC_AGP_LOCATION, 0xffffe000); | ||
| 3002 | OUTREG(DISPLAY_BASE_ADDR, 0x00000000); | ||
| 3003 | if (rinfo->hasCRTC2) | ||
| 3004 | OUTREG(CRTC2_DISPLAY_BASE_ADDR, 0x00000000); | ||
| 3005 | OUTREG(SRC_OFFSET, 0x00000000); | ||
| 3006 | OUTREG(DST_OFFSET, 0x00000000); | ||
| 3007 | mdelay(10); | ||
| 3008 | OUTREG(CRTC_EXT_CNTL, INREG(CRTC_EXT_CNTL) & ~CRTC_DISPLAY_DIS); | ||
| 3009 | #endif /* CONFIG_ALL_PPC */ | ||
| 3010 | |||
| 3011 | /* save current mode regs before we switch into the new one | ||
| 3012 | * so we can restore this upon __exit | ||
| 3013 | */ | ||
| 3014 | radeon_save_state (rinfo, &rinfo->init_state); | ||
| 3015 | |||
| 3016 | /* set all the vital stuff */ | ||
| 3017 | radeon_set_fbinfo (rinfo); | ||
| 3018 | |||
| 3019 | pci_set_drvdata(pdev, rinfo); | ||
| 3020 | rinfo->next = board_list; | ||
| 3021 | board_list = rinfo; | ||
| 3022 | ((struct fb_info *) rinfo)->device = &pdev->dev; | ||
| 3023 | if (register_framebuffer ((struct fb_info *) rinfo) < 0) { | ||
| 3024 | printk ("radeonfb: could not register framebuffer\n"); | ||
| 3025 | iounmap(rinfo->fb_base); | ||
| 3026 | iounmap(rinfo->mmio_base); | ||
| 3027 | release_mem_region (rinfo->mmio_base_phys, | ||
| 3028 | pci_resource_len(pdev, 2)); | ||
| 3029 | release_mem_region (rinfo->fb_base_phys, | ||
| 3030 | pci_resource_len(pdev, 0)); | ||
| 3031 | kfree (rinfo); | ||
| 3032 | return -ENODEV; | ||
| 3033 | } | ||
| 3034 | |||
| 3035 | #ifdef CONFIG_MTRR | ||
| 3036 | rinfo->mtrr_hdl = nomtrr ? -1 : mtrr_add(rinfo->fb_base_phys, | ||
| 3037 | rinfo->video_ram, | ||
| 3038 | MTRR_TYPE_WRCOMB, 1); | ||
| 3039 | #endif | ||
| 3040 | |||
| 3041 | #ifdef CONFIG_PMAC_BACKLIGHT | ||
| 3042 | if (rinfo->dviDisp_type == MT_LCD) | ||
| 3043 | register_backlight_controller(&radeon_backlight_controller, | ||
| 3044 | rinfo, "ati"); | ||
| 3045 | #endif | ||
| 3046 | |||
| 3047 | #ifdef CONFIG_PMAC_PBOOK | ||
| 3048 | if (rinfo->dviDisp_type == MT_LCD) { | ||
| 3049 | rinfo->pm_reg = pci_find_capability(pdev, PCI_CAP_ID_PM); | ||
| 3050 | pmu_register_sleep_notifier(&radeon_sleep_notifier); | ||
| 3051 | } | ||
| 3052 | #endif | ||
| 3053 | |||
| 3054 | printk ("radeonfb: ATI Radeon %s %s %d MB\n", rinfo->name, rinfo->ram_type, | ||
| 3055 | (rinfo->video_ram/(1024*1024))); | ||
| 3056 | |||
| 3057 | if (rinfo->hasCRTC2) { | ||
| 3058 | printk("radeonfb: DVI port %s monitor connected\n", | ||
| 3059 | GET_MON_NAME(rinfo->dviDisp_type)); | ||
| 3060 | printk("radeonfb: CRT port %s monitor connected\n", | ||
| 3061 | GET_MON_NAME(rinfo->crtDisp_type)); | ||
| 3062 | } else { | ||
| 3063 | printk("radeonfb: CRT port %s monitor connected\n", | ||
| 3064 | GET_MON_NAME(rinfo->crtDisp_type)); | ||
| 3065 | } | ||
| 3066 | |||
| 3067 | RTRACE("radeonfb_pci_register END\n"); | ||
| 3068 | |||
| 3069 | return 0; | ||
| 3070 | } | ||
| 3071 | |||
| 3072 | |||
| 3073 | |||
| 3074 | static void __devexit radeonfb_pci_unregister (struct pci_dev *pdev) | ||
| 3075 | { | ||
| 3076 | struct radeonfb_info *rinfo = pci_get_drvdata(pdev); | ||
| 3077 | |||
| 3078 | if (!rinfo) | ||
| 3079 | return; | ||
| 3080 | |||
| 3081 | /* restore original state | ||
| 3082 | * | ||
| 3083 | * Doesn't quite work yet, possibly because of the PPC hacking | ||
| 3084 | * I do on startup, disable for now. --BenH | ||
| 3085 | */ | ||
| 3086 | radeon_write_mode (rinfo, &rinfo->init_state); | ||
| 3087 | |||
| 3088 | #ifdef CONFIG_MTRR | ||
| 3089 | if (rinfo->mtrr_hdl >= 0) | ||
| 3090 | mtrr_del(rinfo->mtrr_hdl, 0, 0); | ||
| 3091 | #endif | ||
| 3092 | |||
| 3093 | unregister_framebuffer ((struct fb_info *) rinfo); | ||
| 3094 | |||
| 3095 | iounmap(rinfo->mmio_base); | ||
| 3096 | iounmap(rinfo->fb_base); | ||
| 3097 | |||
| 3098 | release_mem_region (rinfo->mmio_base_phys, | ||
| 3099 | pci_resource_len(pdev, 2)); | ||
| 3100 | release_mem_region (rinfo->fb_base_phys, | ||
| 3101 | pci_resource_len(pdev, 0)); | ||
| 3102 | |||
| 3103 | kfree (rinfo); | ||
| 3104 | } | ||
| 3105 | |||
| 3106 | |||
| 3107 | static struct pci_driver radeonfb_driver = { | ||
| 3108 | .name = "radeonfb", | ||
| 3109 | .id_table = radeonfb_pci_table, | ||
| 3110 | .probe = radeonfb_pci_register, | ||
| 3111 | .remove = __devexit_p(radeonfb_pci_unregister), | ||
| 3112 | }; | ||
| 3113 | |||
| 3114 | #ifndef MODULE | ||
| 3115 | static int __init radeonfb_old_setup (char *options) | ||
| 3116 | { | ||
| 3117 | char *this_opt; | ||
| 3118 | |||
| 3119 | if (!options || !*options) | ||
| 3120 | return 0; | ||
| 3121 | |||
| 3122 | while ((this_opt = strsep (&options, ",")) != NULL) { | ||
| 3123 | if (!*this_opt) | ||
| 3124 | continue; | ||
| 3125 | if (!strncmp(this_opt, "noaccel", 7)) { | ||
| 3126 | noaccel = 1; | ||
| 3127 | } else if (!strncmp(this_opt, "mirror", 6)) { | ||
| 3128 | mirror = 1; | ||
| 3129 | } else if (!strncmp(this_opt, "dfp", 3)) { | ||
| 3130 | force_dfp = 1; | ||
| 3131 | } else if (!strncmp(this_opt, "panel_yres:", 11)) { | ||
| 3132 | panel_yres = simple_strtoul((this_opt+11), NULL, 0); | ||
| 3133 | } else if (!strncmp(this_opt, "nomtrr", 6)) { | ||
| 3134 | nomtrr = 1; | ||
| 3135 | } else | ||
| 3136 | mode_option = this_opt; | ||
| 3137 | } | ||
| 3138 | |||
| 3139 | return 0; | ||
| 3140 | } | ||
| 3141 | #endif /* MODULE */ | ||
| 3142 | |||
| 3143 | static int __init radeonfb_old_init (void) | ||
| 3144 | { | ||
| 3145 | #ifndef MODULE | ||
| 3146 | char *option = NULL; | ||
| 3147 | |||
| 3148 | if (fb_get_options("radeonfb_old", &option)) | ||
| 3149 | return -ENODEV; | ||
| 3150 | radeonfb_old_setup(option); | ||
| 3151 | #endif | ||
| 3152 | return pci_register_driver (&radeonfb_driver); | ||
| 3153 | } | ||
| 3154 | |||
| 3155 | |||
| 3156 | static void __exit radeonfb_old_exit (void) | ||
| 3157 | { | ||
| 3158 | pci_unregister_driver (&radeonfb_driver); | ||
| 3159 | } | ||
| 3160 | |||
| 3161 | module_init(radeonfb_old_init); | ||
| 3162 | module_exit(radeonfb_old_exit); | ||
| 3163 | |||
| 3164 | |||
| 3165 | MODULE_AUTHOR("Ani Joshi"); | ||
| 3166 | MODULE_DESCRIPTION("framebuffer driver for ATI Radeon chipset"); | ||
| 3167 | MODULE_LICENSE("GPL"); | ||
diff --git a/drivers/video/sticore.h b/drivers/video/sticore.h index dc93336af557..1a9a60c74be3 100644 --- a/drivers/video/sticore.h +++ b/drivers/video/sticore.h | |||
| @@ -34,36 +34,20 @@ | |||
| 34 | * for them to fix it and steal their solution. prumpf | 34 | * for them to fix it and steal their solution. prumpf |
| 35 | */ | 35 | */ |
| 36 | 36 | ||
| 37 | #define STI_WAIT 1 | 37 | #include <asm/io.h> |
| 38 | |||
| 39 | #include <asm/io.h> /* for USE_HPPA_IOREMAP */ | ||
| 40 | |||
| 41 | #if USE_HPPA_IOREMAP | ||
| 42 | 38 | ||
| 43 | #define STI_PTR(p) (p) | 39 | #define STI_WAIT 1 |
| 44 | #define PTR_STI(p) (p) | ||
| 45 | static inline int STI_CALL( unsigned long func, | ||
| 46 | void *flags, void *inptr, void *outptr, void *glob_cfg ) | ||
| 47 | { | ||
| 48 | int (*f)(void *,void *,void *,void *); | ||
| 49 | f = (void*)func; | ||
| 50 | return f(flags, inptr, outptr, glob_cfg); | ||
| 51 | } | ||
| 52 | |||
| 53 | #else /* !USE_HPPA_IOREMAP */ | ||
| 54 | 40 | ||
| 55 | #define STI_PTR(p) ( virt_to_phys(p) ) | 41 | #define STI_PTR(p) ( virt_to_phys(p) ) |
| 56 | #define PTR_STI(p) ( phys_to_virt((long)p) ) | 42 | #define PTR_STI(p) ( phys_to_virt((unsigned long)p) ) |
| 57 | #define STI_CALL(func, flags, inptr, outptr, glob_cfg) \ | 43 | #define STI_CALL(func, flags, inptr, outptr, glob_cfg) \ |
| 58 | ({ \ | 44 | ({ \ |
| 59 | pdc_sti_call( func, (unsigned long)STI_PTR(flags), \ | 45 | pdc_sti_call( func, STI_PTR(flags), \ |
| 60 | (unsigned long)STI_PTR(inptr), \ | 46 | STI_PTR(inptr), \ |
| 61 | (unsigned long)STI_PTR(outptr), \ | 47 | STI_PTR(outptr), \ |
| 62 | (unsigned long)STI_PTR(glob_cfg)); \ | 48 | STI_PTR(glob_cfg)); \ |
| 63 | }) | 49 | }) |
| 64 | 50 | ||
| 65 | #endif /* USE_HPPA_IOREMAP */ | ||
| 66 | |||
| 67 | 51 | ||
| 68 | #define sti_onscreen_x(sti) (sti->glob_cfg->onscreen_x) | 52 | #define sti_onscreen_x(sti) (sti->glob_cfg->onscreen_x) |
| 69 | #define sti_onscreen_y(sti) (sti->glob_cfg->onscreen_y) | 53 | #define sti_onscreen_y(sti) (sti->glob_cfg->onscreen_y) |
| @@ -352,8 +336,9 @@ struct sti_struct { | |||
| 352 | struct sti_conf_outptr outptr; /* configuration */ | 336 | struct sti_conf_outptr outptr; /* configuration */ |
| 353 | struct sti_conf_outptr_ext outptr_ext; | 337 | struct sti_conf_outptr_ext outptr_ext; |
| 354 | 338 | ||
| 355 | /* PCI data structures (pg. 17ff from sti.pdf) */ | ||
| 356 | struct pci_dev *pd; | 339 | struct pci_dev *pd; |
| 340 | |||
| 341 | /* PCI data structures (pg. 17ff from sti.pdf) */ | ||
| 357 | u8 rm_entry[16]; /* pci region mapper array == pci config space offset */ | 342 | u8 rm_entry[16]; /* pci region mapper array == pci config space offset */ |
| 358 | 343 | ||
| 359 | /* pointer to the fb_info where this STI device is used */ | 344 | /* pointer to the fb_info where this STI device is used */ |
diff --git a/drivers/video/stifb.c b/drivers/video/stifb.c index 56d71d6e9a72..4a292aae6eb2 100644 --- a/drivers/video/stifb.c +++ b/drivers/video/stifb.c | |||
| @@ -3,7 +3,7 @@ | |||
| 3 | * Low level Frame buffer driver for HP workstations with | 3 | * Low level Frame buffer driver for HP workstations with |
| 4 | * STI (standard text interface) video firmware. | 4 | * STI (standard text interface) video firmware. |
| 5 | * | 5 | * |
| 6 | * Copyright (C) 2001-2005 Helge Deller <deller@gmx.de> | 6 | * Copyright (C) 2001-2006 Helge Deller <deller@gmx.de> |
| 7 | * Portions Copyright (C) 2001 Thomas Bogendoerfer <tsbogend@alpha.franken.de> | 7 | * Portions Copyright (C) 2001 Thomas Bogendoerfer <tsbogend@alpha.franken.de> |
| 8 | * | 8 | * |
| 9 | * Based on: | 9 | * Based on: |
| @@ -514,7 +514,7 @@ rattlerSetupPlanes(struct stifb_info *fb) | |||
| 514 | SETUP_HW(fb); | 514 | SETUP_HW(fb); |
| 515 | WRITE_BYTE(1, fb, REG_16b1); | 515 | WRITE_BYTE(1, fb, REG_16b1); |
| 516 | 516 | ||
| 517 | fb_memset(fb->info.fix.smem_start, 0xff, | 517 | fb_memset((void*)fb->info.fix.smem_start, 0xff, |
| 518 | fb->info.var.yres*fb->info.fix.line_length); | 518 | fb->info.var.yres*fb->info.fix.line_length); |
| 519 | 519 | ||
| 520 | CRX24_SET_OVLY_MASK(fb); | 520 | CRX24_SET_OVLY_MASK(fb); |
| @@ -908,83 +908,6 @@ SETUP_HCRX(struct stifb_info *fb) | |||
| 908 | 908 | ||
| 909 | /* ------------------- driver specific functions --------------------------- */ | 909 | /* ------------------- driver specific functions --------------------------- */ |
| 910 | 910 | ||
| 911 | #define TMPBUFLEN 2048 | ||
| 912 | |||
| 913 | static ssize_t | ||
| 914 | stifb_read(struct file *file, char *buf, size_t count, loff_t *ppos) | ||
| 915 | { | ||
| 916 | unsigned long p = *ppos; | ||
| 917 | struct inode *inode = file->f_dentry->d_inode; | ||
| 918 | int fbidx = iminor(inode); | ||
| 919 | struct fb_info *info = registered_fb[fbidx]; | ||
| 920 | char tmpbuf[TMPBUFLEN]; | ||
| 921 | |||
| 922 | if (!info || ! info->screen_base) | ||
| 923 | return -ENODEV; | ||
| 924 | |||
| 925 | if (p >= info->fix.smem_len) | ||
| 926 | return 0; | ||
| 927 | if (count >= info->fix.smem_len) | ||
| 928 | count = info->fix.smem_len; | ||
| 929 | if (count + p > info->fix.smem_len) | ||
| 930 | count = info->fix.smem_len - p; | ||
| 931 | if (count > sizeof(tmpbuf)) | ||
| 932 | count = sizeof(tmpbuf); | ||
| 933 | if (count) { | ||
| 934 | char *base_addr; | ||
| 935 | |||
| 936 | base_addr = info->screen_base; | ||
| 937 | memcpy_fromio(&tmpbuf, base_addr+p, count); | ||
| 938 | count -= copy_to_user(buf, &tmpbuf, count); | ||
| 939 | if (!count) | ||
| 940 | return -EFAULT; | ||
| 941 | *ppos += count; | ||
| 942 | } | ||
| 943 | return count; | ||
| 944 | } | ||
| 945 | |||
| 946 | static ssize_t | ||
| 947 | stifb_write(struct file *file, const char *buf, size_t count, loff_t *ppos) | ||
| 948 | { | ||
| 949 | struct inode *inode = file->f_dentry->d_inode; | ||
| 950 | int fbidx = iminor(inode); | ||
| 951 | struct fb_info *info = registered_fb[fbidx]; | ||
| 952 | unsigned long p = *ppos; | ||
| 953 | size_t c; | ||
| 954 | int err; | ||
| 955 | char tmpbuf[TMPBUFLEN]; | ||
| 956 | |||
| 957 | if (!info || !info->screen_base) | ||
| 958 | return -ENODEV; | ||
| 959 | |||
| 960 | if (p > info->fix.smem_len) | ||
| 961 | return -ENOSPC; | ||
| 962 | if (count >= info->fix.smem_len) | ||
| 963 | count = info->fix.smem_len; | ||
| 964 | err = 0; | ||
| 965 | if (count + p > info->fix.smem_len) { | ||
| 966 | count = info->fix.smem_len - p; | ||
| 967 | err = -ENOSPC; | ||
| 968 | } | ||
| 969 | |||
| 970 | p += (unsigned long)info->screen_base; | ||
| 971 | c = count; | ||
| 972 | while (c) { | ||
| 973 | int len = c > sizeof(tmpbuf) ? sizeof(tmpbuf) : c; | ||
| 974 | err = -EFAULT; | ||
| 975 | if (copy_from_user(&tmpbuf, buf, len)) | ||
| 976 | break; | ||
| 977 | memcpy_toio(p, &tmpbuf, len); | ||
| 978 | c -= len; | ||
| 979 | p += len; | ||
| 980 | buf += len; | ||
| 981 | *ppos += len; | ||
| 982 | } | ||
| 983 | if (count-c) | ||
| 984 | return (count-c); | ||
| 985 | return err; | ||
| 986 | } | ||
| 987 | |||
| 988 | static int | 911 | static int |
| 989 | stifb_setcolreg(u_int regno, u_int red, u_int green, | 912 | stifb_setcolreg(u_int regno, u_int red, u_int green, |
| 990 | u_int blue, u_int transp, struct fb_info *info) | 913 | u_int blue, u_int transp, struct fb_info *info) |
| @@ -1137,8 +1060,6 @@ stifb_init_display(struct stifb_info *fb) | |||
| 1137 | 1060 | ||
| 1138 | static struct fb_ops stifb_ops = { | 1061 | static struct fb_ops stifb_ops = { |
| 1139 | .owner = THIS_MODULE, | 1062 | .owner = THIS_MODULE, |
| 1140 | .fb_read = stifb_read, | ||
| 1141 | .fb_write = stifb_write, | ||
| 1142 | .fb_setcolreg = stifb_setcolreg, | 1063 | .fb_setcolreg = stifb_setcolreg, |
| 1143 | .fb_blank = stifb_blank, | 1064 | .fb_blank = stifb_blank, |
| 1144 | .fb_fillrect = cfb_fillrect, | 1065 | .fb_fillrect = cfb_fillrect, |
| @@ -1162,7 +1083,7 @@ stifb_init_fb(struct sti_struct *sti, int bpp_pref) | |||
| 1162 | char *dev_name; | 1083 | char *dev_name; |
| 1163 | int bpp, xres, yres; | 1084 | int bpp, xres, yres; |
| 1164 | 1085 | ||
| 1165 | fb = kmalloc(sizeof(*fb), GFP_ATOMIC); | 1086 | fb = kzalloc(sizeof(*fb), GFP_ATOMIC); |
| 1166 | if (!fb) { | 1087 | if (!fb) { |
| 1167 | printk(KERN_ERR "stifb: Could not allocate stifb structure\n"); | 1088 | printk(KERN_ERR "stifb: Could not allocate stifb structure\n"); |
| 1168 | return -ENODEV; | 1089 | return -ENODEV; |
| @@ -1171,7 +1092,6 @@ stifb_init_fb(struct sti_struct *sti, int bpp_pref) | |||
| 1171 | info = &fb->info; | 1092 | info = &fb->info; |
| 1172 | 1093 | ||
| 1173 | /* set struct to a known state */ | 1094 | /* set struct to a known state */ |
| 1174 | memset(fb, 0, sizeof(*fb)); | ||
| 1175 | fix = &info->fix; | 1095 | fix = &info->fix; |
| 1176 | var = &info->var; | 1096 | var = &info->var; |
| 1177 | 1097 | ||
| @@ -1234,7 +1154,7 @@ stifb_init_fb(struct sti_struct *sti, int bpp_pref) | |||
| 1234 | case S9000_ID_TOMCAT: /* Dual CRX, behaves else like a CRX */ | 1154 | case S9000_ID_TOMCAT: /* Dual CRX, behaves else like a CRX */ |
| 1235 | /* FIXME: TomCat supports two heads: | 1155 | /* FIXME: TomCat supports two heads: |
| 1236 | * fb.iobase = REGION_BASE(fb_info,3); | 1156 | * fb.iobase = REGION_BASE(fb_info,3); |
| 1237 | * fb.screen_base = (void*) REGION_BASE(fb_info,2); | 1157 | * fb.screen_base = ioremap_nocache(REGION_BASE(fb_info,2),xxx); |
| 1238 | * for now we only support the left one ! */ | 1158 | * for now we only support the left one ! */ |
| 1239 | xres = fb->ngle_rom.x_size_visible; | 1159 | xres = fb->ngle_rom.x_size_visible; |
| 1240 | yres = fb->ngle_rom.y_size_visible; | 1160 | yres = fb->ngle_rom.y_size_visible; |
| @@ -1327,7 +1247,8 @@ stifb_init_fb(struct sti_struct *sti, int bpp_pref) | |||
| 1327 | 1247 | ||
| 1328 | strcpy(fix->id, "stifb"); | 1248 | strcpy(fix->id, "stifb"); |
| 1329 | info->fbops = &stifb_ops; | 1249 | info->fbops = &stifb_ops; |
| 1330 | info->screen_base = (void*) REGION_BASE(fb,1); | 1250 | info->screen_base = ioremap_nocache(REGION_BASE(fb,1), fix->smem_len); |
| 1251 | info->screen_size = fix->smem_len; | ||
| 1331 | info->flags = FBINFO_DEFAULT; | 1252 | info->flags = FBINFO_DEFAULT; |
| 1332 | info->pseudo_palette = &fb->pseudo_palette; | 1253 | info->pseudo_palette = &fb->pseudo_palette; |
| 1333 | 1254 | ||
| @@ -1457,7 +1378,7 @@ stifb_setup(char *options) | |||
| 1457 | int i; | 1378 | int i; |
| 1458 | 1379 | ||
| 1459 | if (!options || !*options) | 1380 | if (!options || !*options) |
| 1460 | return 0; | 1381 | return 1; |
| 1461 | 1382 | ||
| 1462 | if (strncmp(options, "off", 3) == 0) { | 1383 | if (strncmp(options, "off", 3) == 0) { |
| 1463 | stifb_disabled = 1; | 1384 | stifb_disabled = 1; |
| @@ -1472,7 +1393,7 @@ stifb_setup(char *options) | |||
| 1472 | stifb_bpp_pref[i] = simple_strtoul(options, &options, 10); | 1393 | stifb_bpp_pref[i] = simple_strtoul(options, &options, 10); |
| 1473 | } | 1394 | } |
| 1474 | } | 1395 | } |
| 1475 | return 0; | 1396 | return 1; |
| 1476 | } | 1397 | } |
| 1477 | 1398 | ||
| 1478 | __setup("stifb=", stifb_setup); | 1399 | __setup("stifb=", stifb_setup); |
diff --git a/drivers/video/w100fb.c b/drivers/video/w100fb.c index f6e24ee85f07..5fc86ea20692 100644 --- a/drivers/video/w100fb.c +++ b/drivers/video/w100fb.c | |||
| @@ -4,8 +4,9 @@ | |||
| 4 | * Frame Buffer Device for ATI Imageon w100 (Wallaby) | 4 | * Frame Buffer Device for ATI Imageon w100 (Wallaby) |
| 5 | * | 5 | * |
| 6 | * Copyright (C) 2002, ATI Corp. | 6 | * Copyright (C) 2002, ATI Corp. |
| 7 | * Copyright (C) 2004-2005 Richard Purdie | 7 | * Copyright (C) 2004-2006 Richard Purdie |
| 8 | * Copyright (c) 2005 Ian Molton | 8 | * Copyright (c) 2005 Ian Molton |
| 9 | * Copyright (c) 2006 Alberto Mardegan | ||
| 9 | * | 10 | * |
| 10 | * Rewritten for 2.6 by Richard Purdie <rpurdie@rpsys.net> | 11 | * Rewritten for 2.6 by Richard Purdie <rpurdie@rpsys.net> |
| 11 | * | 12 | * |
| @@ -14,6 +15,9 @@ | |||
| 14 | * | 15 | * |
| 15 | * w32xx support by Ian Molton | 16 | * w32xx support by Ian Molton |
| 16 | * | 17 | * |
| 18 | * Hardware acceleration support by Alberto Mardegan | ||
| 19 | * <mardy@users.sourceforge.net> | ||
| 20 | * | ||
| 17 | * This program is free software; you can redistribute it and/or modify | 21 | * This program is free software; you can redistribute it and/or modify |
| 18 | * it under the terms of the GNU General Public License version 2 as | 22 | * it under the terms of the GNU General Public License version 2 as |
| 19 | * published by the Free Software Foundation. | 23 | * published by the Free Software Foundation. |
| @@ -47,6 +51,7 @@ static void w100_set_dispregs(struct w100fb_par*); | |||
| 47 | static void w100_update_enable(void); | 51 | static void w100_update_enable(void); |
| 48 | static void w100_update_disable(void); | 52 | static void w100_update_disable(void); |
| 49 | static void calc_hsync(struct w100fb_par *par); | 53 | static void calc_hsync(struct w100fb_par *par); |
| 54 | static void w100_init_graphic_engine(struct w100fb_par *par); | ||
| 50 | struct w100_pll_info *w100_get_xtal_table(unsigned int freq); | 55 | struct w100_pll_info *w100_get_xtal_table(unsigned int freq); |
| 51 | 56 | ||
| 52 | /* Pseudo palette size */ | 57 | /* Pseudo palette size */ |
| @@ -248,6 +253,152 @@ static int w100fb_blank(int blank_mode, struct fb_info *info) | |||
| 248 | } | 253 | } |
| 249 | 254 | ||
| 250 | 255 | ||
| 256 | static void w100_fifo_wait(int entries) | ||
| 257 | { | ||
| 258 | union rbbm_status_u status; | ||
| 259 | int i; | ||
| 260 | |||
| 261 | for (i = 0; i < 2000000; i++) { | ||
| 262 | status.val = readl(remapped_regs + mmRBBM_STATUS); | ||
| 263 | if (status.f.cmdfifo_avail >= entries) | ||
| 264 | return; | ||
| 265 | udelay(1); | ||
| 266 | } | ||
| 267 | printk(KERN_ERR "w100fb: FIFO Timeout!\n"); | ||
| 268 | } | ||
| 269 | |||
| 270 | |||
| 271 | static int w100fb_sync(struct fb_info *info) | ||
| 272 | { | ||
| 273 | union rbbm_status_u status; | ||
| 274 | int i; | ||
| 275 | |||
| 276 | for (i = 0; i < 2000000; i++) { | ||
| 277 | status.val = readl(remapped_regs + mmRBBM_STATUS); | ||
| 278 | if (!status.f.gui_active) | ||
| 279 | return 0; | ||
| 280 | udelay(1); | ||
| 281 | } | ||
| 282 | printk(KERN_ERR "w100fb: Graphic engine timeout!\n"); | ||
| 283 | return -EBUSY; | ||
| 284 | } | ||
| 285 | |||
| 286 | |||
| 287 | static void w100_init_graphic_engine(struct w100fb_par *par) | ||
| 288 | { | ||
| 289 | union dp_gui_master_cntl_u gmc; | ||
| 290 | union dp_mix_u dp_mix; | ||
| 291 | union dp_datatype_u dp_datatype; | ||
| 292 | union dp_cntl_u dp_cntl; | ||
| 293 | |||
| 294 | w100_fifo_wait(4); | ||
| 295 | writel(W100_FB_BASE, remapped_regs + mmDST_OFFSET); | ||
| 296 | writel(par->xres, remapped_regs + mmDST_PITCH); | ||
| 297 | writel(W100_FB_BASE, remapped_regs + mmSRC_OFFSET); | ||
| 298 | writel(par->xres, remapped_regs + mmSRC_PITCH); | ||
| 299 | |||
| 300 | w100_fifo_wait(3); | ||
| 301 | writel(0, remapped_regs + mmSC_TOP_LEFT); | ||
| 302 | writel((par->yres << 16) | par->xres, remapped_regs + mmSC_BOTTOM_RIGHT); | ||
| 303 | writel(0x1fff1fff, remapped_regs + mmSRC_SC_BOTTOM_RIGHT); | ||
| 304 | |||
| 305 | w100_fifo_wait(4); | ||
| 306 | dp_cntl.val = 0; | ||
| 307 | dp_cntl.f.dst_x_dir = 1; | ||
| 308 | dp_cntl.f.dst_y_dir = 1; | ||
| 309 | dp_cntl.f.src_x_dir = 1; | ||
| 310 | dp_cntl.f.src_y_dir = 1; | ||
| 311 | dp_cntl.f.dst_major_x = 1; | ||
| 312 | dp_cntl.f.src_major_x = 1; | ||
| 313 | writel(dp_cntl.val, remapped_regs + mmDP_CNTL); | ||
| 314 | |||
| 315 | gmc.val = 0; | ||
| 316 | gmc.f.gmc_src_pitch_offset_cntl = 1; | ||
| 317 | gmc.f.gmc_dst_pitch_offset_cntl = 1; | ||
| 318 | gmc.f.gmc_src_clipping = 1; | ||
| 319 | gmc.f.gmc_dst_clipping = 1; | ||
| 320 | gmc.f.gmc_brush_datatype = GMC_BRUSH_NONE; | ||
| 321 | gmc.f.gmc_dst_datatype = 3; /* from DstType_16Bpp_444 */ | ||
| 322 | gmc.f.gmc_src_datatype = SRC_DATATYPE_EQU_DST; | ||
| 323 | gmc.f.gmc_byte_pix_order = 1; | ||
| 324 | gmc.f.gmc_default_sel = 0; | ||
| 325 | gmc.f.gmc_rop3 = ROP3_SRCCOPY; | ||
| 326 | gmc.f.gmc_dp_src_source = DP_SRC_MEM_RECTANGULAR; | ||
| 327 | gmc.f.gmc_clr_cmp_fcn_dis = 1; | ||
| 328 | gmc.f.gmc_wr_msk_dis = 1; | ||
| 329 | gmc.f.gmc_dp_op = DP_OP_ROP; | ||
| 330 | writel(gmc.val, remapped_regs + mmDP_GUI_MASTER_CNTL); | ||
| 331 | |||
| 332 | dp_datatype.val = dp_mix.val = 0; | ||
| 333 | dp_datatype.f.dp_dst_datatype = gmc.f.gmc_dst_datatype; | ||
| 334 | dp_datatype.f.dp_brush_datatype = gmc.f.gmc_brush_datatype; | ||
| 335 | dp_datatype.f.dp_src2_type = 0; | ||
| 336 | dp_datatype.f.dp_src2_datatype = gmc.f.gmc_src_datatype; | ||
| 337 | dp_datatype.f.dp_src_datatype = gmc.f.gmc_src_datatype; | ||
| 338 | dp_datatype.f.dp_byte_pix_order = gmc.f.gmc_byte_pix_order; | ||
| 339 | writel(dp_datatype.val, remapped_regs + mmDP_DATATYPE); | ||
| 340 | |||
| 341 | dp_mix.f.dp_src_source = gmc.f.gmc_dp_src_source; | ||
| 342 | dp_mix.f.dp_src2_source = 1; | ||
| 343 | dp_mix.f.dp_rop3 = gmc.f.gmc_rop3; | ||
| 344 | dp_mix.f.dp_op = gmc.f.gmc_dp_op; | ||
| 345 | writel(dp_mix.val, remapped_regs + mmDP_MIX); | ||
| 346 | } | ||
| 347 | |||
| 348 | |||
| 349 | static void w100fb_fillrect(struct fb_info *info, | ||
| 350 | const struct fb_fillrect *rect) | ||
| 351 | { | ||
| 352 | union dp_gui_master_cntl_u gmc; | ||
| 353 | |||
| 354 | if (info->state != FBINFO_STATE_RUNNING) | ||
| 355 | return; | ||
| 356 | if (info->flags & FBINFO_HWACCEL_DISABLED) { | ||
| 357 | cfb_fillrect(info, rect); | ||
| 358 | return; | ||
| 359 | } | ||
| 360 | |||
| 361 | gmc.val = readl(remapped_regs + mmDP_GUI_MASTER_CNTL); | ||
| 362 | gmc.f.gmc_rop3 = ROP3_PATCOPY; | ||
| 363 | gmc.f.gmc_brush_datatype = GMC_BRUSH_SOLID_COLOR; | ||
| 364 | w100_fifo_wait(2); | ||
| 365 | writel(gmc.val, remapped_regs + mmDP_GUI_MASTER_CNTL); | ||
| 366 | writel(rect->color, remapped_regs + mmDP_BRUSH_FRGD_CLR); | ||
| 367 | |||
| 368 | w100_fifo_wait(2); | ||
| 369 | writel((rect->dy << 16) | (rect->dx & 0xffff), remapped_regs + mmDST_Y_X); | ||
| 370 | writel((rect->width << 16) | (rect->height & 0xffff), | ||
| 371 | remapped_regs + mmDST_WIDTH_HEIGHT); | ||
| 372 | } | ||
| 373 | |||
| 374 | |||
| 375 | static void w100fb_copyarea(struct fb_info *info, | ||
| 376 | const struct fb_copyarea *area) | ||
| 377 | { | ||
| 378 | u32 dx = area->dx, dy = area->dy, sx = area->sx, sy = area->sy; | ||
| 379 | u32 h = area->height, w = area->width; | ||
| 380 | union dp_gui_master_cntl_u gmc; | ||
| 381 | |||
| 382 | if (info->state != FBINFO_STATE_RUNNING) | ||
| 383 | return; | ||
| 384 | if (info->flags & FBINFO_HWACCEL_DISABLED) { | ||
| 385 | cfb_copyarea(info, area); | ||
| 386 | return; | ||
| 387 | } | ||
| 388 | |||
| 389 | gmc.val = readl(remapped_regs + mmDP_GUI_MASTER_CNTL); | ||
| 390 | gmc.f.gmc_rop3 = ROP3_SRCCOPY; | ||
| 391 | gmc.f.gmc_brush_datatype = GMC_BRUSH_NONE; | ||
| 392 | w100_fifo_wait(1); | ||
| 393 | writel(gmc.val, remapped_regs + mmDP_GUI_MASTER_CNTL); | ||
| 394 | |||
| 395 | w100_fifo_wait(3); | ||
| 396 | writel((sy << 16) | (sx & 0xffff), remapped_regs + mmSRC_Y_X); | ||
| 397 | writel((dy << 16) | (dx & 0xffff), remapped_regs + mmDST_Y_X); | ||
| 398 | writel((w << 16) | (h & 0xffff), remapped_regs + mmDST_WIDTH_HEIGHT); | ||
| 399 | } | ||
| 400 | |||
| 401 | |||
| 251 | /* | 402 | /* |
| 252 | * Change the resolution by calling the appropriate hardware functions | 403 | * Change the resolution by calling the appropriate hardware functions |
| 253 | */ | 404 | */ |
| @@ -265,6 +416,7 @@ static void w100fb_activate_var(struct w100fb_par *par) | |||
| 265 | w100_init_lcd(par); | 416 | w100_init_lcd(par); |
| 266 | w100_set_dispregs(par); | 417 | w100_set_dispregs(par); |
| 267 | w100_update_enable(); | 418 | w100_update_enable(); |
| 419 | w100_init_graphic_engine(par); | ||
| 268 | 420 | ||
| 269 | calc_hsync(par); | 421 | calc_hsync(par); |
| 270 | 422 | ||
| @@ -394,9 +546,10 @@ static struct fb_ops w100fb_ops = { | |||
| 394 | .fb_set_par = w100fb_set_par, | 546 | .fb_set_par = w100fb_set_par, |
| 395 | .fb_setcolreg = w100fb_setcolreg, | 547 | .fb_setcolreg = w100fb_setcolreg, |
| 396 | .fb_blank = w100fb_blank, | 548 | .fb_blank = w100fb_blank, |
| 397 | .fb_fillrect = cfb_fillrect, | 549 | .fb_fillrect = w100fb_fillrect, |
| 398 | .fb_copyarea = cfb_copyarea, | 550 | .fb_copyarea = w100fb_copyarea, |
| 399 | .fb_imageblit = cfb_imageblit, | 551 | .fb_imageblit = cfb_imageblit, |
| 552 | .fb_sync = w100fb_sync, | ||
| 400 | }; | 553 | }; |
| 401 | 554 | ||
| 402 | #ifdef CONFIG_PM | 555 | #ifdef CONFIG_PM |
| @@ -543,7 +696,8 @@ int __init w100fb_probe(struct platform_device *pdev) | |||
| 543 | } | 696 | } |
| 544 | 697 | ||
| 545 | info->fbops = &w100fb_ops; | 698 | info->fbops = &w100fb_ops; |
| 546 | info->flags = FBINFO_DEFAULT; | 699 | info->flags = FBINFO_DEFAULT | FBINFO_HWACCEL_COPYAREA | |
| 700 | FBINFO_HWACCEL_FILLRECT; | ||
| 547 | info->node = -1; | 701 | info->node = -1; |
| 548 | info->screen_base = remapped_fbuf + (W100_FB_BASE-MEM_WINDOW_BASE); | 702 | info->screen_base = remapped_fbuf + (W100_FB_BASE-MEM_WINDOW_BASE); |
| 549 | info->screen_size = REMAPPED_FB_LEN; | 703 | info->screen_size = REMAPPED_FB_LEN; |
diff --git a/drivers/video/w100fb.h b/drivers/video/w100fb.h index 7a58a1e3e427..fffae7b4f6e9 100644 --- a/drivers/video/w100fb.h +++ b/drivers/video/w100fb.h | |||
| @@ -122,15 +122,32 @@ | |||
| 122 | /* Block DISPLAY End: */ | 122 | /* Block DISPLAY End: */ |
| 123 | 123 | ||
| 124 | /* Block GFX Start: */ | 124 | /* Block GFX Start: */ |
| 125 | #define mmDST_OFFSET 0x1004 | ||
| 126 | #define mmDST_PITCH 0x1008 | ||
| 127 | #define mmDST_Y_X 0x1038 | ||
| 128 | #define mmDST_WIDTH_HEIGHT 0x1198 | ||
| 129 | #define mmDP_GUI_MASTER_CNTL 0x106C | ||
| 125 | #define mmBRUSH_OFFSET 0x108C | 130 | #define mmBRUSH_OFFSET 0x108C |
| 126 | #define mmBRUSH_Y_X 0x1074 | 131 | #define mmBRUSH_Y_X 0x1074 |
| 132 | #define mmDP_BRUSH_FRGD_CLR 0x107C | ||
| 133 | #define mmSRC_OFFSET 0x11AC | ||
| 134 | #define mmSRC_PITCH 0x11B0 | ||
| 135 | #define mmSRC_Y_X 0x1034 | ||
| 127 | #define mmDEFAULT_PITCH_OFFSET 0x10A0 | 136 | #define mmDEFAULT_PITCH_OFFSET 0x10A0 |
| 128 | #define mmDEFAULT_SC_BOTTOM_RIGHT 0x10A8 | 137 | #define mmDEFAULT_SC_BOTTOM_RIGHT 0x10A8 |
| 129 | #define mmDEFAULT2_SC_BOTTOM_RIGHT 0x10AC | 138 | #define mmDEFAULT2_SC_BOTTOM_RIGHT 0x10AC |
| 139 | #define mmSC_TOP_LEFT 0x11BC | ||
| 140 | #define mmSC_BOTTOM_RIGHT 0x11C0 | ||
| 141 | #define mmSRC_SC_BOTTOM_RIGHT 0x11C4 | ||
| 130 | #define mmGLOBAL_ALPHA 0x1210 | 142 | #define mmGLOBAL_ALPHA 0x1210 |
| 131 | #define mmFILTER_COEF 0x1214 | 143 | #define mmFILTER_COEF 0x1214 |
| 132 | #define mmMVC_CNTL_START 0x11E0 | 144 | #define mmMVC_CNTL_START 0x11E0 |
| 133 | #define mmE2_ARITHMETIC_CNTL 0x1220 | 145 | #define mmE2_ARITHMETIC_CNTL 0x1220 |
| 146 | #define mmDP_CNTL 0x11C8 | ||
| 147 | #define mmDP_CNTL_DST_DIR 0x11CC | ||
| 148 | #define mmDP_DATATYPE 0x12C4 | ||
| 149 | #define mmDP_MIX 0x12C8 | ||
| 150 | #define mmDP_WRITE_MSK 0x12CC | ||
| 134 | #define mmENG_CNTL 0x13E8 | 151 | #define mmENG_CNTL 0x13E8 |
| 135 | #define mmENG_PERF_CNT 0x13F0 | 152 | #define mmENG_PERF_CNT 0x13F0 |
| 136 | /* Block GFX End: */ | 153 | /* Block GFX End: */ |
| @@ -179,6 +196,7 @@ | |||
| 179 | /* Block RBBM Start: */ | 196 | /* Block RBBM Start: */ |
| 180 | #define mmWAIT_UNTIL 0x1400 | 197 | #define mmWAIT_UNTIL 0x1400 |
| 181 | #define mmISYNC_CNTL 0x1404 | 198 | #define mmISYNC_CNTL 0x1404 |
| 199 | #define mmRBBM_STATUS 0x0140 | ||
| 182 | #define mmRBBM_CNTL 0x0144 | 200 | #define mmRBBM_CNTL 0x0144 |
| 183 | #define mmNQWAIT_UNTIL 0x0150 | 201 | #define mmNQWAIT_UNTIL 0x0150 |
| 184 | /* Block RBBM End: */ | 202 | /* Block RBBM End: */ |
| @@ -225,147 +243,147 @@ | |||
| 225 | /* Register structure definitions */ | 243 | /* Register structure definitions */ |
| 226 | 244 | ||
| 227 | struct wrap_top_dir_t { | 245 | struct wrap_top_dir_t { |
| 228 | unsigned long top_addr : 23; | 246 | u32 top_addr : 23; |
| 229 | unsigned long : 9; | 247 | u32 : 9; |
| 230 | } __attribute__((packed)); | 248 | } __attribute__((packed)); |
| 231 | 249 | ||
| 232 | union wrap_top_dir_u { | 250 | union wrap_top_dir_u { |
| 233 | unsigned long val : 32; | 251 | u32 val : 32; |
| 234 | struct wrap_top_dir_t f; | 252 | struct wrap_top_dir_t f; |
| 235 | } __attribute__((packed)); | 253 | } __attribute__((packed)); |
| 236 | 254 | ||
| 237 | struct wrap_start_dir_t { | 255 | struct wrap_start_dir_t { |
| 238 | unsigned long start_addr : 23; | 256 | u32 start_addr : 23; |
| 239 | unsigned long : 9; | 257 | u32 : 9; |
| 240 | } __attribute__((packed)); | 258 | } __attribute__((packed)); |
| 241 | 259 | ||
| 242 | union wrap_start_dir_u { | 260 | union wrap_start_dir_u { |
| 243 | unsigned long val : 32; | 261 | u32 val : 32; |
| 244 | struct wrap_start_dir_t f; | 262 | struct wrap_start_dir_t f; |
| 245 | } __attribute__((packed)); | 263 | } __attribute__((packed)); |
| 246 | 264 | ||
| 247 | struct cif_cntl_t { | 265 | struct cif_cntl_t { |
| 248 | unsigned long swap_reg : 2; | 266 | u32 swap_reg : 2; |
| 249 | unsigned long swap_fbuf_1 : 2; | 267 | u32 swap_fbuf_1 : 2; |
| 250 | unsigned long swap_fbuf_2 : 2; | 268 | u32 swap_fbuf_2 : 2; |
| 251 | unsigned long swap_fbuf_3 : 2; | 269 | u32 swap_fbuf_3 : 2; |
| 252 | unsigned long pmi_int_disable : 1; | 270 | u32 pmi_int_disable : 1; |
| 253 | unsigned long pmi_schmen_disable : 1; | 271 | u32 pmi_schmen_disable : 1; |
| 254 | unsigned long intb_oe : 1; | 272 | u32 intb_oe : 1; |
| 255 | unsigned long en_wait_to_compensate_dq_prop_dly : 1; | 273 | u32 en_wait_to_compensate_dq_prop_dly : 1; |
| 256 | unsigned long compensate_wait_rd_size : 2; | 274 | u32 compensate_wait_rd_size : 2; |
| 257 | unsigned long wait_asserted_timeout_val : 2; | 275 | u32 wait_asserted_timeout_val : 2; |
| 258 | unsigned long wait_masked_val : 2; | 276 | u32 wait_masked_val : 2; |
| 259 | unsigned long en_wait_timeout : 1; | 277 | u32 en_wait_timeout : 1; |
| 260 | unsigned long en_one_clk_setup_before_wait : 1; | 278 | u32 en_one_clk_setup_before_wait : 1; |
| 261 | unsigned long interrupt_active_high : 1; | 279 | u32 interrupt_active_high : 1; |
| 262 | unsigned long en_overwrite_straps : 1; | 280 | u32 en_overwrite_straps : 1; |
| 263 | unsigned long strap_wait_active_hi : 1; | 281 | u32 strap_wait_active_hi : 1; |
| 264 | unsigned long lat_busy_count : 2; | 282 | u32 lat_busy_count : 2; |
| 265 | unsigned long lat_rd_pm4_sclk_busy : 1; | 283 | u32 lat_rd_pm4_sclk_busy : 1; |
| 266 | unsigned long dis_system_bits : 1; | 284 | u32 dis_system_bits : 1; |
| 267 | unsigned long dis_mr : 1; | 285 | u32 dis_mr : 1; |
| 268 | unsigned long cif_spare_1 : 4; | 286 | u32 cif_spare_1 : 4; |
| 269 | } __attribute__((packed)); | 287 | } __attribute__((packed)); |
| 270 | 288 | ||
| 271 | union cif_cntl_u { | 289 | union cif_cntl_u { |
| 272 | unsigned long val : 32; | 290 | u32 val : 32; |
| 273 | struct cif_cntl_t f; | 291 | struct cif_cntl_t f; |
| 274 | } __attribute__((packed)); | 292 | } __attribute__((packed)); |
| 275 | 293 | ||
| 276 | struct cfgreg_base_t { | 294 | struct cfgreg_base_t { |
| 277 | unsigned long cfgreg_base : 24; | 295 | u32 cfgreg_base : 24; |
| 278 | unsigned long : 8; | 296 | u32 : 8; |
| 279 | } __attribute__((packed)); | 297 | } __attribute__((packed)); |
| 280 | 298 | ||
| 281 | union cfgreg_base_u { | 299 | union cfgreg_base_u { |
| 282 | unsigned long val : 32; | 300 | u32 val : 32; |
| 283 | struct cfgreg_base_t f; | 301 | struct cfgreg_base_t f; |
| 284 | } __attribute__((packed)); | 302 | } __attribute__((packed)); |
| 285 | 303 | ||
| 286 | struct cif_io_t { | 304 | struct cif_io_t { |
| 287 | unsigned long dq_srp : 1; | 305 | u32 dq_srp : 1; |
| 288 | unsigned long dq_srn : 1; | 306 | u32 dq_srn : 1; |
| 289 | unsigned long dq_sp : 4; | 307 | u32 dq_sp : 4; |
| 290 | unsigned long dq_sn : 4; | 308 | u32 dq_sn : 4; |
| 291 | unsigned long waitb_srp : 1; | 309 | u32 waitb_srp : 1; |
| 292 | unsigned long waitb_srn : 1; | 310 | u32 waitb_srn : 1; |
| 293 | unsigned long waitb_sp : 4; | 311 | u32 waitb_sp : 4; |
| 294 | unsigned long waitb_sn : 4; | 312 | u32 waitb_sn : 4; |
| 295 | unsigned long intb_srp : 1; | 313 | u32 intb_srp : 1; |
| 296 | unsigned long intb_srn : 1; | 314 | u32 intb_srn : 1; |
| 297 | unsigned long intb_sp : 4; | 315 | u32 intb_sp : 4; |
| 298 | unsigned long intb_sn : 4; | 316 | u32 intb_sn : 4; |
| 299 | unsigned long : 2; | 317 | u32 : 2; |
| 300 | } __attribute__((packed)); | 318 | } __attribute__((packed)); |
| 301 | 319 | ||
| 302 | union cif_io_u { | 320 | union cif_io_u { |
| 303 | unsigned long val : 32; | 321 | u32 val : 32; |
| 304 | struct cif_io_t f; | 322 | struct cif_io_t f; |
| 305 | } __attribute__((packed)); | 323 | } __attribute__((packed)); |
| 306 | 324 | ||
| 307 | struct cif_read_dbg_t { | 325 | struct cif_read_dbg_t { |
| 308 | unsigned long unpacker_pre_fetch_trig_gen : 2; | 326 | u32 unpacker_pre_fetch_trig_gen : 2; |
| 309 | unsigned long dly_second_rd_fetch_trig : 1; | 327 | u32 dly_second_rd_fetch_trig : 1; |
| 310 | unsigned long rst_rd_burst_id : 1; | 328 | u32 rst_rd_burst_id : 1; |
| 311 | unsigned long dis_rd_burst_id : 1; | 329 | u32 dis_rd_burst_id : 1; |
| 312 | unsigned long en_block_rd_when_packer_is_not_emp : 1; | 330 | u32 en_block_rd_when_packer_is_not_emp : 1; |
| 313 | unsigned long dis_pre_fetch_cntl_sm : 1; | 331 | u32 dis_pre_fetch_cntl_sm : 1; |
| 314 | unsigned long rbbm_chrncy_dis : 1; | 332 | u32 rbbm_chrncy_dis : 1; |
| 315 | unsigned long rbbm_rd_after_wr_lat : 2; | 333 | u32 rbbm_rd_after_wr_lat : 2; |
| 316 | unsigned long dis_be_during_rd : 1; | 334 | u32 dis_be_during_rd : 1; |
| 317 | unsigned long one_clk_invalidate_pulse : 1; | 335 | u32 one_clk_invalidate_pulse : 1; |
| 318 | unsigned long dis_chnl_priority : 1; | 336 | u32 dis_chnl_priority : 1; |
| 319 | unsigned long rst_read_path_a_pls : 1; | 337 | u32 rst_read_path_a_pls : 1; |
| 320 | unsigned long rst_read_path_b_pls : 1; | 338 | u32 rst_read_path_b_pls : 1; |
| 321 | unsigned long dis_reg_rd_fetch_trig : 1; | 339 | u32 dis_reg_rd_fetch_trig : 1; |
| 322 | unsigned long dis_rd_fetch_trig_from_ind_addr : 1; | 340 | u32 dis_rd_fetch_trig_from_ind_addr : 1; |
| 323 | unsigned long dis_rd_same_byte_to_trig_fetch : 1; | 341 | u32 dis_rd_same_byte_to_trig_fetch : 1; |
| 324 | unsigned long dis_dir_wrap : 1; | 342 | u32 dis_dir_wrap : 1; |
| 325 | unsigned long dis_ring_buf_to_force_dec : 1; | 343 | u32 dis_ring_buf_to_force_dec : 1; |
| 326 | unsigned long dis_addr_comp_in_16bit : 1; | 344 | u32 dis_addr_comp_in_16bit : 1; |
| 327 | unsigned long clr_w : 1; | 345 | u32 clr_w : 1; |
| 328 | unsigned long err_rd_tag_is_3 : 1; | 346 | u32 err_rd_tag_is_3 : 1; |
| 329 | unsigned long err_load_when_ful_a : 1; | 347 | u32 err_load_when_ful_a : 1; |
| 330 | unsigned long err_load_when_ful_b : 1; | 348 | u32 err_load_when_ful_b : 1; |
| 331 | unsigned long : 7; | 349 | u32 : 7; |
| 332 | } __attribute__((packed)); | 350 | } __attribute__((packed)); |
| 333 | 351 | ||
| 334 | union cif_read_dbg_u { | 352 | union cif_read_dbg_u { |
| 335 | unsigned long val : 32; | 353 | u32 val : 32; |
| 336 | struct cif_read_dbg_t f; | 354 | struct cif_read_dbg_t f; |
| 337 | } __attribute__((packed)); | 355 | } __attribute__((packed)); |
| 338 | 356 | ||
| 339 | struct cif_write_dbg_t { | 357 | struct cif_write_dbg_t { |
| 340 | unsigned long packer_timeout_count : 2; | 358 | u32 packer_timeout_count : 2; |
| 341 | unsigned long en_upper_load_cond : 1; | 359 | u32 en_upper_load_cond : 1; |
| 342 | unsigned long en_chnl_change_cond : 1; | 360 | u32 en_chnl_change_cond : 1; |
| 343 | unsigned long dis_addr_comp_cond : 1; | 361 | u32 dis_addr_comp_cond : 1; |
| 344 | unsigned long dis_load_same_byte_addr_cond : 1; | 362 | u32 dis_load_same_byte_addr_cond : 1; |
| 345 | unsigned long dis_timeout_cond : 1; | 363 | u32 dis_timeout_cond : 1; |
| 346 | unsigned long dis_timeout_during_rbbm : 1; | 364 | u32 dis_timeout_during_rbbm : 1; |
| 347 | unsigned long dis_packer_ful_during_rbbm_timeout : 1; | 365 | u32 dis_packer_ful_during_rbbm_timeout : 1; |
| 348 | unsigned long en_dword_split_to_rbbm : 1; | 366 | u32 en_dword_split_to_rbbm : 1; |
| 349 | unsigned long en_dummy_val : 1; | 367 | u32 en_dummy_val : 1; |
| 350 | unsigned long dummy_val_sel : 1; | 368 | u32 dummy_val_sel : 1; |
| 351 | unsigned long mask_pm4_wrptr_dec : 1; | 369 | u32 mask_pm4_wrptr_dec : 1; |
| 352 | unsigned long dis_mc_clean_cond : 1; | 370 | u32 dis_mc_clean_cond : 1; |
| 353 | unsigned long err_two_reqi_during_ful : 1; | 371 | u32 err_two_reqi_during_ful : 1; |
| 354 | unsigned long err_reqi_during_idle_clk : 1; | 372 | u32 err_reqi_during_idle_clk : 1; |
| 355 | unsigned long err_global : 1; | 373 | u32 err_global : 1; |
| 356 | unsigned long en_wr_buf_dbg_load : 1; | 374 | u32 en_wr_buf_dbg_load : 1; |
| 357 | unsigned long en_wr_buf_dbg_path : 1; | 375 | u32 en_wr_buf_dbg_path : 1; |
| 358 | unsigned long sel_wr_buf_byte : 3; | 376 | u32 sel_wr_buf_byte : 3; |
| 359 | unsigned long dis_rd_flush_wr : 1; | 377 | u32 dis_rd_flush_wr : 1; |
| 360 | unsigned long dis_packer_ful_cond : 1; | 378 | u32 dis_packer_ful_cond : 1; |
| 361 | unsigned long dis_invalidate_by_ops_chnl : 1; | 379 | u32 dis_invalidate_by_ops_chnl : 1; |
| 362 | unsigned long en_halt_when_reqi_err : 1; | 380 | u32 en_halt_when_reqi_err : 1; |
| 363 | unsigned long cif_spare_2 : 5; | 381 | u32 cif_spare_2 : 5; |
| 364 | unsigned long : 1; | 382 | u32 : 1; |
| 365 | } __attribute__((packed)); | 383 | } __attribute__((packed)); |
| 366 | 384 | ||
| 367 | union cif_write_dbg_u { | 385 | union cif_write_dbg_u { |
| 368 | unsigned long val : 32; | 386 | u32 val : 32; |
| 369 | struct cif_write_dbg_t f; | 387 | struct cif_write_dbg_t f; |
| 370 | } __attribute__((packed)); | 388 | } __attribute__((packed)); |
| 371 | 389 | ||
| @@ -403,327 +421,327 @@ union cpu_defaults_u { | |||
| 403 | } __attribute__((packed)); | 421 | } __attribute__((packed)); |
| 404 | 422 | ||
| 405 | struct crtc_total_t { | 423 | struct crtc_total_t { |
| 406 | unsigned long crtc_h_total : 10; | 424 | u32 crtc_h_total : 10; |
| 407 | unsigned long : 6; | 425 | u32 : 6; |
| 408 | unsigned long crtc_v_total : 10; | 426 | u32 crtc_v_total : 10; |
| 409 | unsigned long : 6; | 427 | u32 : 6; |
| 410 | } __attribute__((packed)); | 428 | } __attribute__((packed)); |
| 411 | 429 | ||
| 412 | union crtc_total_u { | 430 | union crtc_total_u { |
| 413 | unsigned long val : 32; | 431 | u32 val : 32; |
| 414 | struct crtc_total_t f; | 432 | struct crtc_total_t f; |
| 415 | } __attribute__((packed)); | 433 | } __attribute__((packed)); |
| 416 | 434 | ||
| 417 | struct crtc_ss_t { | 435 | struct crtc_ss_t { |
| 418 | unsigned long ss_start : 10; | 436 | u32 ss_start : 10; |
| 419 | unsigned long : 6; | 437 | u32 : 6; |
| 420 | unsigned long ss_end : 10; | 438 | u32 ss_end : 10; |
| 421 | unsigned long : 2; | 439 | u32 : 2; |
| 422 | unsigned long ss_align : 1; | 440 | u32 ss_align : 1; |
| 423 | unsigned long ss_pol : 1; | 441 | u32 ss_pol : 1; |
| 424 | unsigned long ss_run_mode : 1; | 442 | u32 ss_run_mode : 1; |
| 425 | unsigned long ss_en : 1; | 443 | u32 ss_en : 1; |
| 426 | } __attribute__((packed)); | 444 | } __attribute__((packed)); |
| 427 | 445 | ||
| 428 | union crtc_ss_u { | 446 | union crtc_ss_u { |
| 429 | unsigned long val : 32; | 447 | u32 val : 32; |
| 430 | struct crtc_ss_t f; | 448 | struct crtc_ss_t f; |
| 431 | } __attribute__((packed)); | 449 | } __attribute__((packed)); |
| 432 | 450 | ||
| 433 | struct active_h_disp_t { | 451 | struct active_h_disp_t { |
| 434 | unsigned long active_h_start : 10; | 452 | u32 active_h_start : 10; |
| 435 | unsigned long : 6; | 453 | u32 : 6; |
| 436 | unsigned long active_h_end : 10; | 454 | u32 active_h_end : 10; |
| 437 | unsigned long : 6; | 455 | u32 : 6; |
| 438 | } __attribute__((packed)); | 456 | } __attribute__((packed)); |
| 439 | 457 | ||
| 440 | union active_h_disp_u { | 458 | union active_h_disp_u { |
| 441 | unsigned long val : 32; | 459 | u32 val : 32; |
| 442 | struct active_h_disp_t f; | 460 | struct active_h_disp_t f; |
| 443 | } __attribute__((packed)); | 461 | } __attribute__((packed)); |
| 444 | 462 | ||
| 445 | struct active_v_disp_t { | 463 | struct active_v_disp_t { |
| 446 | unsigned long active_v_start : 10; | 464 | u32 active_v_start : 10; |
| 447 | unsigned long : 6; | 465 | u32 : 6; |
| 448 | unsigned long active_v_end : 10; | 466 | u32 active_v_end : 10; |
| 449 | unsigned long : 6; | 467 | u32 : 6; |
| 450 | } __attribute__((packed)); | 468 | } __attribute__((packed)); |
| 451 | 469 | ||
| 452 | union active_v_disp_u { | 470 | union active_v_disp_u { |
| 453 | unsigned long val : 32; | 471 | u32 val : 32; |
| 454 | struct active_v_disp_t f; | 472 | struct active_v_disp_t f; |
| 455 | } __attribute__((packed)); | 473 | } __attribute__((packed)); |
| 456 | 474 | ||
| 457 | struct graphic_h_disp_t { | 475 | struct graphic_h_disp_t { |
| 458 | unsigned long graphic_h_start : 10; | 476 | u32 graphic_h_start : 10; |
| 459 | unsigned long : 6; | 477 | u32 : 6; |
| 460 | unsigned long graphic_h_end : 10; | 478 | u32 graphic_h_end : 10; |
| 461 | unsigned long : 6; | 479 | u32 : 6; |
| 462 | } __attribute__((packed)); | 480 | } __attribute__((packed)); |
| 463 | 481 | ||
| 464 | union graphic_h_disp_u { | 482 | union graphic_h_disp_u { |
| 465 | unsigned long val : 32; | 483 | u32 val : 32; |
| 466 | struct graphic_h_disp_t f; | 484 | struct graphic_h_disp_t f; |
| 467 | } __attribute__((packed)); | 485 | } __attribute__((packed)); |
| 468 | 486 | ||
| 469 | struct graphic_v_disp_t { | 487 | struct graphic_v_disp_t { |
| 470 | unsigned long graphic_v_start : 10; | 488 | u32 graphic_v_start : 10; |
| 471 | unsigned long : 6; | 489 | u32 : 6; |
| 472 | unsigned long graphic_v_end : 10; | 490 | u32 graphic_v_end : 10; |
| 473 | unsigned long : 6; | 491 | u32 : 6; |
| 474 | } __attribute__((packed)); | 492 | } __attribute__((packed)); |
| 475 | 493 | ||
| 476 | union graphic_v_disp_u{ | 494 | union graphic_v_disp_u{ |
| 477 | unsigned long val : 32; | 495 | u32 val : 32; |
| 478 | struct graphic_v_disp_t f; | 496 | struct graphic_v_disp_t f; |
| 479 | } __attribute__((packed)); | 497 | } __attribute__((packed)); |
| 480 | 498 | ||
| 481 | struct graphic_ctrl_t_w100 { | 499 | struct graphic_ctrl_t_w100 { |
| 482 | unsigned long color_depth : 3; | 500 | u32 color_depth : 3; |
| 483 | unsigned long portrait_mode : 2; | 501 | u32 portrait_mode : 2; |
| 484 | unsigned long low_power_on : 1; | 502 | u32 low_power_on : 1; |
| 485 | unsigned long req_freq : 4; | 503 | u32 req_freq : 4; |
| 486 | unsigned long en_crtc : 1; | 504 | u32 en_crtc : 1; |
| 487 | unsigned long en_graphic_req : 1; | 505 | u32 en_graphic_req : 1; |
| 488 | unsigned long en_graphic_crtc : 1; | 506 | u32 en_graphic_crtc : 1; |
| 489 | unsigned long total_req_graphic : 9; | 507 | u32 total_req_graphic : 9; |
| 490 | unsigned long lcd_pclk_on : 1; | 508 | u32 lcd_pclk_on : 1; |
| 491 | unsigned long lcd_sclk_on : 1; | 509 | u32 lcd_sclk_on : 1; |
| 492 | unsigned long pclk_running : 1; | 510 | u32 pclk_running : 1; |
| 493 | unsigned long sclk_running : 1; | 511 | u32 sclk_running : 1; |
| 494 | unsigned long : 6; | 512 | u32 : 6; |
| 495 | } __attribute__((packed)); | 513 | } __attribute__((packed)); |
| 496 | 514 | ||
| 497 | struct graphic_ctrl_t_w32xx { | 515 | struct graphic_ctrl_t_w32xx { |
| 498 | unsigned long color_depth : 3; | 516 | u32 color_depth : 3; |
| 499 | unsigned long portrait_mode : 2; | 517 | u32 portrait_mode : 2; |
| 500 | unsigned long low_power_on : 1; | 518 | u32 low_power_on : 1; |
| 501 | unsigned long req_freq : 4; | 519 | u32 req_freq : 4; |
| 502 | unsigned long en_crtc : 1; | 520 | u32 en_crtc : 1; |
| 503 | unsigned long en_graphic_req : 1; | 521 | u32 en_graphic_req : 1; |
| 504 | unsigned long en_graphic_crtc : 1; | 522 | u32 en_graphic_crtc : 1; |
| 505 | unsigned long total_req_graphic : 10; | 523 | u32 total_req_graphic : 10; |
| 506 | unsigned long lcd_pclk_on : 1; | 524 | u32 lcd_pclk_on : 1; |
| 507 | unsigned long lcd_sclk_on : 1; | 525 | u32 lcd_sclk_on : 1; |
| 508 | unsigned long pclk_running : 1; | 526 | u32 pclk_running : 1; |
| 509 | unsigned long sclk_running : 1; | 527 | u32 sclk_running : 1; |
| 510 | unsigned long : 5; | 528 | u32 : 5; |
| 511 | } __attribute__((packed)); | 529 | } __attribute__((packed)); |
| 512 | 530 | ||
| 513 | union graphic_ctrl_u { | 531 | union graphic_ctrl_u { |
| 514 | unsigned long val : 32; | 532 | u32 val : 32; |
| 515 | struct graphic_ctrl_t_w100 f_w100; | 533 | struct graphic_ctrl_t_w100 f_w100; |
| 516 | struct graphic_ctrl_t_w32xx f_w32xx; | 534 | struct graphic_ctrl_t_w32xx f_w32xx; |
| 517 | } __attribute__((packed)); | 535 | } __attribute__((packed)); |
| 518 | 536 | ||
| 519 | struct video_ctrl_t { | 537 | struct video_ctrl_t { |
| 520 | unsigned long video_mode : 1; | 538 | u32 video_mode : 1; |
| 521 | unsigned long keyer_en : 1; | 539 | u32 keyer_en : 1; |
| 522 | unsigned long en_video_req : 1; | 540 | u32 en_video_req : 1; |
| 523 | unsigned long en_graphic_req_video : 1; | 541 | u32 en_graphic_req_video : 1; |
| 524 | unsigned long en_video_crtc : 1; | 542 | u32 en_video_crtc : 1; |
| 525 | unsigned long video_hor_exp : 2; | 543 | u32 video_hor_exp : 2; |
| 526 | unsigned long video_ver_exp : 2; | 544 | u32 video_ver_exp : 2; |
| 527 | unsigned long uv_combine : 1; | 545 | u32 uv_combine : 1; |
| 528 | unsigned long total_req_video : 9; | 546 | u32 total_req_video : 9; |
| 529 | unsigned long video_ch_sel : 1; | 547 | u32 video_ch_sel : 1; |
| 530 | unsigned long video_portrait : 2; | 548 | u32 video_portrait : 2; |
| 531 | unsigned long yuv2rgb_en : 1; | 549 | u32 yuv2rgb_en : 1; |
| 532 | unsigned long yuv2rgb_option : 1; | 550 | u32 yuv2rgb_option : 1; |
| 533 | unsigned long video_inv_hor : 1; | 551 | u32 video_inv_hor : 1; |
| 534 | unsigned long video_inv_ver : 1; | 552 | u32 video_inv_ver : 1; |
| 535 | unsigned long gamma_sel : 2; | 553 | u32 gamma_sel : 2; |
| 536 | unsigned long dis_limit : 1; | 554 | u32 dis_limit : 1; |
| 537 | unsigned long en_uv_hblend : 1; | 555 | u32 en_uv_hblend : 1; |
| 538 | unsigned long rgb_gamma_sel : 2; | 556 | u32 rgb_gamma_sel : 2; |
| 539 | } __attribute__((packed)); | 557 | } __attribute__((packed)); |
| 540 | 558 | ||
| 541 | union video_ctrl_u { | 559 | union video_ctrl_u { |
| 542 | unsigned long val : 32; | 560 | u32 val : 32; |
| 543 | struct video_ctrl_t f; | 561 | struct video_ctrl_t f; |
| 544 | } __attribute__((packed)); | 562 | } __attribute__((packed)); |
| 545 | 563 | ||
| 546 | struct disp_db_buf_cntl_rd_t { | 564 | struct disp_db_buf_cntl_rd_t { |
| 547 | unsigned long en_db_buf : 1; | 565 | u32 en_db_buf : 1; |
| 548 | unsigned long update_db_buf_done : 1; | 566 | u32 update_db_buf_done : 1; |
| 549 | unsigned long db_buf_cntl : 6; | 567 | u32 db_buf_cntl : 6; |
| 550 | unsigned long : 24; | 568 | u32 : 24; |
| 551 | } __attribute__((packed)); | 569 | } __attribute__((packed)); |
| 552 | 570 | ||
| 553 | union disp_db_buf_cntl_rd_u { | 571 | union disp_db_buf_cntl_rd_u { |
| 554 | unsigned long val : 32; | 572 | u32 val : 32; |
| 555 | struct disp_db_buf_cntl_rd_t f; | 573 | struct disp_db_buf_cntl_rd_t f; |
| 556 | } __attribute__((packed)); | 574 | } __attribute__((packed)); |
| 557 | 575 | ||
| 558 | struct disp_db_buf_cntl_wr_t { | 576 | struct disp_db_buf_cntl_wr_t { |
| 559 | unsigned long en_db_buf : 1; | 577 | u32 en_db_buf : 1; |
| 560 | unsigned long update_db_buf : 1; | 578 | u32 update_db_buf : 1; |
| 561 | unsigned long db_buf_cntl : 6; | 579 | u32 db_buf_cntl : 6; |
| 562 | unsigned long : 24; | 580 | u32 : 24; |
| 563 | } __attribute__((packed)); | 581 | } __attribute__((packed)); |
| 564 | 582 | ||
| 565 | union disp_db_buf_cntl_wr_u { | 583 | union disp_db_buf_cntl_wr_u { |
| 566 | unsigned long val : 32; | 584 | u32 val : 32; |
| 567 | struct disp_db_buf_cntl_wr_t f; | 585 | struct disp_db_buf_cntl_wr_t f; |
| 568 | } __attribute__((packed)); | 586 | } __attribute__((packed)); |
| 569 | 587 | ||
| 570 | struct gamma_value1_t { | 588 | struct gamma_value1_t { |
| 571 | unsigned long gamma1 : 8; | 589 | u32 gamma1 : 8; |
| 572 | unsigned long gamma2 : 8; | 590 | u32 gamma2 : 8; |
| 573 | unsigned long gamma3 : 8; | 591 | u32 gamma3 : 8; |
| 574 | unsigned long gamma4 : 8; | 592 | u32 gamma4 : 8; |
| 575 | } __attribute__((packed)); | 593 | } __attribute__((packed)); |
| 576 | 594 | ||
| 577 | union gamma_value1_u { | 595 | union gamma_value1_u { |
| 578 | unsigned long val : 32; | 596 | u32 val : 32; |
| 579 | struct gamma_value1_t f; | 597 | struct gamma_value1_t f; |
| 580 | } __attribute__((packed)); | 598 | } __attribute__((packed)); |
| 581 | 599 | ||
| 582 | struct gamma_value2_t { | 600 | struct gamma_value2_t { |
| 583 | unsigned long gamma5 : 8; | 601 | u32 gamma5 : 8; |
| 584 | unsigned long gamma6 : 8; | 602 | u32 gamma6 : 8; |
| 585 | unsigned long gamma7 : 8; | 603 | u32 gamma7 : 8; |
| 586 | unsigned long gamma8 : 8; | 604 | u32 gamma8 : 8; |
| 587 | } __attribute__((packed)); | 605 | } __attribute__((packed)); |
| 588 | 606 | ||
| 589 | union gamma_value2_u { | 607 | union gamma_value2_u { |
| 590 | unsigned long val : 32; | 608 | u32 val : 32; |
| 591 | struct gamma_value2_t f; | 609 | struct gamma_value2_t f; |
| 592 | } __attribute__((packed)); | 610 | } __attribute__((packed)); |
| 593 | 611 | ||
| 594 | struct gamma_slope_t { | 612 | struct gamma_slope_t { |
| 595 | unsigned long slope1 : 3; | 613 | u32 slope1 : 3; |
| 596 | unsigned long slope2 : 3; | 614 | u32 slope2 : 3; |
| 597 | unsigned long slope3 : 3; | 615 | u32 slope3 : 3; |
| 598 | unsigned long slope4 : 3; | 616 | u32 slope4 : 3; |
| 599 | unsigned long slope5 : 3; | 617 | u32 slope5 : 3; |
| 600 | unsigned long slope6 : 3; | 618 | u32 slope6 : 3; |
| 601 | unsigned long slope7 : 3; | 619 | u32 slope7 : 3; |
| 602 | unsigned long slope8 : 3; | 620 | u32 slope8 : 3; |
| 603 | unsigned long : 8; | 621 | u32 : 8; |
| 604 | } __attribute__((packed)); | 622 | } __attribute__((packed)); |
| 605 | 623 | ||
| 606 | union gamma_slope_u { | 624 | union gamma_slope_u { |
| 607 | unsigned long val : 32; | 625 | u32 val : 32; |
| 608 | struct gamma_slope_t f; | 626 | struct gamma_slope_t f; |
| 609 | } __attribute__((packed)); | 627 | } __attribute__((packed)); |
| 610 | 628 | ||
| 611 | struct mc_ext_mem_location_t { | 629 | struct mc_ext_mem_location_t { |
| 612 | unsigned long mc_ext_mem_start : 16; | 630 | u32 mc_ext_mem_start : 16; |
| 613 | unsigned long mc_ext_mem_top : 16; | 631 | u32 mc_ext_mem_top : 16; |
| 614 | } __attribute__((packed)); | 632 | } __attribute__((packed)); |
| 615 | 633 | ||
| 616 | union mc_ext_mem_location_u { | 634 | union mc_ext_mem_location_u { |
| 617 | unsigned long val : 32; | 635 | u32 val : 32; |
| 618 | struct mc_ext_mem_location_t f; | 636 | struct mc_ext_mem_location_t f; |
| 619 | } __attribute__((packed)); | 637 | } __attribute__((packed)); |
| 620 | 638 | ||
| 621 | struct mc_fb_location_t { | 639 | struct mc_fb_location_t { |
| 622 | unsigned long mc_fb_start : 16; | 640 | u32 mc_fb_start : 16; |
| 623 | unsigned long mc_fb_top : 16; | 641 | u32 mc_fb_top : 16; |
| 624 | } __attribute__((packed)); | 642 | } __attribute__((packed)); |
| 625 | 643 | ||
| 626 | union mc_fb_location_u { | 644 | union mc_fb_location_u { |
| 627 | unsigned long val : 32; | 645 | u32 val : 32; |
| 628 | struct mc_fb_location_t f; | 646 | struct mc_fb_location_t f; |
| 629 | } __attribute__((packed)); | 647 | } __attribute__((packed)); |
| 630 | 648 | ||
| 631 | struct clk_pin_cntl_t { | 649 | struct clk_pin_cntl_t { |
| 632 | unsigned long osc_en : 1; | 650 | u32 osc_en : 1; |
| 633 | unsigned long osc_gain : 5; | 651 | u32 osc_gain : 5; |
| 634 | unsigned long dont_use_xtalin : 1; | 652 | u32 dont_use_xtalin : 1; |
| 635 | unsigned long xtalin_pm_en : 1; | 653 | u32 xtalin_pm_en : 1; |
| 636 | unsigned long xtalin_dbl_en : 1; | 654 | u32 xtalin_dbl_en : 1; |
| 637 | unsigned long : 7; | 655 | u32 : 7; |
| 638 | unsigned long cg_debug : 16; | 656 | u32 cg_debug : 16; |
| 639 | } __attribute__((packed)); | 657 | } __attribute__((packed)); |
| 640 | 658 | ||
| 641 | union clk_pin_cntl_u { | 659 | union clk_pin_cntl_u { |
| 642 | unsigned long val : 32; | 660 | u32 val : 32; |
| 643 | struct clk_pin_cntl_t f; | 661 | struct clk_pin_cntl_t f; |
| 644 | } __attribute__((packed)); | 662 | } __attribute__((packed)); |
| 645 | 663 | ||
| 646 | struct pll_ref_fb_div_t { | 664 | struct pll_ref_fb_div_t { |
| 647 | unsigned long pll_ref_div : 4; | 665 | u32 pll_ref_div : 4; |
| 648 | unsigned long : 4; | 666 | u32 : 4; |
| 649 | unsigned long pll_fb_div_int : 6; | 667 | u32 pll_fb_div_int : 6; |
| 650 | unsigned long : 2; | 668 | u32 : 2; |
| 651 | unsigned long pll_fb_div_frac : 3; | 669 | u32 pll_fb_div_frac : 3; |
| 652 | unsigned long : 1; | 670 | u32 : 1; |
| 653 | unsigned long pll_reset_time : 4; | 671 | u32 pll_reset_time : 4; |
| 654 | unsigned long pll_lock_time : 8; | 672 | u32 pll_lock_time : 8; |
| 655 | } __attribute__((packed)); | 673 | } __attribute__((packed)); |
| 656 | 674 | ||
| 657 | union pll_ref_fb_div_u { | 675 | union pll_ref_fb_div_u { |
| 658 | unsigned long val : 32; | 676 | u32 val : 32; |
| 659 | struct pll_ref_fb_div_t f; | 677 | struct pll_ref_fb_div_t f; |
| 660 | } __attribute__((packed)); | 678 | } __attribute__((packed)); |
| 661 | 679 | ||
| 662 | struct pll_cntl_t { | 680 | struct pll_cntl_t { |
| 663 | unsigned long pll_pwdn : 1; | 681 | u32 pll_pwdn : 1; |
| 664 | unsigned long pll_reset : 1; | 682 | u32 pll_reset : 1; |
| 665 | unsigned long pll_pm_en : 1; | 683 | u32 pll_pm_en : 1; |
| 666 | unsigned long pll_mode : 1; | 684 | u32 pll_mode : 1; |
| 667 | unsigned long pll_refclk_sel : 1; | 685 | u32 pll_refclk_sel : 1; |
| 668 | unsigned long pll_fbclk_sel : 1; | 686 | u32 pll_fbclk_sel : 1; |
| 669 | unsigned long pll_tcpoff : 1; | 687 | u32 pll_tcpoff : 1; |
| 670 | unsigned long pll_pcp : 3; | 688 | u32 pll_pcp : 3; |
| 671 | unsigned long pll_pvg : 3; | 689 | u32 pll_pvg : 3; |
| 672 | unsigned long pll_vcofr : 1; | 690 | u32 pll_vcofr : 1; |
| 673 | unsigned long pll_ioffset : 2; | 691 | u32 pll_ioffset : 2; |
| 674 | unsigned long pll_pecc_mode : 2; | 692 | u32 pll_pecc_mode : 2; |
| 675 | unsigned long pll_pecc_scon : 2; | 693 | u32 pll_pecc_scon : 2; |
| 676 | unsigned long pll_dactal : 4; | 694 | u32 pll_dactal : 4; |
| 677 | unsigned long pll_cp_clip : 2; | 695 | u32 pll_cp_clip : 2; |
| 678 | unsigned long pll_conf : 3; | 696 | u32 pll_conf : 3; |
| 679 | unsigned long pll_mbctrl : 2; | 697 | u32 pll_mbctrl : 2; |
| 680 | unsigned long pll_ring_off : 1; | 698 | u32 pll_ring_off : 1; |
| 681 | } __attribute__((packed)); | 699 | } __attribute__((packed)); |
| 682 | 700 | ||
| 683 | union pll_cntl_u { | 701 | union pll_cntl_u { |
| 684 | unsigned long val : 32; | 702 | u32 val : 32; |
| 685 | struct pll_cntl_t f; | 703 | struct pll_cntl_t f; |
| 686 | } __attribute__((packed)); | 704 | } __attribute__((packed)); |
| 687 | 705 | ||
| 688 | struct sclk_cntl_t { | 706 | struct sclk_cntl_t { |
| 689 | unsigned long sclk_src_sel : 2; | 707 | u32 sclk_src_sel : 2; |
| 690 | unsigned long : 2; | 708 | u32 : 2; |
| 691 | unsigned long sclk_post_div_fast : 4; | 709 | u32 sclk_post_div_fast : 4; |
| 692 | unsigned long sclk_clkon_hys : 3; | 710 | u32 sclk_clkon_hys : 3; |
| 693 | unsigned long sclk_post_div_slow : 4; | 711 | u32 sclk_post_div_slow : 4; |
| 694 | unsigned long disp_cg_ok2switch_en : 1; | 712 | u32 disp_cg_ok2switch_en : 1; |
| 695 | unsigned long sclk_force_reg : 1; | 713 | u32 sclk_force_reg : 1; |
| 696 | unsigned long sclk_force_disp : 1; | 714 | u32 sclk_force_disp : 1; |
| 697 | unsigned long sclk_force_mc : 1; | 715 | u32 sclk_force_mc : 1; |
| 698 | unsigned long sclk_force_extmc : 1; | 716 | u32 sclk_force_extmc : 1; |
| 699 | unsigned long sclk_force_cp : 1; | 717 | u32 sclk_force_cp : 1; |
| 700 | unsigned long sclk_force_e2 : 1; | 718 | u32 sclk_force_e2 : 1; |
| 701 | unsigned long sclk_force_e3 : 1; | 719 | u32 sclk_force_e3 : 1; |
| 702 | unsigned long sclk_force_idct : 1; | 720 | u32 sclk_force_idct : 1; |
| 703 | unsigned long sclk_force_bist : 1; | 721 | u32 sclk_force_bist : 1; |
| 704 | unsigned long busy_extend_cp : 1; | 722 | u32 busy_extend_cp : 1; |
| 705 | unsigned long busy_extend_e2 : 1; | 723 | u32 busy_extend_e2 : 1; |
| 706 | unsigned long busy_extend_e3 : 1; | 724 | u32 busy_extend_e3 : 1; |
| 707 | unsigned long busy_extend_idct : 1; | 725 | u32 busy_extend_idct : 1; |
| 708 | unsigned long : 3; | 726 | u32 : 3; |
| 709 | } __attribute__((packed)); | 727 | } __attribute__((packed)); |
| 710 | 728 | ||
| 711 | union sclk_cntl_u { | 729 | union sclk_cntl_u { |
| 712 | unsigned long val : 32; | 730 | u32 val : 32; |
| 713 | struct sclk_cntl_t f; | 731 | struct sclk_cntl_t f; |
| 714 | } __attribute__((packed)); | 732 | } __attribute__((packed)); |
| 715 | 733 | ||
| 716 | struct pclk_cntl_t { | 734 | struct pclk_cntl_t { |
| 717 | unsigned long pclk_src_sel : 2; | 735 | u32 pclk_src_sel : 2; |
| 718 | unsigned long : 2; | 736 | u32 : 2; |
| 719 | unsigned long pclk_post_div : 4; | 737 | u32 pclk_post_div : 4; |
| 720 | unsigned long : 8; | 738 | u32 : 8; |
| 721 | unsigned long pclk_force_disp : 1; | 739 | u32 pclk_force_disp : 1; |
| 722 | unsigned long : 15; | 740 | u32 : 15; |
| 723 | } __attribute__((packed)); | 741 | } __attribute__((packed)); |
| 724 | 742 | ||
| 725 | union pclk_cntl_u { | 743 | union pclk_cntl_u { |
| 726 | unsigned long val : 32; | 744 | u32 val : 32; |
| 727 | struct pclk_cntl_t f; | 745 | struct pclk_cntl_t f; |
| 728 | } __attribute__((packed)); | 746 | } __attribute__((packed)); |
| 729 | 747 | ||
| @@ -735,36 +753,176 @@ union pclk_cntl_u { | |||
| 735 | #define TESTCLK_SRC_XTAL 0x06 | 753 | #define TESTCLK_SRC_XTAL 0x06 |
| 736 | 754 | ||
| 737 | struct clk_test_cntl_t { | 755 | struct clk_test_cntl_t { |
| 738 | unsigned long testclk_sel : 4; | 756 | u32 testclk_sel : 4; |
| 739 | unsigned long : 3; | 757 | u32 : 3; |
| 740 | unsigned long start_check_freq : 1; | 758 | u32 start_check_freq : 1; |
| 741 | unsigned long tstcount_rst : 1; | 759 | u32 tstcount_rst : 1; |
| 742 | unsigned long : 15; | 760 | u32 : 15; |
| 743 | unsigned long test_count : 8; | 761 | u32 test_count : 8; |
| 744 | } __attribute__((packed)); | 762 | } __attribute__((packed)); |
| 745 | 763 | ||
| 746 | union clk_test_cntl_u { | 764 | union clk_test_cntl_u { |
| 747 | unsigned long val : 32; | 765 | u32 val : 32; |
| 748 | struct clk_test_cntl_t f; | 766 | struct clk_test_cntl_t f; |
| 749 | } __attribute__((packed)); | 767 | } __attribute__((packed)); |
| 750 | 768 | ||
| 751 | struct pwrmgt_cntl_t { | 769 | struct pwrmgt_cntl_t { |
| 752 | unsigned long pwm_enable : 1; | 770 | u32 pwm_enable : 1; |
| 753 | unsigned long : 1; | 771 | u32 : 1; |
| 754 | unsigned long pwm_mode_req : 2; | 772 | u32 pwm_mode_req : 2; |
| 755 | unsigned long pwm_wakeup_cond : 2; | 773 | u32 pwm_wakeup_cond : 2; |
| 756 | unsigned long pwm_fast_noml_hw_en : 1; | 774 | u32 pwm_fast_noml_hw_en : 1; |
| 757 | unsigned long pwm_noml_fast_hw_en : 1; | 775 | u32 pwm_noml_fast_hw_en : 1; |
| 758 | unsigned long pwm_fast_noml_cond : 4; | 776 | u32 pwm_fast_noml_cond : 4; |
| 759 | unsigned long pwm_noml_fast_cond : 4; | 777 | u32 pwm_noml_fast_cond : 4; |
| 760 | unsigned long pwm_idle_timer : 8; | 778 | u32 pwm_idle_timer : 8; |
| 761 | unsigned long pwm_busy_timer : 8; | 779 | u32 pwm_busy_timer : 8; |
| 762 | } __attribute__((packed)); | 780 | } __attribute__((packed)); |
| 763 | 781 | ||
| 764 | union pwrmgt_cntl_u { | 782 | union pwrmgt_cntl_u { |
| 765 | unsigned long val : 32; | 783 | u32 val : 32; |
| 766 | struct pwrmgt_cntl_t f; | 784 | struct pwrmgt_cntl_t f; |
| 767 | } __attribute__((packed)); | 785 | } __attribute__((packed)); |
| 768 | 786 | ||
| 787 | #define SRC_DATATYPE_EQU_DST 3 | ||
| 788 | |||
| 789 | #define ROP3_SRCCOPY 0xcc | ||
| 790 | #define ROP3_PATCOPY 0xf0 | ||
| 791 | |||
| 792 | #define GMC_BRUSH_SOLID_COLOR 13 | ||
| 793 | #define GMC_BRUSH_NONE 15 | ||
| 794 | |||
| 795 | #define DP_SRC_MEM_RECTANGULAR 2 | ||
| 796 | |||
| 797 | #define DP_OP_ROP 0 | ||
| 798 | |||
| 799 | struct dp_gui_master_cntl_t { | ||
| 800 | u32 gmc_src_pitch_offset_cntl : 1; | ||
| 801 | u32 gmc_dst_pitch_offset_cntl : 1; | ||
| 802 | u32 gmc_src_clipping : 1; | ||
| 803 | u32 gmc_dst_clipping : 1; | ||
| 804 | u32 gmc_brush_datatype : 4; | ||
| 805 | u32 gmc_dst_datatype : 4; | ||
| 806 | u32 gmc_src_datatype : 3; | ||
| 807 | u32 gmc_byte_pix_order : 1; | ||
| 808 | u32 gmc_default_sel : 1; | ||
| 809 | u32 gmc_rop3 : 8; | ||
| 810 | u32 gmc_dp_src_source : 3; | ||
| 811 | u32 gmc_clr_cmp_fcn_dis : 1; | ||
| 812 | u32 : 1; | ||
| 813 | u32 gmc_wr_msk_dis : 1; | ||
| 814 | u32 gmc_dp_op : 1; | ||
| 815 | } __attribute__((packed)); | ||
| 816 | |||
| 817 | union dp_gui_master_cntl_u { | ||
| 818 | u32 val : 32; | ||
| 819 | struct dp_gui_master_cntl_t f; | ||
| 820 | } __attribute__((packed)); | ||
| 821 | |||
| 822 | struct rbbm_status_t { | ||
| 823 | u32 cmdfifo_avail : 7; | ||
| 824 | u32 : 1; | ||
| 825 | u32 hirq_on_rbb : 1; | ||
| 826 | u32 cprq_on_rbb : 1; | ||
| 827 | u32 cfrq_on_rbb : 1; | ||
| 828 | u32 hirq_in_rtbuf : 1; | ||
| 829 | u32 cprq_in_rtbuf : 1; | ||
| 830 | u32 cfrq_in_rtbuf : 1; | ||
| 831 | u32 cf_pipe_busy : 1; | ||
| 832 | u32 eng_ev_busy : 1; | ||
| 833 | u32 cp_cmdstrm_busy : 1; | ||
| 834 | u32 e2_busy : 1; | ||
| 835 | u32 rb2d_busy : 1; | ||
| 836 | u32 rb3d_busy : 1; | ||
| 837 | u32 se_busy : 1; | ||
| 838 | u32 re_busy : 1; | ||
| 839 | u32 tam_busy : 1; | ||
| 840 | u32 tdm_busy : 1; | ||
| 841 | u32 pb_busy : 1; | ||
| 842 | u32 : 6; | ||
| 843 | u32 gui_active : 1; | ||
| 844 | } __attribute__((packed)); | ||
| 845 | |||
| 846 | union rbbm_status_u { | ||
| 847 | u32 val : 32; | ||
| 848 | struct rbbm_status_t f; | ||
| 849 | } __attribute__((packed)); | ||
| 850 | |||
| 851 | struct dp_datatype_t { | ||
| 852 | u32 dp_dst_datatype : 4; | ||
| 853 | u32 : 4; | ||
| 854 | u32 dp_brush_datatype : 4; | ||
| 855 | u32 dp_src2_type : 1; | ||
| 856 | u32 dp_src2_datatype : 3; | ||
| 857 | u32 dp_src_datatype : 3; | ||
| 858 | u32 : 11; | ||
| 859 | u32 dp_byte_pix_order : 1; | ||
| 860 | u32 : 1; | ||
| 861 | } __attribute__((packed)); | ||
| 862 | |||
| 863 | union dp_datatype_u { | ||
| 864 | u32 val : 32; | ||
| 865 | struct dp_datatype_t f; | ||
| 866 | } __attribute__((packed)); | ||
| 867 | |||
| 868 | struct dp_mix_t { | ||
| 869 | u32 : 8; | ||
| 870 | u32 dp_src_source : 3; | ||
| 871 | u32 dp_src2_source : 3; | ||
| 872 | u32 : 2; | ||
| 873 | u32 dp_rop3 : 8; | ||
| 874 | u32 dp_op : 1; | ||
| 875 | u32 : 7; | ||
| 876 | } __attribute__((packed)); | ||
| 877 | |||
| 878 | union dp_mix_u { | ||
| 879 | u32 val : 32; | ||
| 880 | struct dp_mix_t f; | ||
| 881 | } __attribute__((packed)); | ||
| 882 | |||
| 883 | struct eng_cntl_t { | ||
| 884 | u32 erc_reg_rd_ws : 1; | ||
| 885 | u32 erc_reg_wr_ws : 1; | ||
| 886 | u32 erc_idle_reg_wr : 1; | ||
| 887 | u32 dis_engine_triggers : 1; | ||
| 888 | u32 dis_rop_src_uses_dst_w_h : 1; | ||
| 889 | u32 dis_src_uses_dst_dirmaj : 1; | ||
| 890 | u32 : 6; | ||
| 891 | u32 force_3dclk_when_2dclk : 1; | ||
| 892 | u32 : 19; | ||
| 893 | } __attribute__((packed)); | ||
| 894 | |||
| 895 | union eng_cntl_u { | ||
| 896 | u32 val : 32; | ||
| 897 | struct eng_cntl_t f; | ||
| 898 | } __attribute__((packed)); | ||
| 899 | |||
| 900 | struct dp_cntl_t { | ||
| 901 | u32 dst_x_dir : 1; | ||
| 902 | u32 dst_y_dir : 1; | ||
| 903 | u32 src_x_dir : 1; | ||
| 904 | u32 src_y_dir : 1; | ||
| 905 | u32 dst_major_x : 1; | ||
| 906 | u32 src_major_x : 1; | ||
| 907 | u32 : 26; | ||
| 908 | } __attribute__((packed)); | ||
| 909 | |||
| 910 | union dp_cntl_u { | ||
| 911 | u32 val : 32; | ||
| 912 | struct dp_cntl_t f; | ||
| 913 | } __attribute__((packed)); | ||
| 914 | |||
| 915 | struct dp_cntl_dst_dir_t { | ||
| 916 | u32 : 15; | ||
| 917 | u32 dst_y_dir : 1; | ||
| 918 | u32 : 15; | ||
| 919 | u32 dst_x_dir : 1; | ||
| 920 | } __attribute__((packed)); | ||
| 921 | |||
| 922 | union dp_cntl_dst_dir_u { | ||
| 923 | u32 val : 32; | ||
| 924 | struct dp_cntl_dst_dir_t f; | ||
| 925 | } __attribute__((packed)); | ||
| 926 | |||
| 769 | #endif | 927 | #endif |
| 770 | 928 | ||
