diff options
author | James Morris <jmorris@namei.org> | 2009-09-29 17:47:33 -0400 |
---|---|---|
committer | James Morris <jmorris@namei.org> | 2009-09-29 17:47:33 -0400 |
commit | 1669b049db50fc7f1d4e694fb115a0f408c63fce (patch) | |
tree | 9b3b90b5cbff9b8f30ecf0b2a44896ce8bef0c20 /drivers/char | |
parent | 7f366784f5c2b8fc0658b5b374f4c63ee42c789f (diff) | |
parent | 17d857be649a21ca90008c6dc425d849fa83db5c (diff) |
Merge branch 'master' into next
Diffstat (limited to 'drivers/char')
66 files changed, 2316 insertions, 2331 deletions
diff --git a/drivers/char/Kconfig b/drivers/char/Kconfig index 6a06913b01d3..08a6f50ae791 100644 --- a/drivers/char/Kconfig +++ b/drivers/char/Kconfig | |||
@@ -1087,6 +1087,14 @@ config MMTIMER | |||
1087 | The mmtimer device allows direct userspace access to the | 1087 | The mmtimer device allows direct userspace access to the |
1088 | Altix system timer. | 1088 | Altix system timer. |
1089 | 1089 | ||
1090 | config UV_MMTIMER | ||
1091 | tristate "UV_MMTIMER Memory mapped RTC for SGI UV" | ||
1092 | depends on X86_UV | ||
1093 | default m | ||
1094 | help | ||
1095 | The uv_mmtimer device allows direct userspace access to the | ||
1096 | UV system timer. | ||
1097 | |||
1090 | source "drivers/char/tpm/Kconfig" | 1098 | source "drivers/char/tpm/Kconfig" |
1091 | 1099 | ||
1092 | config TELCLOCK | 1100 | config TELCLOCK |
diff --git a/drivers/char/Makefile b/drivers/char/Makefile index 66f779ad4f4c..19a79dd79eee 100644 --- a/drivers/char/Makefile +++ b/drivers/char/Makefile | |||
@@ -58,6 +58,7 @@ obj-$(CONFIG_RAW_DRIVER) += raw.o | |||
58 | obj-$(CONFIG_SGI_SNSC) += snsc.o snsc_event.o | 58 | obj-$(CONFIG_SGI_SNSC) += snsc.o snsc_event.o |
59 | obj-$(CONFIG_MSPEC) += mspec.o | 59 | obj-$(CONFIG_MSPEC) += mspec.o |
60 | obj-$(CONFIG_MMTIMER) += mmtimer.o | 60 | obj-$(CONFIG_MMTIMER) += mmtimer.o |
61 | obj-$(CONFIG_UV_MMTIMER) += uv_mmtimer.o | ||
61 | obj-$(CONFIG_VIOTAPE) += viotape.o | 62 | obj-$(CONFIG_VIOTAPE) += viotape.o |
62 | obj-$(CONFIG_HVCS) += hvcs.o | 63 | obj-$(CONFIG_HVCS) += hvcs.o |
63 | obj-$(CONFIG_IBM_BSR) += bsr.o | 64 | obj-$(CONFIG_IBM_BSR) += bsr.o |
diff --git a/drivers/char/agp/agp.h b/drivers/char/agp/agp.h index 178e2e9e9f09..870f12cfed93 100644 --- a/drivers/char/agp/agp.h +++ b/drivers/char/agp/agp.h | |||
@@ -107,7 +107,7 @@ struct agp_bridge_driver { | |||
107 | void (*agp_enable)(struct agp_bridge_data *, u32); | 107 | void (*agp_enable)(struct agp_bridge_data *, u32); |
108 | void (*cleanup)(void); | 108 | void (*cleanup)(void); |
109 | void (*tlb_flush)(struct agp_memory *); | 109 | void (*tlb_flush)(struct agp_memory *); |
110 | unsigned long (*mask_memory)(struct agp_bridge_data *, struct page *, int); | 110 | unsigned long (*mask_memory)(struct agp_bridge_data *, dma_addr_t, int); |
111 | void (*cache_flush)(void); | 111 | void (*cache_flush)(void); |
112 | int (*create_gatt_table)(struct agp_bridge_data *); | 112 | int (*create_gatt_table)(struct agp_bridge_data *); |
113 | int (*free_gatt_table)(struct agp_bridge_data *); | 113 | int (*free_gatt_table)(struct agp_bridge_data *); |
@@ -121,12 +121,17 @@ struct agp_bridge_driver { | |||
121 | void (*agp_destroy_pages)(struct agp_memory *); | 121 | void (*agp_destroy_pages)(struct agp_memory *); |
122 | int (*agp_type_to_mask_type) (struct agp_bridge_data *, int); | 122 | int (*agp_type_to_mask_type) (struct agp_bridge_data *, int); |
123 | void (*chipset_flush)(struct agp_bridge_data *); | 123 | void (*chipset_flush)(struct agp_bridge_data *); |
124 | |||
125 | int (*agp_map_page)(struct page *page, dma_addr_t *ret); | ||
126 | void (*agp_unmap_page)(struct page *page, dma_addr_t dma); | ||
127 | int (*agp_map_memory)(struct agp_memory *mem); | ||
128 | void (*agp_unmap_memory)(struct agp_memory *mem); | ||
124 | }; | 129 | }; |
125 | 130 | ||
126 | struct agp_bridge_data { | 131 | struct agp_bridge_data { |
127 | const struct agp_version *version; | 132 | const struct agp_version *version; |
128 | const struct agp_bridge_driver *driver; | 133 | const struct agp_bridge_driver *driver; |
129 | struct vm_operations_struct *vm_ops; | 134 | const struct vm_operations_struct *vm_ops; |
130 | void *previous_size; | 135 | void *previous_size; |
131 | void *current_size; | 136 | void *current_size; |
132 | void *dev_private_data; | 137 | void *dev_private_data; |
@@ -134,7 +139,8 @@ struct agp_bridge_data { | |||
134 | u32 __iomem *gatt_table; | 139 | u32 __iomem *gatt_table; |
135 | u32 *gatt_table_real; | 140 | u32 *gatt_table_real; |
136 | unsigned long scratch_page; | 141 | unsigned long scratch_page; |
137 | unsigned long scratch_page_real; | 142 | struct page *scratch_page_page; |
143 | dma_addr_t scratch_page_dma; | ||
138 | unsigned long gart_bus_addr; | 144 | unsigned long gart_bus_addr; |
139 | unsigned long gatt_bus_addr; | 145 | unsigned long gatt_bus_addr; |
140 | u32 mode; | 146 | u32 mode; |
@@ -291,7 +297,7 @@ int agp_3_5_enable(struct agp_bridge_data *bridge); | |||
291 | void global_cache_flush(void); | 297 | void global_cache_flush(void); |
292 | void get_agp_version(struct agp_bridge_data *bridge); | 298 | void get_agp_version(struct agp_bridge_data *bridge); |
293 | unsigned long agp_generic_mask_memory(struct agp_bridge_data *bridge, | 299 | unsigned long agp_generic_mask_memory(struct agp_bridge_data *bridge, |
294 | struct page *page, int type); | 300 | dma_addr_t phys, int type); |
295 | int agp_generic_type_to_mask_type(struct agp_bridge_data *bridge, | 301 | int agp_generic_type_to_mask_type(struct agp_bridge_data *bridge, |
296 | int type); | 302 | int type); |
297 | struct agp_bridge_data *agp_generic_find_bridge(struct pci_dev *pdev); | 303 | struct agp_bridge_data *agp_generic_find_bridge(struct pci_dev *pdev); |
@@ -312,9 +318,6 @@ void agp3_generic_cleanup(void); | |||
312 | #define AGP_GENERIC_SIZES_ENTRIES 11 | 318 | #define AGP_GENERIC_SIZES_ENTRIES 11 |
313 | extern const struct aper_size_info_16 agp3_generic_sizes[]; | 319 | extern const struct aper_size_info_16 agp3_generic_sizes[]; |
314 | 320 | ||
315 | #define virt_to_gart(x) (phys_to_gart(virt_to_phys(x))) | ||
316 | #define gart_to_virt(x) (phys_to_virt(gart_to_phys(x))) | ||
317 | |||
318 | extern int agp_off; | 321 | extern int agp_off; |
319 | extern int agp_try_unsupported_boot; | 322 | extern int agp_try_unsupported_boot; |
320 | 323 | ||
diff --git a/drivers/char/agp/ali-agp.c b/drivers/char/agp/ali-agp.c index 201ef3ffd484..d2ce68f27e4b 100644 --- a/drivers/char/agp/ali-agp.c +++ b/drivers/char/agp/ali-agp.c | |||
@@ -152,7 +152,7 @@ static struct page *m1541_alloc_page(struct agp_bridge_data *bridge) | |||
152 | pci_read_config_dword(agp_bridge->dev, ALI_CACHE_FLUSH_CTRL, &temp); | 152 | pci_read_config_dword(agp_bridge->dev, ALI_CACHE_FLUSH_CTRL, &temp); |
153 | pci_write_config_dword(agp_bridge->dev, ALI_CACHE_FLUSH_CTRL, | 153 | pci_write_config_dword(agp_bridge->dev, ALI_CACHE_FLUSH_CTRL, |
154 | (((temp & ALI_CACHE_FLUSH_ADDR_MASK) | | 154 | (((temp & ALI_CACHE_FLUSH_ADDR_MASK) | |
155 | phys_to_gart(page_to_phys(page))) | ALI_CACHE_FLUSH_EN )); | 155 | page_to_phys(page)) | ALI_CACHE_FLUSH_EN )); |
156 | return page; | 156 | return page; |
157 | } | 157 | } |
158 | 158 | ||
@@ -180,7 +180,7 @@ static void m1541_destroy_page(struct page *page, int flags) | |||
180 | pci_read_config_dword(agp_bridge->dev, ALI_CACHE_FLUSH_CTRL, &temp); | 180 | pci_read_config_dword(agp_bridge->dev, ALI_CACHE_FLUSH_CTRL, &temp); |
181 | pci_write_config_dword(agp_bridge->dev, ALI_CACHE_FLUSH_CTRL, | 181 | pci_write_config_dword(agp_bridge->dev, ALI_CACHE_FLUSH_CTRL, |
182 | (((temp & ALI_CACHE_FLUSH_ADDR_MASK) | | 182 | (((temp & ALI_CACHE_FLUSH_ADDR_MASK) | |
183 | phys_to_gart(page_to_phys(page))) | ALI_CACHE_FLUSH_EN)); | 183 | page_to_phys(page)) | ALI_CACHE_FLUSH_EN)); |
184 | } | 184 | } |
185 | agp_generic_destroy_page(page, flags); | 185 | agp_generic_destroy_page(page, flags); |
186 | } | 186 | } |
diff --git a/drivers/char/agp/alpha-agp.c b/drivers/char/agp/alpha-agp.c index 5ea4da8e9954..dd84af4d4f7e 100644 --- a/drivers/char/agp/alpha-agp.c +++ b/drivers/char/agp/alpha-agp.c | |||
@@ -40,7 +40,7 @@ static struct aper_size_info_fixed alpha_core_agp_sizes[] = | |||
40 | { 0, 0, 0 }, /* filled in by alpha_core_agp_setup */ | 40 | { 0, 0, 0 }, /* filled in by alpha_core_agp_setup */ |
41 | }; | 41 | }; |
42 | 42 | ||
43 | struct vm_operations_struct alpha_core_agp_vm_ops = { | 43 | static const struct vm_operations_struct alpha_core_agp_vm_ops = { |
44 | .fault = alpha_core_agp_vm_fault, | 44 | .fault = alpha_core_agp_vm_fault, |
45 | }; | 45 | }; |
46 | 46 | ||
diff --git a/drivers/char/agp/amd-k7-agp.c b/drivers/char/agp/amd-k7-agp.c index ba9bde71eaaf..73dbf40c874d 100644 --- a/drivers/char/agp/amd-k7-agp.c +++ b/drivers/char/agp/amd-k7-agp.c | |||
@@ -44,7 +44,7 @@ static int amd_create_page_map(struct amd_page_map *page_map) | |||
44 | #ifndef CONFIG_X86 | 44 | #ifndef CONFIG_X86 |
45 | SetPageReserved(virt_to_page(page_map->real)); | 45 | SetPageReserved(virt_to_page(page_map->real)); |
46 | global_cache_flush(); | 46 | global_cache_flush(); |
47 | page_map->remapped = ioremap_nocache(virt_to_gart(page_map->real), | 47 | page_map->remapped = ioremap_nocache(virt_to_phys(page_map->real), |
48 | PAGE_SIZE); | 48 | PAGE_SIZE); |
49 | if (page_map->remapped == NULL) { | 49 | if (page_map->remapped == NULL) { |
50 | ClearPageReserved(virt_to_page(page_map->real)); | 50 | ClearPageReserved(virt_to_page(page_map->real)); |
@@ -160,7 +160,7 @@ static int amd_create_gatt_table(struct agp_bridge_data *bridge) | |||
160 | 160 | ||
161 | agp_bridge->gatt_table_real = (u32 *)page_dir.real; | 161 | agp_bridge->gatt_table_real = (u32 *)page_dir.real; |
162 | agp_bridge->gatt_table = (u32 __iomem *)page_dir.remapped; | 162 | agp_bridge->gatt_table = (u32 __iomem *)page_dir.remapped; |
163 | agp_bridge->gatt_bus_addr = virt_to_gart(page_dir.real); | 163 | agp_bridge->gatt_bus_addr = virt_to_phys(page_dir.real); |
164 | 164 | ||
165 | /* Get the address for the gart region. | 165 | /* Get the address for the gart region. |
166 | * This is a bus address even on the alpha, b/c its | 166 | * This is a bus address even on the alpha, b/c its |
@@ -173,7 +173,7 @@ static int amd_create_gatt_table(struct agp_bridge_data *bridge) | |||
173 | 173 | ||
174 | /* Calculate the agp offset */ | 174 | /* Calculate the agp offset */ |
175 | for (i = 0; i < value->num_entries / 1024; i++, addr += 0x00400000) { | 175 | for (i = 0; i < value->num_entries / 1024; i++, addr += 0x00400000) { |
176 | writel(virt_to_gart(amd_irongate_private.gatt_pages[i]->real) | 1, | 176 | writel(virt_to_phys(amd_irongate_private.gatt_pages[i]->real) | 1, |
177 | page_dir.remapped+GET_PAGE_DIR_OFF(addr)); | 177 | page_dir.remapped+GET_PAGE_DIR_OFF(addr)); |
178 | readl(page_dir.remapped+GET_PAGE_DIR_OFF(addr)); /* PCI Posting. */ | 178 | readl(page_dir.remapped+GET_PAGE_DIR_OFF(addr)); /* PCI Posting. */ |
179 | } | 179 | } |
@@ -325,7 +325,9 @@ static int amd_insert_memory(struct agp_memory *mem, off_t pg_start, int type) | |||
325 | addr = (j * PAGE_SIZE) + agp_bridge->gart_bus_addr; | 325 | addr = (j * PAGE_SIZE) + agp_bridge->gart_bus_addr; |
326 | cur_gatt = GET_GATT(addr); | 326 | cur_gatt = GET_GATT(addr); |
327 | writel(agp_generic_mask_memory(agp_bridge, | 327 | writel(agp_generic_mask_memory(agp_bridge, |
328 | mem->pages[i], mem->type), cur_gatt+GET_GATT_OFF(addr)); | 328 | page_to_phys(mem->pages[i]), |
329 | mem->type), | ||
330 | cur_gatt+GET_GATT_OFF(addr)); | ||
329 | readl(cur_gatt+GET_GATT_OFF(addr)); /* PCI Posting. */ | 331 | readl(cur_gatt+GET_GATT_OFF(addr)); /* PCI Posting. */ |
330 | } | 332 | } |
331 | amd_irongate_tlbflush(mem); | 333 | amd_irongate_tlbflush(mem); |
diff --git a/drivers/char/agp/amd64-agp.c b/drivers/char/agp/amd64-agp.c index 3bf5dda90f4a..2fb2e6cc322a 100644 --- a/drivers/char/agp/amd64-agp.c +++ b/drivers/char/agp/amd64-agp.c | |||
@@ -79,7 +79,8 @@ static int amd64_insert_memory(struct agp_memory *mem, off_t pg_start, int type) | |||
79 | 79 | ||
80 | for (i = 0, j = pg_start; i < mem->page_count; i++, j++) { | 80 | for (i = 0, j = pg_start; i < mem->page_count; i++, j++) { |
81 | tmp = agp_bridge->driver->mask_memory(agp_bridge, | 81 | tmp = agp_bridge->driver->mask_memory(agp_bridge, |
82 | mem->pages[i], mask_type); | 82 | page_to_phys(mem->pages[i]), |
83 | mask_type); | ||
83 | 84 | ||
84 | BUG_ON(tmp & 0xffffff0000000ffcULL); | 85 | BUG_ON(tmp & 0xffffff0000000ffcULL); |
85 | pte = (tmp & 0x000000ff00000000ULL) >> 28; | 86 | pte = (tmp & 0x000000ff00000000ULL) >> 28; |
@@ -177,7 +178,7 @@ static const struct aper_size_info_32 amd_8151_sizes[7] = | |||
177 | 178 | ||
178 | static int amd_8151_configure(void) | 179 | static int amd_8151_configure(void) |
179 | { | 180 | { |
180 | unsigned long gatt_bus = virt_to_gart(agp_bridge->gatt_table_real); | 181 | unsigned long gatt_bus = virt_to_phys(agp_bridge->gatt_table_real); |
181 | int i; | 182 | int i; |
182 | 183 | ||
183 | /* Configure AGP regs in each x86-64 host bridge. */ | 184 | /* Configure AGP regs in each x86-64 host bridge. */ |
@@ -557,7 +558,7 @@ static void __devexit agp_amd64_remove(struct pci_dev *pdev) | |||
557 | { | 558 | { |
558 | struct agp_bridge_data *bridge = pci_get_drvdata(pdev); | 559 | struct agp_bridge_data *bridge = pci_get_drvdata(pdev); |
559 | 560 | ||
560 | release_mem_region(virt_to_gart(bridge->gatt_table_real), | 561 | release_mem_region(virt_to_phys(bridge->gatt_table_real), |
561 | amd64_aperture_sizes[bridge->aperture_size_idx].size); | 562 | amd64_aperture_sizes[bridge->aperture_size_idx].size); |
562 | agp_remove_bridge(bridge); | 563 | agp_remove_bridge(bridge); |
563 | agp_put_bridge(bridge); | 564 | agp_put_bridge(bridge); |
diff --git a/drivers/char/agp/ati-agp.c b/drivers/char/agp/ati-agp.c index 33656e144cc5..3b2ecbe86ebe 100644 --- a/drivers/char/agp/ati-agp.c +++ b/drivers/char/agp/ati-agp.c | |||
@@ -302,7 +302,8 @@ static int ati_insert_memory(struct agp_memory * mem, | |||
302 | addr = (j * PAGE_SIZE) + agp_bridge->gart_bus_addr; | 302 | addr = (j * PAGE_SIZE) + agp_bridge->gart_bus_addr; |
303 | cur_gatt = GET_GATT(addr); | 303 | cur_gatt = GET_GATT(addr); |
304 | writel(agp_bridge->driver->mask_memory(agp_bridge, | 304 | writel(agp_bridge->driver->mask_memory(agp_bridge, |
305 | mem->pages[i], mem->type), | 305 | page_to_phys(mem->pages[i]), |
306 | mem->type), | ||
306 | cur_gatt+GET_GATT_OFF(addr)); | 307 | cur_gatt+GET_GATT_OFF(addr)); |
307 | } | 308 | } |
308 | readl(GET_GATT(agp_bridge->gart_bus_addr)); /* PCI posting */ | 309 | readl(GET_GATT(agp_bridge->gart_bus_addr)); /* PCI posting */ |
@@ -359,7 +360,7 @@ static int ati_create_gatt_table(struct agp_bridge_data *bridge) | |||
359 | 360 | ||
360 | agp_bridge->gatt_table_real = (u32 *)page_dir.real; | 361 | agp_bridge->gatt_table_real = (u32 *)page_dir.real; |
361 | agp_bridge->gatt_table = (u32 __iomem *) page_dir.remapped; | 362 | agp_bridge->gatt_table = (u32 __iomem *) page_dir.remapped; |
362 | agp_bridge->gatt_bus_addr = virt_to_gart(page_dir.real); | 363 | agp_bridge->gatt_bus_addr = virt_to_phys(page_dir.real); |
363 | 364 | ||
364 | /* Write out the size register */ | 365 | /* Write out the size register */ |
365 | current_size = A_SIZE_LVL2(agp_bridge->current_size); | 366 | current_size = A_SIZE_LVL2(agp_bridge->current_size); |
@@ -389,7 +390,7 @@ static int ati_create_gatt_table(struct agp_bridge_data *bridge) | |||
389 | 390 | ||
390 | /* Calculate the agp offset */ | 391 | /* Calculate the agp offset */ |
391 | for (i = 0; i < value->num_entries / 1024; i++, addr += 0x00400000) { | 392 | for (i = 0; i < value->num_entries / 1024; i++, addr += 0x00400000) { |
392 | writel(virt_to_gart(ati_generic_private.gatt_pages[i]->real) | 1, | 393 | writel(virt_to_phys(ati_generic_private.gatt_pages[i]->real) | 1, |
393 | page_dir.remapped+GET_PAGE_DIR_OFF(addr)); | 394 | page_dir.remapped+GET_PAGE_DIR_OFF(addr)); |
394 | readl(page_dir.remapped+GET_PAGE_DIR_OFF(addr)); /* PCI Posting. */ | 395 | readl(page_dir.remapped+GET_PAGE_DIR_OFF(addr)); /* PCI Posting. */ |
395 | } | 396 | } |
diff --git a/drivers/char/agp/backend.c b/drivers/char/agp/backend.c index cfa5a649dfe7..a56ca080e108 100644 --- a/drivers/char/agp/backend.c +++ b/drivers/char/agp/backend.c | |||
@@ -114,9 +114,9 @@ static int agp_find_max(void) | |||
114 | long memory, index, result; | 114 | long memory, index, result; |
115 | 115 | ||
116 | #if PAGE_SHIFT < 20 | 116 | #if PAGE_SHIFT < 20 |
117 | memory = num_physpages >> (20 - PAGE_SHIFT); | 117 | memory = totalram_pages >> (20 - PAGE_SHIFT); |
118 | #else | 118 | #else |
119 | memory = num_physpages << (PAGE_SHIFT - 20); | 119 | memory = totalram_pages << (PAGE_SHIFT - 20); |
120 | #endif | 120 | #endif |
121 | index = 1; | 121 | index = 1; |
122 | 122 | ||
@@ -149,9 +149,21 @@ static int agp_backend_initialize(struct agp_bridge_data *bridge) | |||
149 | return -ENOMEM; | 149 | return -ENOMEM; |
150 | } | 150 | } |
151 | 151 | ||
152 | bridge->scratch_page_real = phys_to_gart(page_to_phys(page)); | 152 | bridge->scratch_page_page = page; |
153 | bridge->scratch_page = | 153 | if (bridge->driver->agp_map_page) { |
154 | bridge->driver->mask_memory(bridge, page, 0); | 154 | if (bridge->driver->agp_map_page(page, |
155 | &bridge->scratch_page_dma)) { | ||
156 | dev_err(&bridge->dev->dev, | ||
157 | "unable to dma-map scratch page\n"); | ||
158 | rc = -ENOMEM; | ||
159 | goto err_out_nounmap; | ||
160 | } | ||
161 | } else { | ||
162 | bridge->scratch_page_dma = page_to_phys(page); | ||
163 | } | ||
164 | |||
165 | bridge->scratch_page = bridge->driver->mask_memory(bridge, | ||
166 | bridge->scratch_page_dma, 0); | ||
155 | } | 167 | } |
156 | 168 | ||
157 | size_value = bridge->driver->fetch_size(); | 169 | size_value = bridge->driver->fetch_size(); |
@@ -191,8 +203,14 @@ static int agp_backend_initialize(struct agp_bridge_data *bridge) | |||
191 | return 0; | 203 | return 0; |
192 | 204 | ||
193 | err_out: | 205 | err_out: |
206 | if (bridge->driver->needs_scratch_page && | ||
207 | bridge->driver->agp_unmap_page) { | ||
208 | bridge->driver->agp_unmap_page(bridge->scratch_page_page, | ||
209 | bridge->scratch_page_dma); | ||
210 | } | ||
211 | err_out_nounmap: | ||
194 | if (bridge->driver->needs_scratch_page) { | 212 | if (bridge->driver->needs_scratch_page) { |
195 | void *va = gart_to_virt(bridge->scratch_page_real); | 213 | void *va = page_address(bridge->scratch_page_page); |
196 | 214 | ||
197 | bridge->driver->agp_destroy_page(va, AGP_PAGE_DESTROY_UNMAP); | 215 | bridge->driver->agp_destroy_page(va, AGP_PAGE_DESTROY_UNMAP); |
198 | bridge->driver->agp_destroy_page(va, AGP_PAGE_DESTROY_FREE); | 216 | bridge->driver->agp_destroy_page(va, AGP_PAGE_DESTROY_FREE); |
@@ -219,7 +237,11 @@ static void agp_backend_cleanup(struct agp_bridge_data *bridge) | |||
219 | 237 | ||
220 | if (bridge->driver->agp_destroy_page && | 238 | if (bridge->driver->agp_destroy_page && |
221 | bridge->driver->needs_scratch_page) { | 239 | bridge->driver->needs_scratch_page) { |
222 | void *va = gart_to_virt(bridge->scratch_page_real); | 240 | void *va = page_address(bridge->scratch_page_page); |
241 | |||
242 | if (bridge->driver->agp_unmap_page) | ||
243 | bridge->driver->agp_unmap_page(bridge->scratch_page_page, | ||
244 | bridge->scratch_page_dma); | ||
223 | 245 | ||
224 | bridge->driver->agp_destroy_page(va, AGP_PAGE_DESTROY_UNMAP); | 246 | bridge->driver->agp_destroy_page(va, AGP_PAGE_DESTROY_UNMAP); |
225 | bridge->driver->agp_destroy_page(va, AGP_PAGE_DESTROY_FREE); | 247 | bridge->driver->agp_destroy_page(va, AGP_PAGE_DESTROY_FREE); |
diff --git a/drivers/char/agp/efficeon-agp.c b/drivers/char/agp/efficeon-agp.c index 35d50f2861b6..793f39ea9618 100644 --- a/drivers/char/agp/efficeon-agp.c +++ b/drivers/char/agp/efficeon-agp.c | |||
@@ -67,7 +67,7 @@ static const struct gatt_mask efficeon_generic_masks[] = | |||
67 | /* This function does the same thing as mask_memory() for this chipset... */ | 67 | /* This function does the same thing as mask_memory() for this chipset... */ |
68 | static inline unsigned long efficeon_mask_memory(struct page *page) | 68 | static inline unsigned long efficeon_mask_memory(struct page *page) |
69 | { | 69 | { |
70 | unsigned long addr = phys_to_gart(page_to_phys(page)); | 70 | unsigned long addr = page_to_phys(page); |
71 | return addr | 0x00000001; | 71 | return addr | 0x00000001; |
72 | } | 72 | } |
73 | 73 | ||
@@ -226,7 +226,7 @@ static int efficeon_create_gatt_table(struct agp_bridge_data *bridge) | |||
226 | 226 | ||
227 | efficeon_private.l1_table[index] = page; | 227 | efficeon_private.l1_table[index] = page; |
228 | 228 | ||
229 | value = virt_to_gart((unsigned long *)page) | pati | present | index; | 229 | value = virt_to_phys((unsigned long *)page) | pati | present | index; |
230 | 230 | ||
231 | pci_write_config_dword(agp_bridge->dev, | 231 | pci_write_config_dword(agp_bridge->dev, |
232 | EFFICEON_ATTPAGE, value); | 232 | EFFICEON_ATTPAGE, value); |
diff --git a/drivers/char/agp/generic.c b/drivers/char/agp/generic.c index 1e8b461b91f1..c50543966eb2 100644 --- a/drivers/char/agp/generic.c +++ b/drivers/char/agp/generic.c | |||
@@ -437,6 +437,12 @@ int agp_bind_memory(struct agp_memory *curr, off_t pg_start) | |||
437 | curr->bridge->driver->cache_flush(); | 437 | curr->bridge->driver->cache_flush(); |
438 | curr->is_flushed = true; | 438 | curr->is_flushed = true; |
439 | } | 439 | } |
440 | |||
441 | if (curr->bridge->driver->agp_map_memory) { | ||
442 | ret_val = curr->bridge->driver->agp_map_memory(curr); | ||
443 | if (ret_val) | ||
444 | return ret_val; | ||
445 | } | ||
440 | ret_val = curr->bridge->driver->insert_memory(curr, pg_start, curr->type); | 446 | ret_val = curr->bridge->driver->insert_memory(curr, pg_start, curr->type); |
441 | 447 | ||
442 | if (ret_val != 0) | 448 | if (ret_val != 0) |
@@ -478,6 +484,9 @@ int agp_unbind_memory(struct agp_memory *curr) | |||
478 | if (ret_val != 0) | 484 | if (ret_val != 0) |
479 | return ret_val; | 485 | return ret_val; |
480 | 486 | ||
487 | if (curr->bridge->driver->agp_unmap_memory) | ||
488 | curr->bridge->driver->agp_unmap_memory(curr); | ||
489 | |||
481 | curr->is_bound = false; | 490 | curr->is_bound = false; |
482 | curr->pg_start = 0; | 491 | curr->pg_start = 0; |
483 | spin_lock(&curr->bridge->mapped_lock); | 492 | spin_lock(&curr->bridge->mapped_lock); |
@@ -979,7 +988,7 @@ int agp_generic_create_gatt_table(struct agp_bridge_data *bridge) | |||
979 | set_memory_uc((unsigned long)table, 1 << page_order); | 988 | set_memory_uc((unsigned long)table, 1 << page_order); |
980 | bridge->gatt_table = (void *)table; | 989 | bridge->gatt_table = (void *)table; |
981 | #else | 990 | #else |
982 | bridge->gatt_table = ioremap_nocache(virt_to_gart(table), | 991 | bridge->gatt_table = ioremap_nocache(virt_to_phys(table), |
983 | (PAGE_SIZE * (1 << page_order))); | 992 | (PAGE_SIZE * (1 << page_order))); |
984 | bridge->driver->cache_flush(); | 993 | bridge->driver->cache_flush(); |
985 | #endif | 994 | #endif |
@@ -992,7 +1001,7 @@ int agp_generic_create_gatt_table(struct agp_bridge_data *bridge) | |||
992 | 1001 | ||
993 | return -ENOMEM; | 1002 | return -ENOMEM; |
994 | } | 1003 | } |
995 | bridge->gatt_bus_addr = virt_to_gart(bridge->gatt_table_real); | 1004 | bridge->gatt_bus_addr = virt_to_phys(bridge->gatt_table_real); |
996 | 1005 | ||
997 | /* AK: bogus, should encode addresses > 4GB */ | 1006 | /* AK: bogus, should encode addresses > 4GB */ |
998 | for (i = 0; i < num_entries; i++) { | 1007 | for (i = 0; i < num_entries; i++) { |
@@ -1132,7 +1141,9 @@ int agp_generic_insert_memory(struct agp_memory * mem, off_t pg_start, int type) | |||
1132 | } | 1141 | } |
1133 | 1142 | ||
1134 | for (i = 0, j = pg_start; i < mem->page_count; i++, j++) { | 1143 | for (i = 0, j = pg_start; i < mem->page_count; i++, j++) { |
1135 | writel(bridge->driver->mask_memory(bridge, mem->pages[i], mask_type), | 1144 | writel(bridge->driver->mask_memory(bridge, |
1145 | page_to_phys(mem->pages[i]), | ||
1146 | mask_type), | ||
1136 | bridge->gatt_table+j); | 1147 | bridge->gatt_table+j); |
1137 | } | 1148 | } |
1138 | readl(bridge->gatt_table+j-1); /* PCI Posting. */ | 1149 | readl(bridge->gatt_table+j-1); /* PCI Posting. */ |
@@ -1347,9 +1358,8 @@ void global_cache_flush(void) | |||
1347 | EXPORT_SYMBOL(global_cache_flush); | 1358 | EXPORT_SYMBOL(global_cache_flush); |
1348 | 1359 | ||
1349 | unsigned long agp_generic_mask_memory(struct agp_bridge_data *bridge, | 1360 | unsigned long agp_generic_mask_memory(struct agp_bridge_data *bridge, |
1350 | struct page *page, int type) | 1361 | dma_addr_t addr, int type) |
1351 | { | 1362 | { |
1352 | unsigned long addr = phys_to_gart(page_to_phys(page)); | ||
1353 | /* memory type is ignored in the generic routine */ | 1363 | /* memory type is ignored in the generic routine */ |
1354 | if (bridge->driver->masks) | 1364 | if (bridge->driver->masks) |
1355 | return addr | bridge->driver->masks[0].mask; | 1365 | return addr | bridge->driver->masks[0].mask; |
diff --git a/drivers/char/agp/hp-agp.c b/drivers/char/agp/hp-agp.c index 8f3d4c184914..9047b2714653 100644 --- a/drivers/char/agp/hp-agp.c +++ b/drivers/char/agp/hp-agp.c | |||
@@ -107,7 +107,7 @@ static int __init hp_zx1_ioc_shared(void) | |||
107 | hp->gart_size = HP_ZX1_GART_SIZE; | 107 | hp->gart_size = HP_ZX1_GART_SIZE; |
108 | hp->gatt_entries = hp->gart_size / hp->io_page_size; | 108 | hp->gatt_entries = hp->gart_size / hp->io_page_size; |
109 | 109 | ||
110 | hp->io_pdir = gart_to_virt(readq(hp->ioc_regs+HP_ZX1_PDIR_BASE)); | 110 | hp->io_pdir = phys_to_virt(readq(hp->ioc_regs+HP_ZX1_PDIR_BASE)); |
111 | hp->gatt = &hp->io_pdir[HP_ZX1_IOVA_TO_PDIR(hp->gart_base)]; | 111 | hp->gatt = &hp->io_pdir[HP_ZX1_IOVA_TO_PDIR(hp->gart_base)]; |
112 | 112 | ||
113 | if (hp->gatt[0] != HP_ZX1_SBA_IOMMU_COOKIE) { | 113 | if (hp->gatt[0] != HP_ZX1_SBA_IOMMU_COOKIE) { |
@@ -246,7 +246,7 @@ hp_zx1_configure (void) | |||
246 | agp_bridge->mode = readl(hp->lba_regs+hp->lba_cap_offset+PCI_AGP_STATUS); | 246 | agp_bridge->mode = readl(hp->lba_regs+hp->lba_cap_offset+PCI_AGP_STATUS); |
247 | 247 | ||
248 | if (hp->io_pdir_owner) { | 248 | if (hp->io_pdir_owner) { |
249 | writel(virt_to_gart(hp->io_pdir), hp->ioc_regs+HP_ZX1_PDIR_BASE); | 249 | writel(virt_to_phys(hp->io_pdir), hp->ioc_regs+HP_ZX1_PDIR_BASE); |
250 | readl(hp->ioc_regs+HP_ZX1_PDIR_BASE); | 250 | readl(hp->ioc_regs+HP_ZX1_PDIR_BASE); |
251 | writel(hp->io_tlb_ps, hp->ioc_regs+HP_ZX1_TCNFG); | 251 | writel(hp->io_tlb_ps, hp->ioc_regs+HP_ZX1_TCNFG); |
252 | readl(hp->ioc_regs+HP_ZX1_TCNFG); | 252 | readl(hp->ioc_regs+HP_ZX1_TCNFG); |
@@ -394,10 +394,8 @@ hp_zx1_remove_memory (struct agp_memory *mem, off_t pg_start, int type) | |||
394 | } | 394 | } |
395 | 395 | ||
396 | static unsigned long | 396 | static unsigned long |
397 | hp_zx1_mask_memory (struct agp_bridge_data *bridge, | 397 | hp_zx1_mask_memory (struct agp_bridge_data *bridge, dma_addr_t addr, int type) |
398 | struct page *page, int type) | ||
399 | { | 398 | { |
400 | unsigned long addr = phys_to_gart(page_to_phys(page)); | ||
401 | return HP_ZX1_PDIR_VALID_BIT | addr; | 399 | return HP_ZX1_PDIR_VALID_BIT | addr; |
402 | } | 400 | } |
403 | 401 | ||
@@ -478,7 +476,6 @@ zx1_gart_probe (acpi_handle obj, u32 depth, void *context, void **ret) | |||
478 | { | 476 | { |
479 | acpi_handle handle, parent; | 477 | acpi_handle handle, parent; |
480 | acpi_status status; | 478 | acpi_status status; |
481 | struct acpi_buffer buffer; | ||
482 | struct acpi_device_info *info; | 479 | struct acpi_device_info *info; |
483 | u64 lba_hpa, sba_hpa, length; | 480 | u64 lba_hpa, sba_hpa, length; |
484 | int match; | 481 | int match; |
@@ -490,13 +487,11 @@ zx1_gart_probe (acpi_handle obj, u32 depth, void *context, void **ret) | |||
490 | /* Look for an enclosing IOC scope and find its CSR space */ | 487 | /* Look for an enclosing IOC scope and find its CSR space */ |
491 | handle = obj; | 488 | handle = obj; |
492 | do { | 489 | do { |
493 | buffer.length = ACPI_ALLOCATE_LOCAL_BUFFER; | 490 | status = acpi_get_object_info(handle, &info); |
494 | status = acpi_get_object_info(handle, &buffer); | ||
495 | if (ACPI_SUCCESS(status)) { | 491 | if (ACPI_SUCCESS(status)) { |
496 | /* TBD check _CID also */ | 492 | /* TBD check _CID also */ |
497 | info = buffer.pointer; | 493 | info->hardware_id.string[sizeof(info->hardware_id.length)-1] = '\0'; |
498 | info->hardware_id.value[sizeof(info->hardware_id)-1] = '\0'; | 494 | match = (strcmp(info->hardware_id.string, "HWP0001") == 0); |
499 | match = (strcmp(info->hardware_id.value, "HWP0001") == 0); | ||
500 | kfree(info); | 495 | kfree(info); |
501 | if (match) { | 496 | if (match) { |
502 | status = hp_acpi_csr_space(handle, &sba_hpa, &length); | 497 | status = hp_acpi_csr_space(handle, &sba_hpa, &length); |
diff --git a/drivers/char/agp/i460-agp.c b/drivers/char/agp/i460-agp.c index 60cc35bb5db7..e763d3312ce7 100644 --- a/drivers/char/agp/i460-agp.c +++ b/drivers/char/agp/i460-agp.c | |||
@@ -61,7 +61,7 @@ | |||
61 | #define WR_FLUSH_GATT(index) RD_GATT(index) | 61 | #define WR_FLUSH_GATT(index) RD_GATT(index) |
62 | 62 | ||
63 | static unsigned long i460_mask_memory (struct agp_bridge_data *bridge, | 63 | static unsigned long i460_mask_memory (struct agp_bridge_data *bridge, |
64 | unsigned long addr, int type); | 64 | dma_addr_t addr, int type); |
65 | 65 | ||
66 | static struct { | 66 | static struct { |
67 | void *gatt; /* ioremap'd GATT area */ | 67 | void *gatt; /* ioremap'd GATT area */ |
@@ -325,7 +325,7 @@ static int i460_insert_memory_small_io_page (struct agp_memory *mem, | |||
325 | 325 | ||
326 | io_page_size = 1UL << I460_IO_PAGE_SHIFT; | 326 | io_page_size = 1UL << I460_IO_PAGE_SHIFT; |
327 | for (i = 0, j = io_pg_start; i < mem->page_count; i++) { | 327 | for (i = 0, j = io_pg_start; i < mem->page_count; i++) { |
328 | paddr = phys_to_gart(page_to_phys(mem->pages[i])); | 328 | paddr = page_to_phys(mem->pages[i]); |
329 | for (k = 0; k < I460_IOPAGES_PER_KPAGE; k++, j++, paddr += io_page_size) | 329 | for (k = 0; k < I460_IOPAGES_PER_KPAGE; k++, j++, paddr += io_page_size) |
330 | WR_GATT(j, i460_mask_memory(agp_bridge, paddr, mem->type)); | 330 | WR_GATT(j, i460_mask_memory(agp_bridge, paddr, mem->type)); |
331 | } | 331 | } |
@@ -382,7 +382,7 @@ static int i460_alloc_large_page (struct lp_desc *lp) | |||
382 | return -ENOMEM; | 382 | return -ENOMEM; |
383 | } | 383 | } |
384 | 384 | ||
385 | lp->paddr = phys_to_gart(page_to_phys(lp->page)); | 385 | lp->paddr = page_to_phys(lp->page); |
386 | lp->refcount = 0; | 386 | lp->refcount = 0; |
387 | atomic_add(I460_KPAGES_PER_IOPAGE, &agp_bridge->current_memory_agp); | 387 | atomic_add(I460_KPAGES_PER_IOPAGE, &agp_bridge->current_memory_agp); |
388 | return 0; | 388 | return 0; |
@@ -546,20 +546,13 @@ static void i460_destroy_page (struct page *page, int flags) | |||
546 | #endif /* I460_LARGE_IO_PAGES */ | 546 | #endif /* I460_LARGE_IO_PAGES */ |
547 | 547 | ||
548 | static unsigned long i460_mask_memory (struct agp_bridge_data *bridge, | 548 | static unsigned long i460_mask_memory (struct agp_bridge_data *bridge, |
549 | unsigned long addr, int type) | 549 | dma_addr_t addr, int type) |
550 | { | 550 | { |
551 | /* Make sure the returned address is a valid GATT entry */ | 551 | /* Make sure the returned address is a valid GATT entry */ |
552 | return bridge->driver->masks[0].mask | 552 | return bridge->driver->masks[0].mask |
553 | | (((addr & ~((1 << I460_IO_PAGE_SHIFT) - 1)) & 0xfffff000) >> 12); | 553 | | (((addr & ~((1 << I460_IO_PAGE_SHIFT) - 1)) & 0xfffff000) >> 12); |
554 | } | 554 | } |
555 | 555 | ||
556 | static unsigned long i460_page_mask_memory(struct agp_bridge_data *bridge, | ||
557 | struct page *page, int type) | ||
558 | { | ||
559 | unsigned long addr = phys_to_gart(page_to_phys(page)); | ||
560 | return i460_mask_memory(bridge, addr, type); | ||
561 | } | ||
562 | |||
563 | const struct agp_bridge_driver intel_i460_driver = { | 556 | const struct agp_bridge_driver intel_i460_driver = { |
564 | .owner = THIS_MODULE, | 557 | .owner = THIS_MODULE, |
565 | .aperture_sizes = i460_sizes, | 558 | .aperture_sizes = i460_sizes, |
@@ -569,7 +562,7 @@ const struct agp_bridge_driver intel_i460_driver = { | |||
569 | .fetch_size = i460_fetch_size, | 562 | .fetch_size = i460_fetch_size, |
570 | .cleanup = i460_cleanup, | 563 | .cleanup = i460_cleanup, |
571 | .tlb_flush = i460_tlb_flush, | 564 | .tlb_flush = i460_tlb_flush, |
572 | .mask_memory = i460_page_mask_memory, | 565 | .mask_memory = i460_mask_memory, |
573 | .masks = i460_masks, | 566 | .masks = i460_masks, |
574 | .agp_enable = agp_generic_enable, | 567 | .agp_enable = agp_generic_enable, |
575 | .cache_flush = global_cache_flush, | 568 | .cache_flush = global_cache_flush, |
diff --git a/drivers/char/agp/intel-agp.c b/drivers/char/agp/intel-agp.c index c58557790585..4068467ce7b9 100644 --- a/drivers/char/agp/intel-agp.c +++ b/drivers/char/agp/intel-agp.c | |||
@@ -10,6 +10,16 @@ | |||
10 | #include <linux/agp_backend.h> | 10 | #include <linux/agp_backend.h> |
11 | #include "agp.h" | 11 | #include "agp.h" |
12 | 12 | ||
13 | /* | ||
14 | * If we have Intel graphics, we're not going to have anything other than | ||
15 | * an Intel IOMMU. So make the correct use of the PCI DMA API contingent | ||
16 | * on the Intel IOMMU support (CONFIG_DMAR). | ||
17 | * Only newer chipsets need to bother with this, of course. | ||
18 | */ | ||
19 | #ifdef CONFIG_DMAR | ||
20 | #define USE_PCI_DMA_API 1 | ||
21 | #endif | ||
22 | |||
13 | #define PCI_DEVICE_ID_INTEL_E7221_HB 0x2588 | 23 | #define PCI_DEVICE_ID_INTEL_E7221_HB 0x2588 |
14 | #define PCI_DEVICE_ID_INTEL_E7221_IG 0x258a | 24 | #define PCI_DEVICE_ID_INTEL_E7221_IG 0x258a |
15 | #define PCI_DEVICE_ID_INTEL_82946GZ_HB 0x2970 | 25 | #define PCI_DEVICE_ID_INTEL_82946GZ_HB 0x2970 |
@@ -36,6 +46,8 @@ | |||
36 | #define PCI_DEVICE_ID_INTEL_Q35_IG 0x29B2 | 46 | #define PCI_DEVICE_ID_INTEL_Q35_IG 0x29B2 |
37 | #define PCI_DEVICE_ID_INTEL_Q33_HB 0x29D0 | 47 | #define PCI_DEVICE_ID_INTEL_Q33_HB 0x29D0 |
38 | #define PCI_DEVICE_ID_INTEL_Q33_IG 0x29D2 | 48 | #define PCI_DEVICE_ID_INTEL_Q33_IG 0x29D2 |
49 | #define PCI_DEVICE_ID_INTEL_B43_HB 0x2E40 | ||
50 | #define PCI_DEVICE_ID_INTEL_B43_IG 0x2E42 | ||
39 | #define PCI_DEVICE_ID_INTEL_GM45_HB 0x2A40 | 51 | #define PCI_DEVICE_ID_INTEL_GM45_HB 0x2A40 |
40 | #define PCI_DEVICE_ID_INTEL_GM45_IG 0x2A42 | 52 | #define PCI_DEVICE_ID_INTEL_GM45_IG 0x2A42 |
41 | #define PCI_DEVICE_ID_INTEL_IGD_E_HB 0x2E00 | 53 | #define PCI_DEVICE_ID_INTEL_IGD_E_HB 0x2E00 |
@@ -81,6 +93,7 @@ | |||
81 | agp_bridge->dev->device == PCI_DEVICE_ID_INTEL_G45_HB || \ | 93 | agp_bridge->dev->device == PCI_DEVICE_ID_INTEL_G45_HB || \ |
82 | agp_bridge->dev->device == PCI_DEVICE_ID_INTEL_GM45_HB || \ | 94 | agp_bridge->dev->device == PCI_DEVICE_ID_INTEL_GM45_HB || \ |
83 | agp_bridge->dev->device == PCI_DEVICE_ID_INTEL_G41_HB || \ | 95 | agp_bridge->dev->device == PCI_DEVICE_ID_INTEL_G41_HB || \ |
96 | agp_bridge->dev->device == PCI_DEVICE_ID_INTEL_B43_HB || \ | ||
84 | agp_bridge->dev->device == PCI_DEVICE_ID_INTEL_IGDNG_D_HB || \ | 97 | agp_bridge->dev->device == PCI_DEVICE_ID_INTEL_IGDNG_D_HB || \ |
85 | agp_bridge->dev->device == PCI_DEVICE_ID_INTEL_IGDNG_M_HB || \ | 98 | agp_bridge->dev->device == PCI_DEVICE_ID_INTEL_IGDNG_M_HB || \ |
86 | agp_bridge->dev->device == PCI_DEVICE_ID_INTEL_IGDNG_MA_HB) | 99 | agp_bridge->dev->device == PCI_DEVICE_ID_INTEL_IGDNG_MA_HB) |
@@ -172,6 +185,123 @@ static struct _intel_private { | |||
172 | int resource_valid; | 185 | int resource_valid; |
173 | } intel_private; | 186 | } intel_private; |
174 | 187 | ||
188 | #ifdef USE_PCI_DMA_API | ||
189 | static int intel_agp_map_page(struct page *page, dma_addr_t *ret) | ||
190 | { | ||
191 | *ret = pci_map_page(intel_private.pcidev, page, 0, | ||
192 | PAGE_SIZE, PCI_DMA_BIDIRECTIONAL); | ||
193 | if (pci_dma_mapping_error(intel_private.pcidev, *ret)) | ||
194 | return -EINVAL; | ||
195 | return 0; | ||
196 | } | ||
197 | |||
198 | static void intel_agp_unmap_page(struct page *page, dma_addr_t dma) | ||
199 | { | ||
200 | pci_unmap_page(intel_private.pcidev, dma, | ||
201 | PAGE_SIZE, PCI_DMA_BIDIRECTIONAL); | ||
202 | } | ||
203 | |||
204 | static void intel_agp_free_sglist(struct agp_memory *mem) | ||
205 | { | ||
206 | struct sg_table st; | ||
207 | |||
208 | st.sgl = mem->sg_list; | ||
209 | st.orig_nents = st.nents = mem->page_count; | ||
210 | |||
211 | sg_free_table(&st); | ||
212 | |||
213 | mem->sg_list = NULL; | ||
214 | mem->num_sg = 0; | ||
215 | } | ||
216 | |||
217 | static int intel_agp_map_memory(struct agp_memory *mem) | ||
218 | { | ||
219 | struct sg_table st; | ||
220 | struct scatterlist *sg; | ||
221 | int i; | ||
222 | |||
223 | DBG("try mapping %lu pages\n", (unsigned long)mem->page_count); | ||
224 | |||
225 | if (sg_alloc_table(&st, mem->page_count, GFP_KERNEL)) | ||
226 | return -ENOMEM; | ||
227 | |||
228 | mem->sg_list = sg = st.sgl; | ||
229 | |||
230 | for (i = 0 ; i < mem->page_count; i++, sg = sg_next(sg)) | ||
231 | sg_set_page(sg, mem->pages[i], PAGE_SIZE, 0); | ||
232 | |||
233 | mem->num_sg = pci_map_sg(intel_private.pcidev, mem->sg_list, | ||
234 | mem->page_count, PCI_DMA_BIDIRECTIONAL); | ||
235 | if (unlikely(!mem->num_sg)) { | ||
236 | intel_agp_free_sglist(mem); | ||
237 | return -ENOMEM; | ||
238 | } | ||
239 | return 0; | ||
240 | } | ||
241 | |||
242 | static void intel_agp_unmap_memory(struct agp_memory *mem) | ||
243 | { | ||
244 | DBG("try unmapping %lu pages\n", (unsigned long)mem->page_count); | ||
245 | |||
246 | pci_unmap_sg(intel_private.pcidev, mem->sg_list, | ||
247 | mem->page_count, PCI_DMA_BIDIRECTIONAL); | ||
248 | intel_agp_free_sglist(mem); | ||
249 | } | ||
250 | |||
251 | static void intel_agp_insert_sg_entries(struct agp_memory *mem, | ||
252 | off_t pg_start, int mask_type) | ||
253 | { | ||
254 | struct scatterlist *sg; | ||
255 | int i, j; | ||
256 | |||
257 | j = pg_start; | ||
258 | |||
259 | WARN_ON(!mem->num_sg); | ||
260 | |||
261 | if (mem->num_sg == mem->page_count) { | ||
262 | for_each_sg(mem->sg_list, sg, mem->page_count, i) { | ||
263 | writel(agp_bridge->driver->mask_memory(agp_bridge, | ||
264 | sg_dma_address(sg), mask_type), | ||
265 | intel_private.gtt+j); | ||
266 | j++; | ||
267 | } | ||
268 | } else { | ||
269 | /* sg may merge pages, but we have to seperate | ||
270 | * per-page addr for GTT */ | ||
271 | unsigned int len, m; | ||
272 | |||
273 | for_each_sg(mem->sg_list, sg, mem->num_sg, i) { | ||
274 | len = sg_dma_len(sg) / PAGE_SIZE; | ||
275 | for (m = 0; m < len; m++) { | ||
276 | writel(agp_bridge->driver->mask_memory(agp_bridge, | ||
277 | sg_dma_address(sg) + m * PAGE_SIZE, | ||
278 | mask_type), | ||
279 | intel_private.gtt+j); | ||
280 | j++; | ||
281 | } | ||
282 | } | ||
283 | } | ||
284 | readl(intel_private.gtt+j-1); | ||
285 | } | ||
286 | |||
287 | #else | ||
288 | |||
289 | static void intel_agp_insert_sg_entries(struct agp_memory *mem, | ||
290 | off_t pg_start, int mask_type) | ||
291 | { | ||
292 | int i, j; | ||
293 | |||
294 | for (i = 0, j = pg_start; i < mem->page_count; i++, j++) { | ||
295 | writel(agp_bridge->driver->mask_memory(agp_bridge, | ||
296 | page_to_phys(mem->pages[i]), mask_type), | ||
297 | intel_private.gtt+j); | ||
298 | } | ||
299 | |||
300 | readl(intel_private.gtt+j-1); | ||
301 | } | ||
302 | |||
303 | #endif | ||
304 | |||
175 | static int intel_i810_fetch_size(void) | 305 | static int intel_i810_fetch_size(void) |
176 | { | 306 | { |
177 | u32 smram_miscc; | 307 | u32 smram_miscc; |
@@ -345,8 +475,7 @@ static int intel_i810_insert_entries(struct agp_memory *mem, off_t pg_start, | |||
345 | global_cache_flush(); | 475 | global_cache_flush(); |
346 | for (i = 0, j = pg_start; i < mem->page_count; i++, j++) { | 476 | for (i = 0, j = pg_start; i < mem->page_count; i++, j++) { |
347 | writel(agp_bridge->driver->mask_memory(agp_bridge, | 477 | writel(agp_bridge->driver->mask_memory(agp_bridge, |
348 | mem->pages[i], | 478 | page_to_phys(mem->pages[i]), mask_type), |
349 | mask_type), | ||
350 | intel_private.registers+I810_PTE_BASE+(j*4)); | 479 | intel_private.registers+I810_PTE_BASE+(j*4)); |
351 | } | 480 | } |
352 | readl(intel_private.registers+I810_PTE_BASE+((j-1)*4)); | 481 | readl(intel_private.registers+I810_PTE_BASE+((j-1)*4)); |
@@ -463,9 +592,8 @@ static void intel_i810_free_by_type(struct agp_memory *curr) | |||
463 | } | 592 | } |
464 | 593 | ||
465 | static unsigned long intel_i810_mask_memory(struct agp_bridge_data *bridge, | 594 | static unsigned long intel_i810_mask_memory(struct agp_bridge_data *bridge, |
466 | struct page *page, int type) | 595 | dma_addr_t addr, int type) |
467 | { | 596 | { |
468 | unsigned long addr = phys_to_gart(page_to_phys(page)); | ||
469 | /* Type checking must be done elsewhere */ | 597 | /* Type checking must be done elsewhere */ |
470 | return addr | bridge->driver->masks[type].mask; | 598 | return addr | bridge->driver->masks[type].mask; |
471 | } | 599 | } |
@@ -679,23 +807,39 @@ static void intel_i830_setup_flush(void) | |||
679 | if (!intel_private.i8xx_page) | 807 | if (!intel_private.i8xx_page) |
680 | return; | 808 | return; |
681 | 809 | ||
682 | /* make page uncached */ | ||
683 | map_page_into_agp(intel_private.i8xx_page); | ||
684 | |||
685 | intel_private.i8xx_flush_page = kmap(intel_private.i8xx_page); | 810 | intel_private.i8xx_flush_page = kmap(intel_private.i8xx_page); |
686 | if (!intel_private.i8xx_flush_page) | 811 | if (!intel_private.i8xx_flush_page) |
687 | intel_i830_fini_flush(); | 812 | intel_i830_fini_flush(); |
688 | } | 813 | } |
689 | 814 | ||
815 | static void | ||
816 | do_wbinvd(void *null) | ||
817 | { | ||
818 | wbinvd(); | ||
819 | } | ||
820 | |||
821 | /* The chipset_flush interface needs to get data that has already been | ||
822 | * flushed out of the CPU all the way out to main memory, because the GPU | ||
823 | * doesn't snoop those buffers. | ||
824 | * | ||
825 | * The 8xx series doesn't have the same lovely interface for flushing the | ||
826 | * chipset write buffers that the later chips do. According to the 865 | ||
827 | * specs, it's 64 octwords, or 1KB. So, to get those previous things in | ||
828 | * that buffer out, we just fill 1KB and clflush it out, on the assumption | ||
829 | * that it'll push whatever was in there out. It appears to work. | ||
830 | */ | ||
690 | static void intel_i830_chipset_flush(struct agp_bridge_data *bridge) | 831 | static void intel_i830_chipset_flush(struct agp_bridge_data *bridge) |
691 | { | 832 | { |
692 | unsigned int *pg = intel_private.i8xx_flush_page; | 833 | unsigned int *pg = intel_private.i8xx_flush_page; |
693 | int i; | ||
694 | 834 | ||
695 | for (i = 0; i < 256; i += 2) | 835 | memset(pg, 0, 1024); |
696 | *(pg + i) = i; | ||
697 | 836 | ||
698 | wmb(); | 837 | if (cpu_has_clflush) { |
838 | clflush_cache_range(pg, 1024); | ||
839 | } else { | ||
840 | if (on_each_cpu(do_wbinvd, NULL, 1) != 0) | ||
841 | printk(KERN_ERR "Timed out waiting for cache flush.\n"); | ||
842 | } | ||
699 | } | 843 | } |
700 | 844 | ||
701 | /* The intel i830 automatically initializes the agp aperture during POST. | 845 | /* The intel i830 automatically initializes the agp aperture during POST. |
@@ -853,7 +997,7 @@ static int intel_i830_insert_entries(struct agp_memory *mem, off_t pg_start, | |||
853 | 997 | ||
854 | for (i = 0, j = pg_start; i < mem->page_count; i++, j++) { | 998 | for (i = 0, j = pg_start; i < mem->page_count; i++, j++) { |
855 | writel(agp_bridge->driver->mask_memory(agp_bridge, | 999 | writel(agp_bridge->driver->mask_memory(agp_bridge, |
856 | mem->pages[i], mask_type), | 1000 | page_to_phys(mem->pages[i]), mask_type), |
857 | intel_private.registers+I810_PTE_BASE+(j*4)); | 1001 | intel_private.registers+I810_PTE_BASE+(j*4)); |
858 | } | 1002 | } |
859 | readl(intel_private.registers+I810_PTE_BASE+((j-1)*4)); | 1003 | readl(intel_private.registers+I810_PTE_BASE+((j-1)*4)); |
@@ -1017,6 +1161,12 @@ static int intel_i915_configure(void) | |||
1017 | 1161 | ||
1018 | intel_i9xx_setup_flush(); | 1162 | intel_i9xx_setup_flush(); |
1019 | 1163 | ||
1164 | #ifdef USE_PCI_DMA_API | ||
1165 | if (pci_set_dma_mask(intel_private.pcidev, DMA_BIT_MASK(36))) | ||
1166 | dev_err(&intel_private.pcidev->dev, | ||
1167 | "set gfx device dma mask 36bit failed!\n"); | ||
1168 | #endif | ||
1169 | |||
1020 | return 0; | 1170 | return 0; |
1021 | } | 1171 | } |
1022 | 1172 | ||
@@ -1041,7 +1191,7 @@ static void intel_i915_chipset_flush(struct agp_bridge_data *bridge) | |||
1041 | static int intel_i915_insert_entries(struct agp_memory *mem, off_t pg_start, | 1191 | static int intel_i915_insert_entries(struct agp_memory *mem, off_t pg_start, |
1042 | int type) | 1192 | int type) |
1043 | { | 1193 | { |
1044 | int i, j, num_entries; | 1194 | int num_entries; |
1045 | void *temp; | 1195 | void *temp; |
1046 | int ret = -EINVAL; | 1196 | int ret = -EINVAL; |
1047 | int mask_type; | 1197 | int mask_type; |
@@ -1065,7 +1215,7 @@ static int intel_i915_insert_entries(struct agp_memory *mem, off_t pg_start, | |||
1065 | if ((pg_start + mem->page_count) > num_entries) | 1215 | if ((pg_start + mem->page_count) > num_entries) |
1066 | goto out_err; | 1216 | goto out_err; |
1067 | 1217 | ||
1068 | /* The i915 can't check the GTT for entries since its read only, | 1218 | /* The i915 can't check the GTT for entries since it's read only; |
1069 | * depend on the caller to make the correct offset decisions. | 1219 | * depend on the caller to make the correct offset decisions. |
1070 | */ | 1220 | */ |
1071 | 1221 | ||
@@ -1081,12 +1231,7 @@ static int intel_i915_insert_entries(struct agp_memory *mem, off_t pg_start, | |||
1081 | if (!mem->is_flushed) | 1231 | if (!mem->is_flushed) |
1082 | global_cache_flush(); | 1232 | global_cache_flush(); |
1083 | 1233 | ||
1084 | for (i = 0, j = pg_start; i < mem->page_count; i++, j++) { | 1234 | intel_agp_insert_sg_entries(mem, pg_start, mask_type); |
1085 | writel(agp_bridge->driver->mask_memory(agp_bridge, | ||
1086 | mem->pages[i], mask_type), intel_private.gtt+j); | ||
1087 | } | ||
1088 | |||
1089 | readl(intel_private.gtt+j-1); | ||
1090 | agp_bridge->driver->tlb_flush(mem); | 1235 | agp_bridge->driver->tlb_flush(mem); |
1091 | 1236 | ||
1092 | out: | 1237 | out: |
@@ -1198,9 +1343,8 @@ static int intel_i915_create_gatt_table(struct agp_bridge_data *bridge) | |||
1198 | * this conditional. | 1343 | * this conditional. |
1199 | */ | 1344 | */ |
1200 | static unsigned long intel_i965_mask_memory(struct agp_bridge_data *bridge, | 1345 | static unsigned long intel_i965_mask_memory(struct agp_bridge_data *bridge, |
1201 | struct page *page, int type) | 1346 | dma_addr_t addr, int type) |
1202 | { | 1347 | { |
1203 | dma_addr_t addr = phys_to_gart(page_to_phys(page)); | ||
1204 | /* Shift high bits down */ | 1348 | /* Shift high bits down */ |
1205 | addr |= (addr >> 28) & 0xf0; | 1349 | addr |= (addr >> 28) & 0xf0; |
1206 | 1350 | ||
@@ -1216,6 +1360,7 @@ static void intel_i965_get_gtt_range(int *gtt_offset, int *gtt_size) | |||
1216 | case PCI_DEVICE_ID_INTEL_Q45_HB: | 1360 | case PCI_DEVICE_ID_INTEL_Q45_HB: |
1217 | case PCI_DEVICE_ID_INTEL_G45_HB: | 1361 | case PCI_DEVICE_ID_INTEL_G45_HB: |
1218 | case PCI_DEVICE_ID_INTEL_G41_HB: | 1362 | case PCI_DEVICE_ID_INTEL_G41_HB: |
1363 | case PCI_DEVICE_ID_INTEL_B43_HB: | ||
1219 | case PCI_DEVICE_ID_INTEL_IGDNG_D_HB: | 1364 | case PCI_DEVICE_ID_INTEL_IGDNG_D_HB: |
1220 | case PCI_DEVICE_ID_INTEL_IGDNG_M_HB: | 1365 | case PCI_DEVICE_ID_INTEL_IGDNG_M_HB: |
1221 | case PCI_DEVICE_ID_INTEL_IGDNG_MA_HB: | 1366 | case PCI_DEVICE_ID_INTEL_IGDNG_MA_HB: |
@@ -2006,6 +2151,12 @@ static const struct agp_bridge_driver intel_915_driver = { | |||
2006 | .agp_destroy_pages = agp_generic_destroy_pages, | 2151 | .agp_destroy_pages = agp_generic_destroy_pages, |
2007 | .agp_type_to_mask_type = intel_i830_type_to_mask_type, | 2152 | .agp_type_to_mask_type = intel_i830_type_to_mask_type, |
2008 | .chipset_flush = intel_i915_chipset_flush, | 2153 | .chipset_flush = intel_i915_chipset_flush, |
2154 | #ifdef USE_PCI_DMA_API | ||
2155 | .agp_map_page = intel_agp_map_page, | ||
2156 | .agp_unmap_page = intel_agp_unmap_page, | ||
2157 | .agp_map_memory = intel_agp_map_memory, | ||
2158 | .agp_unmap_memory = intel_agp_unmap_memory, | ||
2159 | #endif | ||
2009 | }; | 2160 | }; |
2010 | 2161 | ||
2011 | static const struct agp_bridge_driver intel_i965_driver = { | 2162 | static const struct agp_bridge_driver intel_i965_driver = { |
@@ -2034,6 +2185,12 @@ static const struct agp_bridge_driver intel_i965_driver = { | |||
2034 | .agp_destroy_pages = agp_generic_destroy_pages, | 2185 | .agp_destroy_pages = agp_generic_destroy_pages, |
2035 | .agp_type_to_mask_type = intel_i830_type_to_mask_type, | 2186 | .agp_type_to_mask_type = intel_i830_type_to_mask_type, |
2036 | .chipset_flush = intel_i915_chipset_flush, | 2187 | .chipset_flush = intel_i915_chipset_flush, |
2188 | #ifdef USE_PCI_DMA_API | ||
2189 | .agp_map_page = intel_agp_map_page, | ||
2190 | .agp_unmap_page = intel_agp_unmap_page, | ||
2191 | .agp_map_memory = intel_agp_map_memory, | ||
2192 | .agp_unmap_memory = intel_agp_unmap_memory, | ||
2193 | #endif | ||
2037 | }; | 2194 | }; |
2038 | 2195 | ||
2039 | static const struct agp_bridge_driver intel_7505_driver = { | 2196 | static const struct agp_bridge_driver intel_7505_driver = { |
@@ -2088,6 +2245,12 @@ static const struct agp_bridge_driver intel_g33_driver = { | |||
2088 | .agp_destroy_pages = agp_generic_destroy_pages, | 2245 | .agp_destroy_pages = agp_generic_destroy_pages, |
2089 | .agp_type_to_mask_type = intel_i830_type_to_mask_type, | 2246 | .agp_type_to_mask_type = intel_i830_type_to_mask_type, |
2090 | .chipset_flush = intel_i915_chipset_flush, | 2247 | .chipset_flush = intel_i915_chipset_flush, |
2248 | #ifdef USE_PCI_DMA_API | ||
2249 | .agp_map_page = intel_agp_map_page, | ||
2250 | .agp_unmap_page = intel_agp_unmap_page, | ||
2251 | .agp_map_memory = intel_agp_map_memory, | ||
2252 | .agp_unmap_memory = intel_agp_unmap_memory, | ||
2253 | #endif | ||
2091 | }; | 2254 | }; |
2092 | 2255 | ||
2093 | static int find_gmch(u16 device) | 2256 | static int find_gmch(u16 device) |
@@ -2192,6 +2355,8 @@ static const struct intel_driver_description { | |||
2192 | "Q45/Q43", NULL, &intel_i965_driver }, | 2355 | "Q45/Q43", NULL, &intel_i965_driver }, |
2193 | { PCI_DEVICE_ID_INTEL_G45_HB, PCI_DEVICE_ID_INTEL_G45_IG, 0, | 2356 | { PCI_DEVICE_ID_INTEL_G45_HB, PCI_DEVICE_ID_INTEL_G45_IG, 0, |
2194 | "G45/G43", NULL, &intel_i965_driver }, | 2357 | "G45/G43", NULL, &intel_i965_driver }, |
2358 | { PCI_DEVICE_ID_INTEL_B43_HB, PCI_DEVICE_ID_INTEL_B43_IG, 0, | ||
2359 | "B43", NULL, &intel_i965_driver }, | ||
2195 | { PCI_DEVICE_ID_INTEL_G41_HB, PCI_DEVICE_ID_INTEL_G41_IG, 0, | 2360 | { PCI_DEVICE_ID_INTEL_G41_HB, PCI_DEVICE_ID_INTEL_G41_IG, 0, |
2196 | "G41", NULL, &intel_i965_driver }, | 2361 | "G41", NULL, &intel_i965_driver }, |
2197 | { PCI_DEVICE_ID_INTEL_IGDNG_D_HB, PCI_DEVICE_ID_INTEL_IGDNG_D_IG, 0, | 2362 | { PCI_DEVICE_ID_INTEL_IGDNG_D_HB, PCI_DEVICE_ID_INTEL_IGDNG_D_IG, 0, |
@@ -2313,15 +2478,6 @@ static int agp_intel_resume(struct pci_dev *pdev) | |||
2313 | struct agp_bridge_data *bridge = pci_get_drvdata(pdev); | 2478 | struct agp_bridge_data *bridge = pci_get_drvdata(pdev); |
2314 | int ret_val; | 2479 | int ret_val; |
2315 | 2480 | ||
2316 | pci_restore_state(pdev); | ||
2317 | |||
2318 | /* We should restore our graphics device's config space, | ||
2319 | * as host bridge (00:00) resumes before graphics device (02:00), | ||
2320 | * then our access to its pci space can work right. | ||
2321 | */ | ||
2322 | if (intel_private.pcidev) | ||
2323 | pci_restore_state(intel_private.pcidev); | ||
2324 | |||
2325 | if (bridge->driver == &intel_generic_driver) | 2481 | if (bridge->driver == &intel_generic_driver) |
2326 | intel_configure(); | 2482 | intel_configure(); |
2327 | else if (bridge->driver == &intel_850_driver) | 2483 | else if (bridge->driver == &intel_850_driver) |
@@ -2401,6 +2557,7 @@ static struct pci_device_id agp_intel_pci_table[] = { | |||
2401 | ID(PCI_DEVICE_ID_INTEL_Q45_HB), | 2557 | ID(PCI_DEVICE_ID_INTEL_Q45_HB), |
2402 | ID(PCI_DEVICE_ID_INTEL_G45_HB), | 2558 | ID(PCI_DEVICE_ID_INTEL_G45_HB), |
2403 | ID(PCI_DEVICE_ID_INTEL_G41_HB), | 2559 | ID(PCI_DEVICE_ID_INTEL_G41_HB), |
2560 | ID(PCI_DEVICE_ID_INTEL_B43_HB), | ||
2404 | ID(PCI_DEVICE_ID_INTEL_IGDNG_D_HB), | 2561 | ID(PCI_DEVICE_ID_INTEL_IGDNG_D_HB), |
2405 | ID(PCI_DEVICE_ID_INTEL_IGDNG_M_HB), | 2562 | ID(PCI_DEVICE_ID_INTEL_IGDNG_M_HB), |
2406 | ID(PCI_DEVICE_ID_INTEL_IGDNG_MA_HB), | 2563 | ID(PCI_DEVICE_ID_INTEL_IGDNG_MA_HB), |
diff --git a/drivers/char/agp/nvidia-agp.c b/drivers/char/agp/nvidia-agp.c index 263d71dd441c..7e36d2b4f9d4 100644 --- a/drivers/char/agp/nvidia-agp.c +++ b/drivers/char/agp/nvidia-agp.c | |||
@@ -225,7 +225,7 @@ static int nvidia_insert_memory(struct agp_memory *mem, off_t pg_start, int type | |||
225 | } | 225 | } |
226 | for (i = 0, j = pg_start; i < mem->page_count; i++, j++) { | 226 | for (i = 0, j = pg_start; i < mem->page_count; i++, j++) { |
227 | writel(agp_bridge->driver->mask_memory(agp_bridge, | 227 | writel(agp_bridge->driver->mask_memory(agp_bridge, |
228 | mem->pages[i], mask_type), | 228 | page_to_phys(mem->pages[i]), mask_type), |
229 | agp_bridge->gatt_table+nvidia_private.pg_offset+j); | 229 | agp_bridge->gatt_table+nvidia_private.pg_offset+j); |
230 | } | 230 | } |
231 | 231 | ||
diff --git a/drivers/char/agp/parisc-agp.c b/drivers/char/agp/parisc-agp.c index e077701ae3d9..60ab75104da9 100644 --- a/drivers/char/agp/parisc-agp.c +++ b/drivers/char/agp/parisc-agp.c | |||
@@ -32,7 +32,7 @@ | |||
32 | #define AGP8X_MODE (1 << AGP8X_MODE_BIT) | 32 | #define AGP8X_MODE (1 << AGP8X_MODE_BIT) |
33 | 33 | ||
34 | static unsigned long | 34 | static unsigned long |
35 | parisc_agp_mask_memory(struct agp_bridge_data *bridge, unsigned long addr, | 35 | parisc_agp_mask_memory(struct agp_bridge_data *bridge, dma_addr_t addr, |
36 | int type); | 36 | int type); |
37 | 37 | ||
38 | static struct _parisc_agp_info { | 38 | static struct _parisc_agp_info { |
@@ -189,20 +189,12 @@ parisc_agp_remove_memory(struct agp_memory *mem, off_t pg_start, int type) | |||
189 | } | 189 | } |
190 | 190 | ||
191 | static unsigned long | 191 | static unsigned long |
192 | parisc_agp_mask_memory(struct agp_bridge_data *bridge, unsigned long addr, | 192 | parisc_agp_mask_memory(struct agp_bridge_data *bridge, dma_addr_t addr, |
193 | int type) | 193 | int type) |
194 | { | 194 | { |
195 | return SBA_PDIR_VALID_BIT | addr; | 195 | return SBA_PDIR_VALID_BIT | addr; |
196 | } | 196 | } |
197 | 197 | ||
198 | static unsigned long | ||
199 | parisc_agp_page_mask_memory(struct agp_bridge_data *bridge, struct page *page, | ||
200 | int type) | ||
201 | { | ||
202 | unsigned long addr = phys_to_gart(page_to_phys(page)); | ||
203 | return SBA_PDIR_VALID_BIT | addr; | ||
204 | } | ||
205 | |||
206 | static void | 198 | static void |
207 | parisc_agp_enable(struct agp_bridge_data *bridge, u32 mode) | 199 | parisc_agp_enable(struct agp_bridge_data *bridge, u32 mode) |
208 | { | 200 | { |
diff --git a/drivers/char/agp/sgi-agp.c b/drivers/char/agp/sgi-agp.c index d3ea2e4226b5..0d426ae39c85 100644 --- a/drivers/char/agp/sgi-agp.c +++ b/drivers/char/agp/sgi-agp.c | |||
@@ -70,10 +70,9 @@ static void sgi_tioca_tlbflush(struct agp_memory *mem) | |||
70 | * entry. | 70 | * entry. |
71 | */ | 71 | */ |
72 | static unsigned long | 72 | static unsigned long |
73 | sgi_tioca_mask_memory(struct agp_bridge_data *bridge, | 73 | sgi_tioca_mask_memory(struct agp_bridge_data *bridge, dma_addr_t addr, |
74 | struct page *page, int type) | 74 | int type) |
75 | { | 75 | { |
76 | unsigned long addr = phys_to_gart(page_to_phys(page)); | ||
77 | return tioca_physpage_to_gart(addr); | 76 | return tioca_physpage_to_gart(addr); |
78 | } | 77 | } |
79 | 78 | ||
@@ -190,7 +189,8 @@ static int sgi_tioca_insert_memory(struct agp_memory *mem, off_t pg_start, | |||
190 | 189 | ||
191 | for (i = 0, j = pg_start; i < mem->page_count; i++, j++) { | 190 | for (i = 0, j = pg_start; i < mem->page_count; i++, j++) { |
192 | table[j] = | 191 | table[j] = |
193 | bridge->driver->mask_memory(bridge, mem->pages[i], | 192 | bridge->driver->mask_memory(bridge, |
193 | page_to_phys(mem->pages[i]), | ||
194 | mem->type); | 194 | mem->type); |
195 | } | 195 | } |
196 | 196 | ||
diff --git a/drivers/char/agp/sworks-agp.c b/drivers/char/agp/sworks-agp.c index b964a2199329..13acaaf64edb 100644 --- a/drivers/char/agp/sworks-agp.c +++ b/drivers/char/agp/sworks-agp.c | |||
@@ -155,7 +155,7 @@ static int serverworks_create_gatt_table(struct agp_bridge_data *bridge) | |||
155 | /* Create a fake scratch directory */ | 155 | /* Create a fake scratch directory */ |
156 | for (i = 0; i < 1024; i++) { | 156 | for (i = 0; i < 1024; i++) { |
157 | writel(agp_bridge->scratch_page, serverworks_private.scratch_dir.remapped+i); | 157 | writel(agp_bridge->scratch_page, serverworks_private.scratch_dir.remapped+i); |
158 | writel(virt_to_gart(serverworks_private.scratch_dir.real) | 1, page_dir.remapped+i); | 158 | writel(virt_to_phys(serverworks_private.scratch_dir.real) | 1, page_dir.remapped+i); |
159 | } | 159 | } |
160 | 160 | ||
161 | retval = serverworks_create_gatt_pages(value->num_entries / 1024); | 161 | retval = serverworks_create_gatt_pages(value->num_entries / 1024); |
@@ -167,7 +167,7 @@ static int serverworks_create_gatt_table(struct agp_bridge_data *bridge) | |||
167 | 167 | ||
168 | agp_bridge->gatt_table_real = (u32 *)page_dir.real; | 168 | agp_bridge->gatt_table_real = (u32 *)page_dir.real; |
169 | agp_bridge->gatt_table = (u32 __iomem *)page_dir.remapped; | 169 | agp_bridge->gatt_table = (u32 __iomem *)page_dir.remapped; |
170 | agp_bridge->gatt_bus_addr = virt_to_gart(page_dir.real); | 170 | agp_bridge->gatt_bus_addr = virt_to_phys(page_dir.real); |
171 | 171 | ||
172 | /* Get the address for the gart region. | 172 | /* Get the address for the gart region. |
173 | * This is a bus address even on the alpha, b/c its | 173 | * This is a bus address even on the alpha, b/c its |
@@ -179,7 +179,7 @@ static int serverworks_create_gatt_table(struct agp_bridge_data *bridge) | |||
179 | 179 | ||
180 | /* Calculate the agp offset */ | 180 | /* Calculate the agp offset */ |
181 | for (i = 0; i < value->num_entries / 1024; i++) | 181 | for (i = 0; i < value->num_entries / 1024; i++) |
182 | writel(virt_to_gart(serverworks_private.gatt_pages[i]->real)|1, page_dir.remapped+i); | 182 | writel(virt_to_phys(serverworks_private.gatt_pages[i]->real)|1, page_dir.remapped+i); |
183 | 183 | ||
184 | return 0; | 184 | return 0; |
185 | } | 185 | } |
@@ -349,7 +349,9 @@ static int serverworks_insert_memory(struct agp_memory *mem, | |||
349 | for (i = 0, j = pg_start; i < mem->page_count; i++, j++) { | 349 | for (i = 0, j = pg_start; i < mem->page_count; i++, j++) { |
350 | addr = (j * PAGE_SIZE) + agp_bridge->gart_bus_addr; | 350 | addr = (j * PAGE_SIZE) + agp_bridge->gart_bus_addr; |
351 | cur_gatt = SVRWRKS_GET_GATT(addr); | 351 | cur_gatt = SVRWRKS_GET_GATT(addr); |
352 | writel(agp_bridge->driver->mask_memory(agp_bridge, mem->pages[i], mem->type), cur_gatt+GET_GATT_OFF(addr)); | 352 | writel(agp_bridge->driver->mask_memory(agp_bridge, |
353 | page_to_phys(mem->pages[i]), mem->type), | ||
354 | cur_gatt+GET_GATT_OFF(addr)); | ||
353 | } | 355 | } |
354 | serverworks_tlbflush(mem); | 356 | serverworks_tlbflush(mem); |
355 | return 0; | 357 | return 0; |
diff --git a/drivers/char/agp/uninorth-agp.c b/drivers/char/agp/uninorth-agp.c index f192c3b9ad41..703959eba45a 100644 --- a/drivers/char/agp/uninorth-agp.c +++ b/drivers/char/agp/uninorth-agp.c | |||
@@ -7,6 +7,7 @@ | |||
7 | #include <linux/pagemap.h> | 7 | #include <linux/pagemap.h> |
8 | #include <linux/agp_backend.h> | 8 | #include <linux/agp_backend.h> |
9 | #include <linux/delay.h> | 9 | #include <linux/delay.h> |
10 | #include <linux/vmalloc.h> | ||
10 | #include <asm/uninorth.h> | 11 | #include <asm/uninorth.h> |
11 | #include <asm/pci-bridge.h> | 12 | #include <asm/pci-bridge.h> |
12 | #include <asm/prom.h> | 13 | #include <asm/prom.h> |
@@ -27,6 +28,8 @@ | |||
27 | static int uninorth_rev; | 28 | static int uninorth_rev; |
28 | static int is_u3; | 29 | static int is_u3; |
29 | 30 | ||
31 | #define DEFAULT_APERTURE_SIZE 256 | ||
32 | #define DEFAULT_APERTURE_STRING "256" | ||
30 | static char *aperture = NULL; | 33 | static char *aperture = NULL; |
31 | 34 | ||
32 | static int uninorth_fetch_size(void) | 35 | static int uninorth_fetch_size(void) |
@@ -55,7 +58,7 @@ static int uninorth_fetch_size(void) | |||
55 | 58 | ||
56 | if (!size) { | 59 | if (!size) { |
57 | for (i = 0; i < agp_bridge->driver->num_aperture_sizes; i++) | 60 | for (i = 0; i < agp_bridge->driver->num_aperture_sizes; i++) |
58 | if (values[i].size == 32) | 61 | if (values[i].size == DEFAULT_APERTURE_SIZE) |
59 | break; | 62 | break; |
60 | } | 63 | } |
61 | 64 | ||
@@ -135,7 +138,7 @@ static int uninorth_configure(void) | |||
135 | if (is_u3) { | 138 | if (is_u3) { |
136 | pci_write_config_dword(agp_bridge->dev, | 139 | pci_write_config_dword(agp_bridge->dev, |
137 | UNI_N_CFG_GART_DUMMY_PAGE, | 140 | UNI_N_CFG_GART_DUMMY_PAGE, |
138 | agp_bridge->scratch_page_real >> 12); | 141 | page_to_phys(agp_bridge->scratch_page_page) >> 12); |
139 | } | 142 | } |
140 | 143 | ||
141 | return 0; | 144 | return 0; |
@@ -179,8 +182,6 @@ static int uninorth_insert_memory(struct agp_memory *mem, off_t pg_start, | |||
179 | } | 182 | } |
180 | (void)in_le32((volatile u32*)&agp_bridge->gatt_table[pg_start]); | 183 | (void)in_le32((volatile u32*)&agp_bridge->gatt_table[pg_start]); |
181 | mb(); | 184 | mb(); |
182 | flush_dcache_range((unsigned long)&agp_bridge->gatt_table[pg_start], | ||
183 | (unsigned long)&agp_bridge->gatt_table[pg_start + mem->page_count]); | ||
184 | 185 | ||
185 | uninorth_tlbflush(mem); | 186 | uninorth_tlbflush(mem); |
186 | return 0; | 187 | return 0; |
@@ -224,7 +225,6 @@ static int u3_insert_memory(struct agp_memory *mem, off_t pg_start, int type) | |||
224 | (unsigned long)__va(page_to_phys(mem->pages[i]))+0x1000); | 225 | (unsigned long)__va(page_to_phys(mem->pages[i]))+0x1000); |
225 | } | 226 | } |
226 | mb(); | 227 | mb(); |
227 | flush_dcache_range((unsigned long)gp, (unsigned long) &gp[i]); | ||
228 | uninorth_tlbflush(mem); | 228 | uninorth_tlbflush(mem); |
229 | 229 | ||
230 | return 0; | 230 | return 0; |
@@ -243,7 +243,6 @@ int u3_remove_memory(struct agp_memory *mem, off_t pg_start, int type) | |||
243 | for (i = 0; i < mem->page_count; ++i) | 243 | for (i = 0; i < mem->page_count; ++i) |
244 | gp[i] = 0; | 244 | gp[i] = 0; |
245 | mb(); | 245 | mb(); |
246 | flush_dcache_range((unsigned long)gp, (unsigned long) &gp[i]); | ||
247 | uninorth_tlbflush(mem); | 246 | uninorth_tlbflush(mem); |
248 | 247 | ||
249 | return 0; | 248 | return 0; |
@@ -271,7 +270,7 @@ static void uninorth_agp_enable(struct agp_bridge_data *bridge, u32 mode) | |||
271 | 270 | ||
272 | if ((uninorth_rev >= 0x30) && (uninorth_rev <= 0x33)) { | 271 | if ((uninorth_rev >= 0x30) && (uninorth_rev <= 0x33)) { |
273 | /* | 272 | /* |
274 | * We need to to set REQ_DEPTH to 7 for U3 versions 1.0, 2.1, | 273 | * We need to set REQ_DEPTH to 7 for U3 versions 1.0, 2.1, |
275 | * 2.2 and 2.3, Darwin do so. | 274 | * 2.2 and 2.3, Darwin do so. |
276 | */ | 275 | */ |
277 | if ((command >> AGPSTAT_RQ_DEPTH_SHIFT) > 7) | 276 | if ((command >> AGPSTAT_RQ_DEPTH_SHIFT) > 7) |
@@ -396,6 +395,7 @@ static int uninorth_create_gatt_table(struct agp_bridge_data *bridge) | |||
396 | int i; | 395 | int i; |
397 | void *temp; | 396 | void *temp; |
398 | struct page *page; | 397 | struct page *page; |
398 | struct page **pages; | ||
399 | 399 | ||
400 | /* We can't handle 2 level gatt's */ | 400 | /* We can't handle 2 level gatt's */ |
401 | if (bridge->driver->size_type == LVL2_APER_SIZE) | 401 | if (bridge->driver->size_type == LVL2_APER_SIZE) |
@@ -424,21 +424,39 @@ static int uninorth_create_gatt_table(struct agp_bridge_data *bridge) | |||
424 | if (table == NULL) | 424 | if (table == NULL) |
425 | return -ENOMEM; | 425 | return -ENOMEM; |
426 | 426 | ||
427 | pages = kmalloc((1 << page_order) * sizeof(struct page*), GFP_KERNEL); | ||
428 | if (pages == NULL) | ||
429 | goto enomem; | ||
430 | |||
427 | table_end = table + ((PAGE_SIZE * (1 << page_order)) - 1); | 431 | table_end = table + ((PAGE_SIZE * (1 << page_order)) - 1); |
428 | 432 | ||
429 | for (page = virt_to_page(table); page <= virt_to_page(table_end); page++) | 433 | for (page = virt_to_page(table), i = 0; page <= virt_to_page(table_end); |
434 | page++, i++) { | ||
430 | SetPageReserved(page); | 435 | SetPageReserved(page); |
436 | pages[i] = page; | ||
437 | } | ||
431 | 438 | ||
432 | bridge->gatt_table_real = (u32 *) table; | 439 | bridge->gatt_table_real = (u32 *) table; |
433 | bridge->gatt_table = (u32 *)table; | 440 | /* Need to clear out any dirty data still sitting in caches */ |
434 | bridge->gatt_bus_addr = virt_to_gart(table); | 441 | flush_dcache_range((unsigned long)table, |
442 | (unsigned long)(table_end + PAGE_SIZE)); | ||
443 | bridge->gatt_table = vmap(pages, (1 << page_order), 0, PAGE_KERNEL_NCG); | ||
444 | |||
445 | if (bridge->gatt_table == NULL) | ||
446 | goto enomem; | ||
447 | |||
448 | bridge->gatt_bus_addr = virt_to_phys(table); | ||
435 | 449 | ||
436 | for (i = 0; i < num_entries; i++) | 450 | for (i = 0; i < num_entries; i++) |
437 | bridge->gatt_table[i] = 0; | 451 | bridge->gatt_table[i] = 0; |
438 | 452 | ||
439 | flush_dcache_range((unsigned long)table, (unsigned long)table_end); | ||
440 | |||
441 | return 0; | 453 | return 0; |
454 | |||
455 | enomem: | ||
456 | kfree(pages); | ||
457 | if (table) | ||
458 | free_pages((unsigned long)table, page_order); | ||
459 | return -ENOMEM; | ||
442 | } | 460 | } |
443 | 461 | ||
444 | static int uninorth_free_gatt_table(struct agp_bridge_data *bridge) | 462 | static int uninorth_free_gatt_table(struct agp_bridge_data *bridge) |
@@ -456,6 +474,7 @@ static int uninorth_free_gatt_table(struct agp_bridge_data *bridge) | |||
456 | * from the table. | 474 | * from the table. |
457 | */ | 475 | */ |
458 | 476 | ||
477 | vunmap(bridge->gatt_table); | ||
459 | table = (char *) bridge->gatt_table_real; | 478 | table = (char *) bridge->gatt_table_real; |
460 | table_end = table + ((PAGE_SIZE * (1 << page_order)) - 1); | 479 | table_end = table + ((PAGE_SIZE * (1 << page_order)) - 1); |
461 | 480 | ||
@@ -474,13 +493,11 @@ void null_cache_flush(void) | |||
474 | 493 | ||
475 | /* Setup function */ | 494 | /* Setup function */ |
476 | 495 | ||
477 | static const struct aper_size_info_32 uninorth_sizes[7] = | 496 | static const struct aper_size_info_32 uninorth_sizes[] = |
478 | { | 497 | { |
479 | #if 0 /* Not sure uninorth supports that high aperture sizes */ | ||
480 | {256, 65536, 6, 64}, | 498 | {256, 65536, 6, 64}, |
481 | {128, 32768, 5, 32}, | 499 | {128, 32768, 5, 32}, |
482 | {64, 16384, 4, 16}, | 500 | {64, 16384, 4, 16}, |
483 | #endif | ||
484 | {32, 8192, 3, 8}, | 501 | {32, 8192, 3, 8}, |
485 | {16, 4096, 2, 4}, | 502 | {16, 4096, 2, 4}, |
486 | {8, 2048, 1, 2}, | 503 | {8, 2048, 1, 2}, |
@@ -491,7 +508,7 @@ static const struct aper_size_info_32 uninorth_sizes[7] = | |||
491 | * Not sure that u3 supports that high aperture sizes but it | 508 | * Not sure that u3 supports that high aperture sizes but it |
492 | * would strange if it did not :) | 509 | * would strange if it did not :) |
493 | */ | 510 | */ |
494 | static const struct aper_size_info_32 u3_sizes[8] = | 511 | static const struct aper_size_info_32 u3_sizes[] = |
495 | { | 512 | { |
496 | {512, 131072, 7, 128}, | 513 | {512, 131072, 7, 128}, |
497 | {256, 65536, 6, 64}, | 514 | {256, 65536, 6, 64}, |
@@ -507,7 +524,7 @@ const struct agp_bridge_driver uninorth_agp_driver = { | |||
507 | .owner = THIS_MODULE, | 524 | .owner = THIS_MODULE, |
508 | .aperture_sizes = (void *)uninorth_sizes, | 525 | .aperture_sizes = (void *)uninorth_sizes, |
509 | .size_type = U32_APER_SIZE, | 526 | .size_type = U32_APER_SIZE, |
510 | .num_aperture_sizes = 4, | 527 | .num_aperture_sizes = ARRAY_SIZE(uninorth_sizes), |
511 | .configure = uninorth_configure, | 528 | .configure = uninorth_configure, |
512 | .fetch_size = uninorth_fetch_size, | 529 | .fetch_size = uninorth_fetch_size, |
513 | .cleanup = uninorth_cleanup, | 530 | .cleanup = uninorth_cleanup, |
@@ -534,7 +551,7 @@ const struct agp_bridge_driver u3_agp_driver = { | |||
534 | .owner = THIS_MODULE, | 551 | .owner = THIS_MODULE, |
535 | .aperture_sizes = (void *)u3_sizes, | 552 | .aperture_sizes = (void *)u3_sizes, |
536 | .size_type = U32_APER_SIZE, | 553 | .size_type = U32_APER_SIZE, |
537 | .num_aperture_sizes = 8, | 554 | .num_aperture_sizes = ARRAY_SIZE(u3_sizes), |
538 | .configure = uninorth_configure, | 555 | .configure = uninorth_configure, |
539 | .fetch_size = uninorth_fetch_size, | 556 | .fetch_size = uninorth_fetch_size, |
540 | .cleanup = uninorth_cleanup, | 557 | .cleanup = uninorth_cleanup, |
@@ -717,7 +734,7 @@ module_param(aperture, charp, 0); | |||
717 | MODULE_PARM_DESC(aperture, | 734 | MODULE_PARM_DESC(aperture, |
718 | "Aperture size, must be power of two between 4MB and an\n" | 735 | "Aperture size, must be power of two between 4MB and an\n" |
719 | "\t\tupper limit specific to the UniNorth revision.\n" | 736 | "\t\tupper limit specific to the UniNorth revision.\n" |
720 | "\t\tDefault: 32M"); | 737 | "\t\tDefault: " DEFAULT_APERTURE_STRING "M"); |
721 | 738 | ||
722 | MODULE_AUTHOR("Ben Herrenschmidt & Paul Mackerras"); | 739 | MODULE_AUTHOR("Ben Herrenschmidt & Paul Mackerras"); |
723 | MODULE_LICENSE("GPL"); | 740 | MODULE_LICENSE("GPL"); |
diff --git a/drivers/char/bfin-otp.c b/drivers/char/bfin-otp.c index 0a01329451e4..e3dd24bff514 100644 --- a/drivers/char/bfin-otp.c +++ b/drivers/char/bfin-otp.c | |||
@@ -1,8 +1,7 @@ | |||
1 | /* | 1 | /* |
2 | * Blackfin On-Chip OTP Memory Interface | 2 | * Blackfin On-Chip OTP Memory Interface |
3 | * Supports BF52x/BF54x | ||
4 | * | 3 | * |
5 | * Copyright 2007-2008 Analog Devices Inc. | 4 | * Copyright 2007-2009 Analog Devices Inc. |
6 | * | 5 | * |
7 | * Enter bugs at http://blackfin.uclinux.org/ | 6 | * Enter bugs at http://blackfin.uclinux.org/ |
8 | * | 7 | * |
@@ -17,8 +16,10 @@ | |||
17 | #include <linux/module.h> | 16 | #include <linux/module.h> |
18 | #include <linux/mutex.h> | 17 | #include <linux/mutex.h> |
19 | #include <linux/types.h> | 18 | #include <linux/types.h> |
19 | #include <mtd/mtd-abi.h> | ||
20 | 20 | ||
21 | #include <asm/blackfin.h> | 21 | #include <asm/blackfin.h> |
22 | #include <asm/bfrom.h> | ||
22 | #include <asm/uaccess.h> | 23 | #include <asm/uaccess.h> |
23 | 24 | ||
24 | #define stamp(fmt, args...) pr_debug("%s:%i: " fmt "\n", __func__, __LINE__, ## args) | 25 | #define stamp(fmt, args...) pr_debug("%s:%i: " fmt "\n", __func__, __LINE__, ## args) |
@@ -30,39 +31,6 @@ | |||
30 | 31 | ||
31 | static DEFINE_MUTEX(bfin_otp_lock); | 32 | static DEFINE_MUTEX(bfin_otp_lock); |
32 | 33 | ||
33 | /* OTP Boot ROM functions */ | ||
34 | #define _BOOTROM_OTP_COMMAND 0xEF000018 | ||
35 | #define _BOOTROM_OTP_READ 0xEF00001A | ||
36 | #define _BOOTROM_OTP_WRITE 0xEF00001C | ||
37 | |||
38 | static u32 (* const otp_command)(u32 command, u32 value) = (void *)_BOOTROM_OTP_COMMAND; | ||
39 | static u32 (* const otp_read)(u32 page, u32 flags, u64 *page_content) = (void *)_BOOTROM_OTP_READ; | ||
40 | static u32 (* const otp_write)(u32 page, u32 flags, u64 *page_content) = (void *)_BOOTROM_OTP_WRITE; | ||
41 | |||
42 | /* otp_command(): defines for "command" */ | ||
43 | #define OTP_INIT 0x00000001 | ||
44 | #define OTP_CLOSE 0x00000002 | ||
45 | |||
46 | /* otp_{read,write}(): defines for "flags" */ | ||
47 | #define OTP_LOWER_HALF 0x00000000 /* select upper/lower 64-bit half (bit 0) */ | ||
48 | #define OTP_UPPER_HALF 0x00000001 | ||
49 | #define OTP_NO_ECC 0x00000010 /* do not use ECC */ | ||
50 | #define OTP_LOCK 0x00000020 /* sets page protection bit for page */ | ||
51 | #define OTP_ACCESS_READ 0x00001000 | ||
52 | #define OTP_ACCESS_READWRITE 0x00002000 | ||
53 | |||
54 | /* Return values for all functions */ | ||
55 | #define OTP_SUCCESS 0x00000000 | ||
56 | #define OTP_MASTER_ERROR 0x001 | ||
57 | #define OTP_WRITE_ERROR 0x003 | ||
58 | #define OTP_READ_ERROR 0x005 | ||
59 | #define OTP_ACC_VIO_ERROR 0x009 | ||
60 | #define OTP_DATA_MULT_ERROR 0x011 | ||
61 | #define OTP_ECC_MULT_ERROR 0x021 | ||
62 | #define OTP_PREV_WR_ERROR 0x041 | ||
63 | #define OTP_DATA_SB_WARN 0x100 | ||
64 | #define OTP_ECC_SB_WARN 0x200 | ||
65 | |||
66 | /** | 34 | /** |
67 | * bfin_otp_read - Read OTP pages | 35 | * bfin_otp_read - Read OTP pages |
68 | * | 36 | * |
@@ -86,9 +54,11 @@ static ssize_t bfin_otp_read(struct file *file, char __user *buff, size_t count, | |||
86 | page = *pos / (sizeof(u64) * 2); | 54 | page = *pos / (sizeof(u64) * 2); |
87 | while (bytes_done < count) { | 55 | while (bytes_done < count) { |
88 | flags = (*pos % (sizeof(u64) * 2) ? OTP_UPPER_HALF : OTP_LOWER_HALF); | 56 | flags = (*pos % (sizeof(u64) * 2) ? OTP_UPPER_HALF : OTP_LOWER_HALF); |
89 | stamp("processing page %i (%s)", page, (flags == OTP_UPPER_HALF ? "upper" : "lower")); | 57 | stamp("processing page %i (0x%x:%s)", page, flags, |
90 | ret = otp_read(page, flags, &content); | 58 | (flags & OTP_UPPER_HALF ? "upper" : "lower")); |
59 | ret = bfrom_OtpRead(page, flags, &content); | ||
91 | if (ret & OTP_MASTER_ERROR) { | 60 | if (ret & OTP_MASTER_ERROR) { |
61 | stamp("error from otp: 0x%x", ret); | ||
92 | bytes_done = -EIO; | 62 | bytes_done = -EIO; |
93 | break; | 63 | break; |
94 | } | 64 | } |
@@ -96,7 +66,7 @@ static ssize_t bfin_otp_read(struct file *file, char __user *buff, size_t count, | |||
96 | bytes_done = -EFAULT; | 66 | bytes_done = -EFAULT; |
97 | break; | 67 | break; |
98 | } | 68 | } |
99 | if (flags == OTP_UPPER_HALF) | 69 | if (flags & OTP_UPPER_HALF) |
100 | ++page; | 70 | ++page; |
101 | bytes_done += sizeof(content); | 71 | bytes_done += sizeof(content); |
102 | *pos += sizeof(content); | 72 | *pos += sizeof(content); |
@@ -108,14 +78,53 @@ static ssize_t bfin_otp_read(struct file *file, char __user *buff, size_t count, | |||
108 | } | 78 | } |
109 | 79 | ||
110 | #ifdef CONFIG_BFIN_OTP_WRITE_ENABLE | 80 | #ifdef CONFIG_BFIN_OTP_WRITE_ENABLE |
81 | static bool allow_writes; | ||
82 | |||
83 | /** | ||
84 | * bfin_otp_init_timing - setup OTP timing parameters | ||
85 | * | ||
86 | * Required before doing any write operation. Algorithms from HRM. | ||
87 | */ | ||
88 | static u32 bfin_otp_init_timing(void) | ||
89 | { | ||
90 | u32 tp1, tp2, tp3, timing; | ||
91 | |||
92 | tp1 = get_sclk() / 1000000; | ||
93 | tp2 = (2 * get_sclk() / 10000000) << 8; | ||
94 | tp3 = (0x1401) << 15; | ||
95 | timing = tp1 | tp2 | tp3; | ||
96 | if (bfrom_OtpCommand(OTP_INIT, timing)) | ||
97 | return 0; | ||
98 | |||
99 | return timing; | ||
100 | } | ||
101 | |||
102 | /** | ||
103 | * bfin_otp_deinit_timing - set timings to only allow reads | ||
104 | * | ||
105 | * Should be called after all writes are done. | ||
106 | */ | ||
107 | static void bfin_otp_deinit_timing(u32 timing) | ||
108 | { | ||
109 | /* mask bits [31:15] so that any attempts to write fail */ | ||
110 | bfrom_OtpCommand(OTP_CLOSE, 0); | ||
111 | bfrom_OtpCommand(OTP_INIT, timing & ~(-1 << 15)); | ||
112 | bfrom_OtpCommand(OTP_CLOSE, 0); | ||
113 | } | ||
114 | |||
111 | /** | 115 | /** |
112 | * bfin_otp_write - Write OTP pages | 116 | * bfin_otp_write - write OTP pages |
113 | * | 117 | * |
114 | * All writes must be in half page chunks (half page == 64 bits). | 118 | * All writes must be in half page chunks (half page == 64 bits). |
115 | */ | 119 | */ |
116 | static ssize_t bfin_otp_write(struct file *filp, const char __user *buff, size_t count, loff_t *pos) | 120 | static ssize_t bfin_otp_write(struct file *filp, const char __user *buff, size_t count, loff_t *pos) |
117 | { | 121 | { |
118 | stampit(); | 122 | ssize_t bytes_done; |
123 | u32 timing, page, base_flags, flags, ret; | ||
124 | u64 content; | ||
125 | |||
126 | if (!allow_writes) | ||
127 | return -EACCES; | ||
119 | 128 | ||
120 | if (count % sizeof(u64)) | 129 | if (count % sizeof(u64)) |
121 | return -EMSGSIZE; | 130 | return -EMSGSIZE; |
@@ -123,20 +132,96 @@ static ssize_t bfin_otp_write(struct file *filp, const char __user *buff, size_t | |||
123 | if (mutex_lock_interruptible(&bfin_otp_lock)) | 132 | if (mutex_lock_interruptible(&bfin_otp_lock)) |
124 | return -ERESTARTSYS; | 133 | return -ERESTARTSYS; |
125 | 134 | ||
126 | /* need otp_init() documentation before this can be implemented */ | 135 | stampit(); |
136 | |||
137 | timing = bfin_otp_init_timing(); | ||
138 | if (timing == 0) { | ||
139 | mutex_unlock(&bfin_otp_lock); | ||
140 | return -EIO; | ||
141 | } | ||
142 | |||
143 | base_flags = OTP_CHECK_FOR_PREV_WRITE; | ||
144 | |||
145 | bytes_done = 0; | ||
146 | page = *pos / (sizeof(u64) * 2); | ||
147 | while (bytes_done < count) { | ||
148 | flags = base_flags | (*pos % (sizeof(u64) * 2) ? OTP_UPPER_HALF : OTP_LOWER_HALF); | ||
149 | stamp("processing page %i (0x%x:%s) from %p", page, flags, | ||
150 | (flags & OTP_UPPER_HALF ? "upper" : "lower"), buff + bytes_done); | ||
151 | if (copy_from_user(&content, buff + bytes_done, sizeof(content))) { | ||
152 | bytes_done = -EFAULT; | ||
153 | break; | ||
154 | } | ||
155 | ret = bfrom_OtpWrite(page, flags, &content); | ||
156 | if (ret & OTP_MASTER_ERROR) { | ||
157 | stamp("error from otp: 0x%x", ret); | ||
158 | bytes_done = -EIO; | ||
159 | break; | ||
160 | } | ||
161 | if (flags & OTP_UPPER_HALF) | ||
162 | ++page; | ||
163 | bytes_done += sizeof(content); | ||
164 | *pos += sizeof(content); | ||
165 | } | ||
166 | |||
167 | bfin_otp_deinit_timing(timing); | ||
127 | 168 | ||
128 | mutex_unlock(&bfin_otp_lock); | 169 | mutex_unlock(&bfin_otp_lock); |
129 | 170 | ||
171 | return bytes_done; | ||
172 | } | ||
173 | |||
174 | static long bfin_otp_ioctl(struct file *filp, unsigned cmd, unsigned long arg) | ||
175 | { | ||
176 | stampit(); | ||
177 | |||
178 | switch (cmd) { | ||
179 | case OTPLOCK: { | ||
180 | u32 timing; | ||
181 | int ret = -EIO; | ||
182 | |||
183 | if (!allow_writes) | ||
184 | return -EACCES; | ||
185 | |||
186 | if (mutex_lock_interruptible(&bfin_otp_lock)) | ||
187 | return -ERESTARTSYS; | ||
188 | |||
189 | timing = bfin_otp_init_timing(); | ||
190 | if (timing) { | ||
191 | u32 otp_result = bfrom_OtpWrite(arg, OTP_LOCK, NULL); | ||
192 | stamp("locking page %lu resulted in 0x%x", arg, otp_result); | ||
193 | if (!(otp_result & OTP_MASTER_ERROR)) | ||
194 | ret = 0; | ||
195 | |||
196 | bfin_otp_deinit_timing(timing); | ||
197 | } | ||
198 | |||
199 | mutex_unlock(&bfin_otp_lock); | ||
200 | |||
201 | return ret; | ||
202 | } | ||
203 | |||
204 | case MEMLOCK: | ||
205 | allow_writes = false; | ||
206 | return 0; | ||
207 | |||
208 | case MEMUNLOCK: | ||
209 | allow_writes = true; | ||
210 | return 0; | ||
211 | } | ||
212 | |||
130 | return -EINVAL; | 213 | return -EINVAL; |
131 | } | 214 | } |
132 | #else | 215 | #else |
133 | # define bfin_otp_write NULL | 216 | # define bfin_otp_write NULL |
217 | # define bfin_otp_ioctl NULL | ||
134 | #endif | 218 | #endif |
135 | 219 | ||
136 | static struct file_operations bfin_otp_fops = { | 220 | static struct file_operations bfin_otp_fops = { |
137 | .owner = THIS_MODULE, | 221 | .owner = THIS_MODULE, |
138 | .read = bfin_otp_read, | 222 | .unlocked_ioctl = bfin_otp_ioctl, |
139 | .write = bfin_otp_write, | 223 | .read = bfin_otp_read, |
224 | .write = bfin_otp_write, | ||
140 | }; | 225 | }; |
141 | 226 | ||
142 | static struct miscdevice bfin_otp_misc_device = { | 227 | static struct miscdevice bfin_otp_misc_device = { |
diff --git a/drivers/char/cyclades.c b/drivers/char/cyclades.c index 2dafc2da0648..df5038bbcbc2 100644 --- a/drivers/char/cyclades.c +++ b/drivers/char/cyclades.c | |||
@@ -11,7 +11,7 @@ | |||
11 | * Initially written by Randolph Bentson <bentson@grieg.seaslug.org>. | 11 | * Initially written by Randolph Bentson <bentson@grieg.seaslug.org>. |
12 | * Modified and maintained by Marcio Saito <marcio@cyclades.com>. | 12 | * Modified and maintained by Marcio Saito <marcio@cyclades.com>. |
13 | * | 13 | * |
14 | * Copyright (C) 2007 Jiri Slaby <jirislaby@gmail.com> | 14 | * Copyright (C) 2007-2009 Jiri Slaby <jirislaby@gmail.com> |
15 | * | 15 | * |
16 | * Much of the design and some of the code came from serial.c | 16 | * Much of the design and some of the code came from serial.c |
17 | * which was copyright (C) 1991, 1992 Linus Torvalds. It was | 17 | * which was copyright (C) 1991, 1992 Linus Torvalds. It was |
@@ -19,577 +19,9 @@ | |||
19 | * and then fixed as suggested by Michael K. Johnson 12/12/92. | 19 | * and then fixed as suggested by Michael K. Johnson 12/12/92. |
20 | * Converted to pci probing and cleaned up by Jiri Slaby. | 20 | * Converted to pci probing and cleaned up by Jiri Slaby. |
21 | * | 21 | * |
22 | * This version supports shared IRQ's (only for PCI boards). | ||
23 | * | ||
24 | * Prevent users from opening non-existing Z ports. | ||
25 | * | ||
26 | * Revision 2.3.2.8 2000/07/06 18:14:16 ivan | ||
27 | * Fixed the PCI detection function to work properly on Alpha systems. | ||
28 | * Implemented support for TIOCSERGETLSR ioctl. | ||
29 | * Implemented full support for non-standard baud rates. | ||
30 | * | ||
31 | * Revision 2.3.2.7 2000/06/01 18:26:34 ivan | ||
32 | * Request PLX I/O region, although driver doesn't use it, to avoid | ||
33 | * problems with other drivers accessing it. | ||
34 | * Removed count for on-board buffer characters in cy_chars_in_buffer | ||
35 | * (Cyclades-Z only). | ||
36 | * | ||
37 | * Revision 2.3.2.6 2000/05/05 13:56:05 ivan | ||
38 | * Driver now reports physical instead of virtual memory addresses. | ||
39 | * Masks were added to some Cyclades-Z read accesses. | ||
40 | * Implemented workaround for PLX9050 bug that would cause a system lockup | ||
41 | * in certain systems, depending on the MMIO addresses allocated to the | ||
42 | * board. | ||
43 | * Changed the Tx interrupt programming in the CD1400 chips to boost up | ||
44 | * performance (Cyclom-Y only). | ||
45 | * Code is now compliant with the new module interface (module_[init|exit]). | ||
46 | * Make use of the PCI helper functions to access PCI resources. | ||
47 | * Did some code "housekeeping". | ||
48 | * | ||
49 | * Revision 2.3.2.5 2000/01/19 14:35:33 ivan | ||
50 | * Fixed bug in cy_set_termios on CRTSCTS flag turnoff. | ||
51 | * | ||
52 | * Revision 2.3.2.4 2000/01/17 09:19:40 ivan | ||
53 | * Fixed SMP locking in Cyclom-Y interrupt handler. | ||
54 | * | ||
55 | * Revision 2.3.2.3 1999/12/28 12:11:39 ivan | ||
56 | * Added a new cyclades_card field called nports to allow the driver to | ||
57 | * know the exact number of ports found by the Z firmware after its load; | ||
58 | * RX buffer contention prevention logic on interrupt op mode revisited | ||
59 | * (Cyclades-Z only); | ||
60 | * Revisited printk's for Z debug; | ||
61 | * Driver now makes sure that the constant SERIAL_XMIT_SIZE is defined; | ||
62 | * | ||
63 | * Revision 2.3.2.2 1999/10/01 11:27:43 ivan | ||
64 | * Fixed bug in cyz_poll that would make all ports but port 0 | ||
65 | * unable to transmit/receive data (Cyclades-Z only); | ||
66 | * Implemented logic to prevent the RX buffer from being stuck with data | ||
67 | * due to a driver / firmware race condition in interrupt op mode | ||
68 | * (Cyclades-Z only); | ||
69 | * Fixed bug in block_til_ready logic that would lead to a system crash; | ||
70 | * Revisited cy_close spinlock usage; | ||
71 | * | ||
72 | * Revision 2.3.2.1 1999/09/28 11:01:22 ivan | ||
73 | * Revisited CONFIG_PCI conditional compilation for PCI board support; | ||
74 | * Implemented TIOCGICOUNT and TIOCMIWAIT ioctl support; | ||
75 | * _Major_ cleanup on the Cyclades-Z interrupt support code / logic; | ||
76 | * Removed CTS handling from the driver -- this is now completely handled | ||
77 | * by the firmware (Cyclades-Z only); | ||
78 | * Flush RX on-board buffers on a port open (Cyclades-Z only); | ||
79 | * Fixed handling of ASYNC_SPD_* TTY flags; | ||
80 | * Module unload now unmaps all memory area allocated by ioremap; | ||
81 | * | ||
82 | * Revision 2.3.1.1 1999/07/15 16:45:53 ivan | ||
83 | * Removed CY_PROC conditional compilation; | ||
84 | * Implemented SMP-awareness for the driver; | ||
85 | * Implemented a new ISA IRQ autoprobe that uses the irq_probe_[on|off] | ||
86 | * functions; | ||
87 | * The driver now accepts memory addresses (maddr=0xMMMMM) and IRQs | ||
88 | * (irq=NN) as parameters (only for ISA boards); | ||
89 | * Fixed bug in set_line_char that would prevent the Cyclades-Z | ||
90 | * ports from being configured at speeds above 115.2Kbps; | ||
91 | * Fixed bug in cy_set_termios that would prevent XON/XOFF flow control | ||
92 | * switching from working properly; | ||
93 | * The driver now only prints IRQ info for the Cyclades-Z if it's | ||
94 | * configured to work in interrupt mode; | ||
95 | * | ||
96 | * Revision 2.2.2.3 1999/06/28 11:13:29 ivan | ||
97 | * Added support for interrupt mode operation for the Z cards; | ||
98 | * Removed the driver inactivity control for the Z; | ||
99 | * Added a missing MOD_DEC_USE_COUNT in the cy_open function for when | ||
100 | * the Z firmware is not loaded yet; | ||
101 | * Replaced the "manual" Z Tx flush buffer by a call to a FW command of | ||
102 | * same functionality; | ||
103 | * Implemented workaround for IRQ setting loss on the PCI configuration | ||
104 | * registers after a PCI bridge EEPROM reload (affects PLX9060 only); | ||
105 | * | ||
106 | * Revision 2.2.2.2 1999/05/14 17:18:15 ivan | ||
107 | * /proc entry location changed to /proc/tty/driver/cyclades; | ||
108 | * Added support to shared IRQ's (only for PCI boards); | ||
109 | * Added support for Cobalt Qube2 systems; | ||
110 | * IRQ [de]allocation scheme revisited; | ||
111 | * BREAK implementation changed in order to make use of the 'break_ctl' | ||
112 | * TTY facility; | ||
113 | * Fixed typo in TTY structure field 'driver_name'; | ||
114 | * Included a PCI bridge reset and EEPROM reload in the board | ||
115 | * initialization code (for both Y and Z series). | ||
116 | * | ||
117 | * Revision 2.2.2.1 1999/04/08 16:17:43 ivan | ||
118 | * Fixed a bug in cy_wait_until_sent that was preventing the port to be | ||
119 | * closed properly after a SIGINT; | ||
120 | * Module usage counter scheme revisited; | ||
121 | * Added support to the upcoming Y PCI boards (i.e., support to additional | ||
122 | * PCI Device ID's). | ||
123 | * | ||
124 | * Revision 2.2.1.10 1999/01/20 16:14:29 ivan | ||
125 | * Removed all unnecessary page-alignement operations in ioremap calls | ||
126 | * (ioremap is currently safe for these operations). | ||
127 | * | ||
128 | * Revision 2.2.1.9 1998/12/30 18:18:30 ivan | ||
129 | * Changed access to PLX PCI bridge registers from I/O to MMIO, in | ||
130 | * order to make PLX9050-based boards work with certain motherboards. | ||
131 | * | ||
132 | * Revision 2.2.1.8 1998/11/13 12:46:20 ivan | ||
133 | * cy_close function now resets (correctly) the tty->closing flag; | ||
134 | * JIFFIES_DIFF macro fixed. | ||
135 | * | ||
136 | * Revision 2.2.1.7 1998/09/03 12:07:28 ivan | ||
137 | * Fixed bug in cy_close function, which was not informing HW of | ||
138 | * which port should have the reception disabled before doing so; | ||
139 | * fixed Cyclom-8YoP hardware detection bug. | ||
140 | * | ||
141 | * Revision 2.2.1.6 1998/08/20 17:15:39 ivan | ||
142 | * Fixed bug in cy_close function, which causes malfunction | ||
143 | * of one of the first 4 ports when a higher port is closed | ||
144 | * (Cyclom-Y only). | ||
145 | * | ||
146 | * Revision 2.2.1.5 1998/08/10 18:10:28 ivan | ||
147 | * Fixed Cyclom-4Yo hardware detection bug. | ||
148 | * | ||
149 | * Revision 2.2.1.4 1998/08/04 11:02:50 ivan | ||
150 | * /proc/cyclades implementation with great collaboration of | ||
151 | * Marc Lewis <marc@blarg.net>; | ||
152 | * cyy_interrupt was changed to avoid occurrence of kernel oopses | ||
153 | * during PPP operation. | ||
154 | * | ||
155 | * Revision 2.2.1.3 1998/06/01 12:09:10 ivan | ||
156 | * General code review in order to comply with 2.1 kernel standards; | ||
157 | * data loss prevention for slow devices revisited (cy_wait_until_sent | ||
158 | * was created); | ||
159 | * removed conditional compilation for new/old PCI structure support | ||
160 | * (now the driver only supports the new PCI structure). | ||
161 | * | ||
162 | * Revision 2.2.1.1 1998/03/19 16:43:12 ivan | ||
163 | * added conditional compilation for new/old PCI structure support; | ||
164 | * removed kernel series (2.0.x / 2.1.x) conditional compilation. | ||
165 | * | ||
166 | * Revision 2.1.1.3 1998/03/16 18:01:12 ivan | ||
167 | * cleaned up the data loss fix; | ||
168 | * fixed XON/XOFF handling once more (Cyclades-Z); | ||
169 | * general review of the driver routines; | ||
170 | * introduction of a mechanism to prevent data loss with slow | ||
171 | * printers, by forcing a delay before closing the port. | ||
172 | * | ||
173 | * Revision 2.1.1.2 1998/02/17 16:50:00 ivan | ||
174 | * fixed detection/handling of new CD1400 in Ye boards; | ||
175 | * fixed XON/XOFF handling (Cyclades-Z); | ||
176 | * fixed data loss caused by a premature port close; | ||
177 | * introduction of a flag that holds the CD1400 version ID per port | ||
178 | * (used by the CYGETCD1400VER new ioctl). | ||
179 | * | ||
180 | * Revision 2.1.1.1 1997/12/03 17:31:19 ivan | ||
181 | * Code review for the module cleanup routine; | ||
182 | * fixed RTS and DTR status report for new CD1400's in get_modem_info; | ||
183 | * includes anonymous changes regarding signal_pending. | ||
184 | * | ||
185 | * Revision 2.1 1997/11/01 17:42:41 ivan | ||
186 | * Changes in the driver to support Alpha systems (except 8Zo V_1); | ||
187 | * BREAK fix for the Cyclades-Z boards; | ||
188 | * driver inactivity control by FW implemented; | ||
189 | * introduction of flag that allows driver to take advantage of | ||
190 | * a special CD1400 feature related to HW flow control; | ||
191 | * added support for the CD1400 rev. J (Cyclom-Y boards); | ||
192 | * introduction of ioctls to: | ||
193 | * - control the rtsdtr_inv flag (Cyclom-Y); | ||
194 | * - control the rflow flag (Cyclom-Y); | ||
195 | * - adjust the polling interval (Cyclades-Z); | ||
196 | * | ||
197 | * Revision 1.36.4.33 1997/06/27 19:00:00 ivan | ||
198 | * Fixes related to kernel version conditional | ||
199 | * compilation. | ||
200 | * | ||
201 | * Revision 1.36.4.32 1997/06/14 19:30:00 ivan | ||
202 | * Compatibility issues between kernels 2.0.x and | ||
203 | * 2.1.x (mainly related to clear_bit function). | ||
204 | * | ||
205 | * Revision 1.36.4.31 1997/06/03 15:30:00 ivan | ||
206 | * Changes to define the memory window according to the | ||
207 | * board type. | ||
208 | * | ||
209 | * Revision 1.36.4.30 1997/05/16 15:30:00 daniel | ||
210 | * Changes to support new cycladesZ boards. | ||
211 | * | ||
212 | * Revision 1.36.4.29 1997/05/12 11:30:00 daniel | ||
213 | * Merge of Bentson's and Daniel's version 1.36.4.28. | ||
214 | * Corrects bug in cy_detect_pci: check if there are more | ||
215 | * ports than the number of static structs allocated. | ||
216 | * Warning message during initialization if this driver is | ||
217 | * used with the new generation of cycladesZ boards. Those | ||
218 | * will be supported only in next release of the driver. | ||
219 | * Corrects bug in cy_detect_pci and cy_detect_isa that | ||
220 | * returned wrong number of VALID boards, when a cyclomY | ||
221 | * was found with no serial modules connected. | ||
222 | * Changes to use current (2.1.x) kernel subroutine names | ||
223 | * and created macros for compilation with 2.0.x kernel, | ||
224 | * instead of the other way around. | ||
225 | * | ||
226 | * Revision 1.36.4.28 1997/05/?? ??:00:00 bentson | ||
227 | * Change queue_task_irq_off to queue_task_irq. | ||
228 | * The inline function queue_task_irq_off (tqueue.h) | ||
229 | * was removed from latest releases of 2.1.x kernel. | ||
230 | * Use of macro __init to mark the initialization | ||
231 | * routines, so memory can be reused. | ||
232 | * Also incorporate implementation of critical region | ||
233 | * in function cleanup_module() created by anonymous | ||
234 | * linuxer. | ||
235 | * | ||
236 | * Revision 1.36.4.28 1997/04/25 16:00:00 daniel | ||
237 | * Change to support new firmware that solves DCD problem: | ||
238 | * application could fail to receive SIGHUP signal when DCD | ||
239 | * varying too fast. | ||
240 | * | ||
241 | * Revision 1.36.4.27 1997/03/26 10:30:00 daniel | ||
242 | * Changed for support linux versions 2.1.X. | ||
243 | * Backward compatible with linux versions 2.0.X. | ||
244 | * Corrected illegal use of filler field in | ||
245 | * CH_CTRL struct. | ||
246 | * Deleted some debug messages. | ||
247 | * | ||
248 | * Revision 1.36.4.26 1997/02/27 12:00:00 daniel | ||
249 | * Included check for NULL tty pointer in cyz_poll. | ||
250 | * | ||
251 | * Revision 1.36.4.25 1997/02/26 16:28:30 bentson | ||
252 | * Bill Foster at Blarg! Online services noticed that | ||
253 | * some of the switch elements of -Z modem control | ||
254 | * lacked a closing "break;" | ||
255 | * | ||
256 | * Revision 1.36.4.24 1997/02/24 11:00:00 daniel | ||
257 | * Changed low water threshold for buffer xmit_buf | ||
258 | * | ||
259 | * Revision 1.36.4.23 1996/12/02 21:50:16 bentson | ||
260 | * Marcio provided fix to modem status fetch for -Z | ||
261 | * | ||
262 | * Revision 1.36.4.22 1996/10/28 22:41:17 bentson | ||
263 | * improve mapping of -Z control page (thanks to Steve | ||
264 | * Price <stevep@fa.tdktca.com> for help on this) | ||
265 | * | ||
266 | * Revision 1.36.4.21 1996/09/10 17:00:10 bentson | ||
267 | * shift from CPU-bound to memcopy in cyz_polling operation | ||
268 | * | ||
269 | * Revision 1.36.4.20 1996/09/09 18:30:32 Bentson | ||
270 | * Added support to set and report higher speeds. | ||
271 | * | ||
272 | * Revision 1.36.4.19c 1996/08/09 10:00:00 Marcio Saito | ||
273 | * Some fixes in the HW flow control for the BETA release. | ||
274 | * Don't try to register the IRQ. | ||
275 | * | ||
276 | * Revision 1.36.4.19 1996/08/08 16:23:18 Bentson | ||
277 | * make sure "cyc" appears in all kernel messages; all soft interrupts | ||
278 | * handled by same routine; recognize out-of-band reception; comment | ||
279 | * out some diagnostic messages; leave RTS/CTS flow control to hardware; | ||
280 | * fix race condition in -Z buffer management; only -Y needs to explicitly | ||
281 | * flush chars; tidy up some startup messages; | ||
282 | * | ||
283 | * Revision 1.36.4.18 1996/07/25 18:57:31 bentson | ||
284 | * shift MOD_INC_USE_COUNT location to match | ||
285 | * serial.c; purge some diagnostic messages; | ||
286 | * | ||
287 | * Revision 1.36.4.17 1996/07/25 18:01:08 bentson | ||
288 | * enable modem status messages and fetch & process them; note | ||
289 | * time of last activity type for each port; set_line_char now | ||
290 | * supports more than line 0 and treats 0 baud correctly; | ||
291 | * get_modem_info senses rs_status; | ||
292 | * | ||
293 | * Revision 1.36.4.16 1996/07/20 08:43:15 bentson | ||
294 | * barely works--now's time to turn on | ||
295 | * more features 'til it breaks | ||
296 | * | ||
297 | * Revision 1.36.4.15 1996/07/19 22:30:06 bentson | ||
298 | * check more -Z board status; shorten boot message | ||
299 | * | ||
300 | * Revision 1.36.4.14 1996/07/19 22:20:37 bentson | ||
301 | * fix reference to ch_ctrl in startup; verify return | ||
302 | * values from cyz_issue_cmd and cyz_update_channel; | ||
303 | * more stuff to get modem control correct; | ||
304 | * | ||
305 | * Revision 1.36.4.13 1996/07/11 19:53:33 bentson | ||
306 | * more -Z stuff folded in; re-order changes to put -Z stuff | ||
307 | * after -Y stuff (to make changes clearer) | ||
308 | * | ||
309 | * Revision 1.36.4.12 1996/07/11 15:40:55 bentson | ||
310 | * Add code to poll Cyclades-Z. Add code to get & set RS-232 control. | ||
311 | * Add code to send break. Clear firmware ID word at startup (so | ||
312 | * that other code won't talk to inactive board). | ||
313 | * | ||
314 | * Revision 1.36.4.11 1996/07/09 05:28:29 bentson | ||
315 | * add code for -Z in set_line_char | ||
316 | * | ||
317 | * Revision 1.36.4.10 1996/07/08 19:28:37 bentson | ||
318 | * fold more -Z stuff (or in some cases, error messages) | ||
319 | * into driver; add text to "don't know what to do" messages. | ||
320 | * | ||
321 | * Revision 1.36.4.9 1996/07/08 18:38:38 bentson | ||
322 | * moved compile-time flags near top of file; cosmetic changes | ||
323 | * to narrow text (to allow 2-up printing); changed many declarations | ||
324 | * to "static" to limit external symbols; shuffled code order to | ||
325 | * coalesce -Y and -Z specific code, also to put internal functions | ||
326 | * in order of tty_driver structure; added code to recognize -Z | ||
327 | * ports (and for moment, do nothing or report error); add cy_startup | ||
328 | * to parse boot command line for extra base addresses for ISA probes; | ||
329 | * | ||
330 | * Revision 1.36.4.8 1996/06/25 17:40:19 bentson | ||
331 | * reorder some code, fix types of some vars (int vs. long), | ||
332 | * add cy_setup to support user declared ISA addresses | ||
333 | * | ||
334 | * Revision 1.36.4.7 1996/06/21 23:06:18 bentson | ||
335 | * dump ioctl based firmware load (it's now a user level | ||
336 | * program); ensure uninitialzed ports cannot be used | ||
337 | * | ||
338 | * Revision 1.36.4.6 1996/06/20 23:17:19 bentson | ||
339 | * rename vars and restructure some code | ||
340 | * | ||
341 | * Revision 1.36.4.5 1996/06/14 15:09:44 bentson | ||
342 | * get right status back after boot load | ||
343 | * | ||
344 | * Revision 1.36.4.4 1996/06/13 19:51:44 bentson | ||
345 | * successfully loads firmware | ||
346 | * | ||
347 | * Revision 1.36.4.3 1996/06/13 06:08:33 bentson | ||
348 | * add more of the code for the boot/load ioctls | ||
349 | * | ||
350 | * Revision 1.36.4.2 1996/06/11 21:00:51 bentson | ||
351 | * start to add Z functionality--starting with ioctl | ||
352 | * for loading firmware | ||
353 | * | ||
354 | * Revision 1.36.4.1 1996/06/10 18:03:02 bentson | ||
355 | * added code to recognize Z/PCI card at initialization; report | ||
356 | * presence, but card is not initialized (because firmware needs | ||
357 | * to be loaded) | ||
358 | * | ||
359 | * Revision 1.36.3.8 1996/06/07 16:29:00 bentson | ||
360 | * starting minor number at zero; added missing verify_area | ||
361 | * as noted by Heiko Eißfeldt <heiko@colossus.escape.de> | ||
362 | * | ||
363 | * Revision 1.36.3.7 1996/04/19 21:06:18 bentson | ||
364 | * remove unneeded boot message & fix CLOCAL hardware flow | ||
365 | * control (Miquel van Smoorenburg <miquels@Q.cistron.nl>); | ||
366 | * remove unused diagnostic statements; minor 0 is first; | ||
367 | * | ||
368 | * Revision 1.36.3.6 1996/03/13 13:21:17 marcio | ||
369 | * The kernel function vremap (available only in later 1.3.xx kernels) | ||
370 | * allows the access to memory addresses above the RAM. This revision | ||
371 | * of the driver supports PCI boards below 1Mb (device id 0x100) and | ||
372 | * above 1Mb (device id 0x101). | ||
373 | * | ||
374 | * Revision 1.36.3.5 1996/03/07 15:20:17 bentson | ||
375 | * Some global changes to interrupt handling spilled into | ||
376 | * this driver--mostly unused arguments in system function | ||
377 | * calls. Also added change by Marcio Saito which should | ||
378 | * reduce lost interrupts at startup by fast processors. | ||
379 | * | ||
380 | * Revision 1.36.3.4 1995/11/13 20:45:10 bentson | ||
381 | * Changes by Corey Minyard <minyard@wf-rch.cirr.com> distributed | ||
382 | * in 1.3.41 kernel to remove a possible race condition, extend | ||
383 | * some error messages, and let the driver run as a loadable module | ||
384 | * Change by Alan Wendt <alan@ez0.ezlink.com> to remove a | ||
385 | * possible race condition. | ||
386 | * Change by Marcio Saito <marcio@cyclades.com> to fix PCI addressing. | ||
387 | * | ||
388 | * Revision 1.36.3.3 1995/11/13 19:44:48 bentson | ||
389 | * Changes by Linus Torvalds in 1.3.33 kernel distribution | ||
390 | * required due to reordering of driver initialization. | ||
391 | * Drivers are now initialized *after* memory management. | ||
392 | * | ||
393 | * Revision 1.36.3.2 1995/09/08 22:07:14 bentson | ||
394 | * remove printk from ISR; fix typo | ||
395 | * | ||
396 | * Revision 1.36.3.1 1995/09/01 12:00:42 marcio | ||
397 | * Minor fixes in the PCI board support. PCI function calls in | ||
398 | * conditional compilation (CONFIG_PCI). Thanks to Jim Duncan | ||
399 | * <duncan@okay.com>. "bad serial count" message removed. | ||
400 | * | ||
401 | * Revision 1.36.3 1995/08/22 09:19:42 marcio | ||
402 | * Cyclom-Y/PCI support added. Changes in the cy_init routine and | ||
403 | * board initialization. Changes in the boot messages. The driver | ||
404 | * supports up to 4 boards and 64 ports by default. | ||
405 | * | ||
406 | * Revision 1.36.1.4 1995/03/29 06:14:14 bentson | ||
407 | * disambiguate between Cyclom-16Y and Cyclom-32Ye; | ||
408 | * | ||
409 | * Revision 1.36.1.3 1995/03/23 22:15:35 bentson | ||
410 | * add missing break in modem control block in ioctl switch statement | ||
411 | * (discovered by Michael Edward Chastain <mec@jobe.shell.portal.com>); | ||
412 | * | ||
413 | * Revision 1.36.1.2 1995/03/22 19:16:22 bentson | ||
414 | * make sure CTS flow control is set as soon as possible (thanks | ||
415 | * to note from David Lambert <lambert@chesapeake.rps.slb.com>); | ||
416 | * | ||
417 | * Revision 1.36.1.1 1995/03/13 15:44:43 bentson | ||
418 | * initialize defaults for receive threshold and stale data timeout; | ||
419 | * cosmetic changes; | ||
420 | * | ||
421 | * Revision 1.36 1995/03/10 23:33:53 bentson | ||
422 | * added support of chips 4-7 in 32 port Cyclom-Ye; | ||
423 | * fix cy_interrupt pointer dereference problem | ||
424 | * (Joe Portman <baron@aa.net>); | ||
425 | * give better error response if open is attempted on non-existent port | ||
426 | * (Zachariah Vaum <jchryslr@netcom.com>); | ||
427 | * correct command timeout (Kenneth Lerman <lerman@@seltd.newnet.com>); | ||
428 | * conditional compilation for -16Y on systems with fast, noisy bus; | ||
429 | * comment out diagnostic print function; | ||
430 | * cleaned up table of base addresses; | ||
431 | * set receiver time-out period register to correct value, | ||
432 | * set receive threshold to better default values, | ||
433 | * set chip timer to more accurate 200 Hz ticking, | ||
434 | * add code to monitor and modify receive parameters | ||
435 | * (Rik Faith <faith@cs.unc.edu> Nick Simicich | ||
436 | * <njs@scifi.emi.net>); | ||
437 | * | ||
438 | * Revision 1.35 1994/12/16 13:54:18 steffen | ||
439 | * additional patch by Marcio Saito for board detection | ||
440 | * Accidently left out in 1.34 | ||
441 | * | ||
442 | * Revision 1.34 1994/12/10 12:37:12 steffen | ||
443 | * This is the corrected version as suggested by Marcio Saito | ||
444 | * | ||
445 | * Revision 1.33 1994/12/01 22:41:18 bentson | ||
446 | * add hooks to support more high speeds directly; add tytso | ||
447 | * patch regarding CLOCAL wakeups | ||
448 | * | ||
449 | * Revision 1.32 1994/11/23 19:50:04 bentson | ||
450 | * allow direct kernel control of higher signalling rates; | ||
451 | * look for cards at additional locations | ||
452 | * | ||
453 | * Revision 1.31 1994/11/16 04:33:28 bentson | ||
454 | * ANOTHER fix from Corey Minyard, minyard@wf-rch.cirr.com-- | ||
455 | * a problem in chars_in_buffer has been resolved by some | ||
456 | * small changes; this should yield smoother output | ||
457 | * | ||
458 | * Revision 1.30 1994/11/16 04:28:05 bentson | ||
459 | * Fix from Corey Minyard, Internet: minyard@metronet.com, | ||
460 | * UUCP: minyard@wf-rch.cirr.com, WORK: minyardbnr.ca, to | ||
461 | * cy_hangup that appears to clear up much (all?) of the | ||
462 | * DTR glitches; also he's added/cleaned-up diagnostic messages | ||
463 | * | ||
464 | * Revision 1.29 1994/11/16 04:16:07 bentson | ||
465 | * add change proposed by Ralph Sims, ralphs@halcyon.com, to | ||
466 | * operate higher speeds in same way as other serial ports; | ||
467 | * add more serial ports (for up to two 16-port muxes). | ||
468 | * | ||
469 | * Revision 1.28 1994/11/04 00:13:16 root | ||
470 | * turn off diagnostic messages | ||
471 | * | ||
472 | * Revision 1.27 1994/11/03 23:46:37 root | ||
473 | * bunch of changes to bring driver into greater conformance | ||
474 | * with the serial.c driver (looking for missed fixes) | ||
475 | * | ||
476 | * Revision 1.26 1994/11/03 22:40:36 root | ||
477 | * automatic interrupt probing fixed. | ||
478 | * | ||
479 | * Revision 1.25 1994/11/03 20:17:02 root | ||
480 | * start to implement auto-irq | ||
481 | * | ||
482 | * Revision 1.24 1994/11/03 18:01:55 root | ||
483 | * still working on modem signals--trying not to drop DTR | ||
484 | * during the getty/login processes | ||
485 | * | ||
486 | * Revision 1.23 1994/11/03 17:51:36 root | ||
487 | * extend baud rate support; set receive threshold as function | ||
488 | * of baud rate; fix some problems with RTS/CTS; | ||
489 | * | ||
490 | * Revision 1.22 1994/11/02 18:05:35 root | ||
491 | * changed arguments to udelay to type long to get | ||
492 | * delays to be of correct duration | ||
493 | * | ||
494 | * Revision 1.21 1994/11/02 17:37:30 root | ||
495 | * employ udelay (after calibrating loops_per_second earlier | ||
496 | * in init/main.c) instead of using home-grown delay routines | ||
497 | * | ||
498 | * Revision 1.20 1994/11/02 03:11:38 root | ||
499 | * cy_chars_in_buffer forces a return value of 0 to let | ||
500 | * login work (don't know why it does); some functions | ||
501 | * that were returning EFAULT, now executes the code; | ||
502 | * more work on deciding when to disable xmit interrupts; | ||
503 | * | ||
504 | * Revision 1.19 1994/11/01 20:10:14 root | ||
505 | * define routine to start transmission interrupts (by enabling | ||
506 | * transmit interrupts); directly enable/disable modem interrupts; | ||
507 | * | ||
508 | * Revision 1.18 1994/11/01 18:40:45 bentson | ||
509 | * Don't always enable transmit interrupts in startup; interrupt on | ||
510 | * TxMpty instead of TxRdy to help characters get out before shutdown; | ||
511 | * restructure xmit interrupt to check for chars first and quit if | ||
512 | * none are ready to go; modem status (MXVRx) is upright, _not_ inverted | ||
513 | * (to my view); | ||
514 | * | ||
515 | * Revision 1.17 1994/10/30 04:39:45 bentson | ||
516 | * rename serial_driver and callout_driver to cy_serial_driver and | ||
517 | * cy_callout_driver to avoid linkage interference; initialize | ||
518 | * info->type to PORT_CIRRUS; ruggedize paranoia test; elide ->port | ||
519 | * from cyclades_port structure; add paranoia check to cy_close; | ||
520 | * | ||
521 | * Revision 1.16 1994/10/30 01:14:33 bentson | ||
522 | * change major numbers; add some _early_ return statements; | ||
523 | * | ||
524 | * Revision 1.15 1994/10/29 06:43:15 bentson | ||
525 | * final tidying up for clean compile; enable some error reporting | ||
526 | * | ||
527 | * Revision 1.14 1994/10/28 20:30:22 Bentson | ||
528 | * lots of changes to drag the driver towards the new tty_io | ||
529 | * structures and operation. not expected to work, but may | ||
530 | * compile cleanly. | ||
531 | * | ||
532 | * Revision 1.13 1994/07/21 23:08:57 Bentson | ||
533 | * add some diagnostic cruft; support 24 lines (for testing | ||
534 | * both -8Y and -16Y cards; be more thorough in servicing all | ||
535 | * chips during interrupt; add "volatile" a few places to | ||
536 | * circumvent compiler optimizations; fix base & offset | ||
537 | * computations in block_til_ready (was causing chip 0 to | ||
538 | * stop operation) | ||
539 | * | ||
540 | * Revision 1.12 1994/07/19 16:42:11 Bentson | ||
541 | * add some hackery for kernel version 1.1.8; expand | ||
542 | * error messages; refine timing for delay loops and | ||
543 | * declare loop params volatile | ||
544 | * | ||
545 | * Revision 1.11 1994/06/11 21:53:10 bentson | ||
546 | * get use of save_car right in transmit interrupt service | ||
547 | * | ||
548 | * Revision 1.10.1.1 1994/06/11 21:31:18 bentson | ||
549 | * add some diagnostic printing; try to fix save_car stuff | ||
550 | * | ||
551 | * Revision 1.10 1994/06/11 20:36:08 bentson | ||
552 | * clean up compiler warnings | ||
553 | * | ||
554 | * Revision 1.9 1994/06/11 19:42:46 bentson | ||
555 | * added a bunch of code to support modem signalling | ||
556 | * | ||
557 | * Revision 1.8 1994/06/11 17:57:07 bentson | ||
558 | * recognize break & parity error | ||
559 | * | ||
560 | * Revision 1.7 1994/06/05 05:51:34 bentson | ||
561 | * Reorder baud table to be monotonic; add cli to CP; discard | ||
562 | * incoming characters and status if the line isn't open; start to | ||
563 | * fold code into cy_throttle; start to port get_serial_info, | ||
564 | * set_serial_info, get_modem_info, set_modem_info, and send_break | ||
565 | * from serial.c; expand cy_ioctl; relocate and expand config_setup; | ||
566 | * get flow control characters from tty struct; invalidate ports w/o | ||
567 | * hardware; | ||
568 | * | ||
569 | * Revision 1.6 1994/05/31 18:42:21 bentson | ||
570 | * add a loop-breaker in the interrupt service routine; | ||
571 | * note when port is initialized so that it can be shut | ||
572 | * down under the right conditions; receive works without | ||
573 | * any obvious errors | ||
574 | * | ||
575 | * Revision 1.5 1994/05/30 00:55:02 bentson | ||
576 | * transmit works without obvious errors | ||
577 | * | ||
578 | * Revision 1.4 1994/05/27 18:46:27 bentson | ||
579 | * incorporated more code from lib_y.c; can now print short | ||
580 | * strings under interrupt control to port zero; seems to | ||
581 | * select ports/channels/lines correctly | ||
582 | * | ||
583 | * Revision 1.3 1994/05/25 22:12:44 bentson | ||
584 | * shifting from multi-port on a card to proper multiplexor | ||
585 | * data structures; added skeletons of most routines | ||
586 | * | ||
587 | * Revision 1.2 1994/05/19 13:21:43 bentson | ||
588 | * start to crib from other sources | ||
589 | * | ||
590 | */ | 22 | */ |
591 | 23 | ||
592 | #define CY_VERSION "2.5" | 24 | #define CY_VERSION "2.6" |
593 | 25 | ||
594 | /* If you need to install more boards than NR_CARDS, change the constant | 26 | /* If you need to install more boards than NR_CARDS, change the constant |
595 | in the definition below. No other change is necessary to support up to | 27 | in the definition below. No other change is necessary to support up to |
@@ -648,9 +80,7 @@ | |||
648 | #include <linux/firmware.h> | 80 | #include <linux/firmware.h> |
649 | #include <linux/device.h> | 81 | #include <linux/device.h> |
650 | 82 | ||
651 | #include <asm/system.h> | ||
652 | #include <linux/io.h> | 83 | #include <linux/io.h> |
653 | #include <asm/irq.h> | ||
654 | #include <linux/uaccess.h> | 84 | #include <linux/uaccess.h> |
655 | 85 | ||
656 | #include <linux/kernel.h> | 86 | #include <linux/kernel.h> |
@@ -660,13 +90,11 @@ | |||
660 | #include <linux/proc_fs.h> | 90 | #include <linux/proc_fs.h> |
661 | #include <linux/seq_file.h> | 91 | #include <linux/seq_file.h> |
662 | 92 | ||
663 | static void cy_throttle(struct tty_struct *tty); | ||
664 | static void cy_send_xchar(struct tty_struct *tty, char ch); | 93 | static void cy_send_xchar(struct tty_struct *tty, char ch); |
665 | 94 | ||
666 | #ifndef SERIAL_XMIT_SIZE | 95 | #ifndef SERIAL_XMIT_SIZE |
667 | #define SERIAL_XMIT_SIZE (min(PAGE_SIZE, 4096)) | 96 | #define SERIAL_XMIT_SIZE (min(PAGE_SIZE, 4096)) |
668 | #endif | 97 | #endif |
669 | #define WAKEUP_CHARS 256 | ||
670 | 98 | ||
671 | #define STD_COM_FLAGS (0) | 99 | #define STD_COM_FLAGS (0) |
672 | 100 | ||
@@ -756,25 +184,25 @@ static int cy_next_channel; /* next minor available */ | |||
756 | * HI VHI | 184 | * HI VHI |
757 | * 20 | 185 | * 20 |
758 | */ | 186 | */ |
759 | static int baud_table[] = { | 187 | static const int baud_table[] = { |
760 | 0, 50, 75, 110, 134, 150, 200, 300, 600, 1200, | 188 | 0, 50, 75, 110, 134, 150, 200, 300, 600, 1200, |
761 | 1800, 2400, 4800, 9600, 19200, 38400, 57600, 76800, 115200, 150000, | 189 | 1800, 2400, 4800, 9600, 19200, 38400, 57600, 76800, 115200, 150000, |
762 | 230400, 0 | 190 | 230400, 0 |
763 | }; | 191 | }; |
764 | 192 | ||
765 | static char baud_co_25[] = { /* 25 MHz clock option table */ | 193 | static const char baud_co_25[] = { /* 25 MHz clock option table */ |
766 | /* value => 00 01 02 03 04 */ | 194 | /* value => 00 01 02 03 04 */ |
767 | /* divide by 8 32 128 512 2048 */ | 195 | /* divide by 8 32 128 512 2048 */ |
768 | 0x00, 0x04, 0x04, 0x04, 0x04, 0x04, 0x03, 0x03, 0x03, 0x02, | 196 | 0x00, 0x04, 0x04, 0x04, 0x04, 0x04, 0x03, 0x03, 0x03, 0x02, |
769 | 0x02, 0x02, 0x01, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 | 197 | 0x02, 0x02, 0x01, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 |
770 | }; | 198 | }; |
771 | 199 | ||
772 | static char baud_bpr_25[] = { /* 25 MHz baud rate period table */ | 200 | static const char baud_bpr_25[] = { /* 25 MHz baud rate period table */ |
773 | 0x00, 0xf5, 0xa3, 0x6f, 0x5c, 0x51, 0xf5, 0xa3, 0x51, 0xa3, | 201 | 0x00, 0xf5, 0xa3, 0x6f, 0x5c, 0x51, 0xf5, 0xa3, 0x51, 0xa3, |
774 | 0x6d, 0x51, 0xa3, 0x51, 0xa3, 0x51, 0x36, 0x29, 0x1b, 0x15 | 202 | 0x6d, 0x51, 0xa3, 0x51, 0xa3, 0x51, 0x36, 0x29, 0x1b, 0x15 |
775 | }; | 203 | }; |
776 | 204 | ||
777 | static char baud_co_60[] = { /* 60 MHz clock option table (CD1400 J) */ | 205 | static const char baud_co_60[] = { /* 60 MHz clock option table (CD1400 J) */ |
778 | /* value => 00 01 02 03 04 */ | 206 | /* value => 00 01 02 03 04 */ |
779 | /* divide by 8 32 128 512 2048 */ | 207 | /* divide by 8 32 128 512 2048 */ |
780 | 0x00, 0x00, 0x00, 0x04, 0x04, 0x04, 0x04, 0x04, 0x03, 0x03, | 208 | 0x00, 0x00, 0x00, 0x04, 0x04, 0x04, 0x04, 0x04, 0x03, 0x03, |
@@ -782,13 +210,13 @@ static char baud_co_60[] = { /* 60 MHz clock option table (CD1400 J) */ | |||
782 | 0x00 | 210 | 0x00 |
783 | }; | 211 | }; |
784 | 212 | ||
785 | static char baud_bpr_60[] = { /* 60 MHz baud rate period table (CD1400 J) */ | 213 | static const char baud_bpr_60[] = { /* 60 MHz baud rate period table (CD1400 J) */ |
786 | 0x00, 0x82, 0x21, 0xff, 0xdb, 0xc3, 0x92, 0x62, 0xc3, 0x62, | 214 | 0x00, 0x82, 0x21, 0xff, 0xdb, 0xc3, 0x92, 0x62, 0xc3, 0x62, |
787 | 0x41, 0xc3, 0x62, 0xc3, 0x62, 0xc3, 0x82, 0x62, 0x41, 0x32, | 215 | 0x41, 0xc3, 0x62, 0xc3, 0x62, 0xc3, 0x82, 0x62, 0x41, 0x32, |
788 | 0x21 | 216 | 0x21 |
789 | }; | 217 | }; |
790 | 218 | ||
791 | static char baud_cor3[] = { /* receive threshold */ | 219 | static const char baud_cor3[] = { /* receive threshold */ |
792 | 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, | 220 | 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, |
793 | 0x0a, 0x0a, 0x0a, 0x09, 0x09, 0x08, 0x08, 0x08, 0x08, 0x07, | 221 | 0x0a, 0x0a, 0x0a, 0x09, 0x09, 0x08, 0x08, 0x08, 0x08, 0x07, |
794 | 0x07 | 222 | 0x07 |
@@ -805,7 +233,7 @@ static char baud_cor3[] = { /* receive threshold */ | |||
805 | * cables. | 233 | * cables. |
806 | */ | 234 | */ |
807 | 235 | ||
808 | static char rflow_thr[] = { /* rflow threshold */ | 236 | static const char rflow_thr[] = { /* rflow threshold */ |
809 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, | 237 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, |
810 | 0x00, 0x00, 0x00, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, | 238 | 0x00, 0x00, 0x00, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, |
811 | 0x0a | 239 | 0x0a |
@@ -814,7 +242,7 @@ static char rflow_thr[] = { /* rflow threshold */ | |||
814 | /* The Cyclom-Ye has placed the sequential chips in non-sequential | 242 | /* The Cyclom-Ye has placed the sequential chips in non-sequential |
815 | * address order. This look-up table overcomes that problem. | 243 | * address order. This look-up table overcomes that problem. |
816 | */ | 244 | */ |
817 | static int cy_chip_offset[] = { 0x0000, | 245 | static const unsigned int cy_chip_offset[] = { 0x0000, |
818 | 0x0400, | 246 | 0x0400, |
819 | 0x0800, | 247 | 0x0800, |
820 | 0x0C00, | 248 | 0x0C00, |
@@ -827,7 +255,7 @@ static int cy_chip_offset[] = { 0x0000, | |||
827 | /* PCI related definitions */ | 255 | /* PCI related definitions */ |
828 | 256 | ||
829 | #ifdef CONFIG_PCI | 257 | #ifdef CONFIG_PCI |
830 | static struct pci_device_id cy_pci_dev_id[] __devinitdata = { | 258 | static const struct pci_device_id cy_pci_dev_id[] = { |
831 | /* PCI < 1Mb */ | 259 | /* PCI < 1Mb */ |
832 | { PCI_DEVICE(PCI_VENDOR_ID_CYCLADES, PCI_DEVICE_ID_CYCLOM_Y_Lo) }, | 260 | { PCI_DEVICE(PCI_VENDOR_ID_CYCLADES, PCI_DEVICE_ID_CYCLOM_Y_Lo) }, |
833 | /* PCI > 1Mb */ | 261 | /* PCI > 1Mb */ |
@@ -850,7 +278,7 @@ MODULE_DEVICE_TABLE(pci, cy_pci_dev_id); | |||
850 | #endif | 278 | #endif |
851 | 279 | ||
852 | static void cy_start(struct tty_struct *); | 280 | static void cy_start(struct tty_struct *); |
853 | static void set_line_char(struct cyclades_port *); | 281 | static void cy_set_line_char(struct cyclades_port *, struct tty_struct *); |
854 | static int cyz_issue_cmd(struct cyclades_card *, __u32, __u8, __u32); | 282 | static int cyz_issue_cmd(struct cyclades_card *, __u32, __u8, __u32); |
855 | #ifdef CONFIG_ISA | 283 | #ifdef CONFIG_ISA |
856 | static unsigned detect_isa_irq(void __iomem *); | 284 | static unsigned detect_isa_irq(void __iomem *); |
@@ -869,6 +297,20 @@ static void cyz_rx_restart(unsigned long); | |||
869 | static struct timer_list cyz_rx_full_timer[NR_PORTS]; | 297 | static struct timer_list cyz_rx_full_timer[NR_PORTS]; |
870 | #endif /* CONFIG_CYZ_INTR */ | 298 | #endif /* CONFIG_CYZ_INTR */ |
871 | 299 | ||
300 | static inline void cyy_writeb(struct cyclades_port *port, u32 reg, u8 val) | ||
301 | { | ||
302 | struct cyclades_card *card = port->card; | ||
303 | |||
304 | cy_writeb(port->u.cyy.base_addr + (reg << card->bus_index), val); | ||
305 | } | ||
306 | |||
307 | static inline u8 cyy_readb(struct cyclades_port *port, u32 reg) | ||
308 | { | ||
309 | struct cyclades_card *card = port->card; | ||
310 | |||
311 | return readb(port->u.cyy.base_addr + (reg << card->bus_index)); | ||
312 | } | ||
313 | |||
872 | static inline bool cy_is_Z(struct cyclades_card *card) | 314 | static inline bool cy_is_Z(struct cyclades_card *card) |
873 | { | 315 | { |
874 | return card->num_chips == (unsigned int)-1; | 316 | return card->num_chips == (unsigned int)-1; |
@@ -893,7 +335,7 @@ static inline bool cyz_is_loaded(struct cyclades_card *card) | |||
893 | } | 335 | } |
894 | 336 | ||
895 | static inline int serial_paranoia_check(struct cyclades_port *info, | 337 | static inline int serial_paranoia_check(struct cyclades_port *info, |
896 | char *name, const char *routine) | 338 | const char *name, const char *routine) |
897 | { | 339 | { |
898 | #ifdef SERIAL_PARANOIA_CHECK | 340 | #ifdef SERIAL_PARANOIA_CHECK |
899 | if (!info) { | 341 | if (!info) { |
@@ -909,7 +351,7 @@ static inline int serial_paranoia_check(struct cyclades_port *info, | |||
909 | } | 351 | } |
910 | #endif | 352 | #endif |
911 | return 0; | 353 | return 0; |
912 | } /* serial_paranoia_check */ | 354 | } |
913 | 355 | ||
914 | /***********************************************************/ | 356 | /***********************************************************/ |
915 | /********* Start of block of Cyclom-Y specific code ********/ | 357 | /********* Start of block of Cyclom-Y specific code ********/ |
@@ -921,13 +363,14 @@ static inline int serial_paranoia_check(struct cyclades_port *info, | |||
921 | 363 | ||
922 | This function is only called from inside spinlock-protected code. | 364 | This function is only called from inside spinlock-protected code. |
923 | */ | 365 | */ |
924 | static int cyy_issue_cmd(void __iomem *base_addr, u_char cmd, int index) | 366 | static int __cyy_issue_cmd(void __iomem *base_addr, u8 cmd, int index) |
925 | { | 367 | { |
368 | void __iomem *ccr = base_addr + (CyCCR << index); | ||
926 | unsigned int i; | 369 | unsigned int i; |
927 | 370 | ||
928 | /* Check to see that the previous command has completed */ | 371 | /* Check to see that the previous command has completed */ |
929 | for (i = 0; i < 100; i++) { | 372 | for (i = 0; i < 100; i++) { |
930 | if (readb(base_addr + (CyCCR << index)) == 0) | 373 | if (readb(ccr) == 0) |
931 | break; | 374 | break; |
932 | udelay(10L); | 375 | udelay(10L); |
933 | } | 376 | } |
@@ -937,10 +380,16 @@ static int cyy_issue_cmd(void __iomem *base_addr, u_char cmd, int index) | |||
937 | return -1; | 380 | return -1; |
938 | 381 | ||
939 | /* Issue the new command */ | 382 | /* Issue the new command */ |
940 | cy_writeb(base_addr + (CyCCR << index), cmd); | 383 | cy_writeb(ccr, cmd); |
941 | 384 | ||
942 | return 0; | 385 | return 0; |
943 | } /* cyy_issue_cmd */ | 386 | } |
387 | |||
388 | static inline int cyy_issue_cmd(struct cyclades_port *port, u8 cmd) | ||
389 | { | ||
390 | return __cyy_issue_cmd(port->u.cyy.base_addr, cmd, | ||
391 | port->card->bus_index); | ||
392 | } | ||
944 | 393 | ||
945 | #ifdef CONFIG_ISA | 394 | #ifdef CONFIG_ISA |
946 | /* ISA interrupt detection code */ | 395 | /* ISA interrupt detection code */ |
@@ -960,12 +409,12 @@ static unsigned detect_isa_irq(void __iomem *address) | |||
960 | 409 | ||
961 | irqs = probe_irq_on(); | 410 | irqs = probe_irq_on(); |
962 | /* Wait ... */ | 411 | /* Wait ... */ |
963 | udelay(5000L); | 412 | msleep(5); |
964 | 413 | ||
965 | /* Enable the Tx interrupts on the CD1400 */ | 414 | /* Enable the Tx interrupts on the CD1400 */ |
966 | local_irq_save(flags); | 415 | local_irq_save(flags); |
967 | cy_writeb(address + (CyCAR << index), 0); | 416 | cy_writeb(address + (CyCAR << index), 0); |
968 | cyy_issue_cmd(address, CyCHAN_CTL | CyENB_XMTR, index); | 417 | __cyy_issue_cmd(address, CyCHAN_CTL | CyENB_XMTR, index); |
969 | 418 | ||
970 | cy_writeb(address + (CyCAR << index), 0); | 419 | cy_writeb(address + (CyCAR << index), 0); |
971 | cy_writeb(address + (CySRER << index), | 420 | cy_writeb(address + (CySRER << index), |
@@ -973,7 +422,7 @@ static unsigned detect_isa_irq(void __iomem *address) | |||
973 | local_irq_restore(flags); | 422 | local_irq_restore(flags); |
974 | 423 | ||
975 | /* Wait ... */ | 424 | /* Wait ... */ |
976 | udelay(5000L); | 425 | msleep(5); |
977 | 426 | ||
978 | /* Check which interrupt is in use */ | 427 | /* Check which interrupt is in use */ |
979 | irq = probe_irq_off(irqs); | 428 | irq = probe_irq_off(irqs); |
@@ -999,7 +448,7 @@ static void cyy_chip_rx(struct cyclades_card *cinfo, int chip, | |||
999 | struct cyclades_port *info; | 448 | struct cyclades_port *info; |
1000 | struct tty_struct *tty; | 449 | struct tty_struct *tty; |
1001 | int len, index = cinfo->bus_index; | 450 | int len, index = cinfo->bus_index; |
1002 | u8 save_xir, channel, save_car, data, char_count; | 451 | u8 ivr, save_xir, channel, save_car, data, char_count; |
1003 | 452 | ||
1004 | #ifdef CY_DEBUG_INTERRUPTS | 453 | #ifdef CY_DEBUG_INTERRUPTS |
1005 | printk(KERN_DEBUG "cyy_interrupt: rcvd intr, chip %d\n", chip); | 454 | printk(KERN_DEBUG "cyy_interrupt: rcvd intr, chip %d\n", chip); |
@@ -1008,26 +457,25 @@ static void cyy_chip_rx(struct cyclades_card *cinfo, int chip, | |||
1008 | save_xir = readb(base_addr + (CyRIR << index)); | 457 | save_xir = readb(base_addr + (CyRIR << index)); |
1009 | channel = save_xir & CyIRChannel; | 458 | channel = save_xir & CyIRChannel; |
1010 | info = &cinfo->ports[channel + chip * 4]; | 459 | info = &cinfo->ports[channel + chip * 4]; |
1011 | save_car = readb(base_addr + (CyCAR << index)); | 460 | save_car = cyy_readb(info, CyCAR); |
1012 | cy_writeb(base_addr + (CyCAR << index), save_xir); | 461 | cyy_writeb(info, CyCAR, save_xir); |
462 | ivr = cyy_readb(info, CyRIVR) & CyIVRMask; | ||
1013 | 463 | ||
464 | tty = tty_port_tty_get(&info->port); | ||
1014 | /* if there is nowhere to put the data, discard it */ | 465 | /* if there is nowhere to put the data, discard it */ |
1015 | if (info->port.tty == NULL) { | 466 | if (tty == NULL) { |
1016 | if ((readb(base_addr + (CyRIVR << index)) & CyIVRMask) == | 467 | if (ivr == CyIVRRxEx) { /* exception */ |
1017 | CyIVRRxEx) { /* exception */ | 468 | data = cyy_readb(info, CyRDSR); |
1018 | data = readb(base_addr + (CyRDSR << index)); | ||
1019 | } else { /* normal character reception */ | 469 | } else { /* normal character reception */ |
1020 | char_count = readb(base_addr + (CyRDCR << index)); | 470 | char_count = cyy_readb(info, CyRDCR); |
1021 | while (char_count--) | 471 | while (char_count--) |
1022 | data = readb(base_addr + (CyRDSR << index)); | 472 | data = cyy_readb(info, CyRDSR); |
1023 | } | 473 | } |
1024 | goto end; | 474 | goto end; |
1025 | } | 475 | } |
1026 | /* there is an open port for this data */ | 476 | /* there is an open port for this data */ |
1027 | tty = info->port.tty; | 477 | if (ivr == CyIVRRxEx) { /* exception */ |
1028 | if ((readb(base_addr + (CyRIVR << index)) & CyIVRMask) == | 478 | data = cyy_readb(info, CyRDSR); |
1029 | CyIVRRxEx) { /* exception */ | ||
1030 | data = readb(base_addr + (CyRDSR << index)); | ||
1031 | 479 | ||
1032 | /* For statistics only */ | 480 | /* For statistics only */ |
1033 | if (data & CyBREAK) | 481 | if (data & CyBREAK) |
@@ -1041,28 +489,29 @@ static void cyy_chip_rx(struct cyclades_card *cinfo, int chip, | |||
1041 | 489 | ||
1042 | if (data & info->ignore_status_mask) { | 490 | if (data & info->ignore_status_mask) { |
1043 | info->icount.rx++; | 491 | info->icount.rx++; |
492 | tty_kref_put(tty); | ||
1044 | return; | 493 | return; |
1045 | } | 494 | } |
1046 | if (tty_buffer_request_room(tty, 1)) { | 495 | if (tty_buffer_request_room(tty, 1)) { |
1047 | if (data & info->read_status_mask) { | 496 | if (data & info->read_status_mask) { |
1048 | if (data & CyBREAK) { | 497 | if (data & CyBREAK) { |
1049 | tty_insert_flip_char(tty, | 498 | tty_insert_flip_char(tty, |
1050 | readb(base_addr + (CyRDSR << | 499 | cyy_readb(info, CyRDSR), |
1051 | index)), TTY_BREAK); | 500 | TTY_BREAK); |
1052 | info->icount.rx++; | 501 | info->icount.rx++; |
1053 | if (info->port.flags & ASYNC_SAK) | 502 | if (info->port.flags & ASYNC_SAK) |
1054 | do_SAK(tty); | 503 | do_SAK(tty); |
1055 | } else if (data & CyFRAME) { | 504 | } else if (data & CyFRAME) { |
1056 | tty_insert_flip_char(tty, | 505 | tty_insert_flip_char(tty, |
1057 | readb(base_addr + (CyRDSR << | 506 | cyy_readb(info, CyRDSR), |
1058 | index)), TTY_FRAME); | 507 | TTY_FRAME); |
1059 | info->icount.rx++; | 508 | info->icount.rx++; |
1060 | info->idle_stats.frame_errs++; | 509 | info->idle_stats.frame_errs++; |
1061 | } else if (data & CyPARITY) { | 510 | } else if (data & CyPARITY) { |
1062 | /* Pieces of seven... */ | 511 | /* Pieces of seven... */ |
1063 | tty_insert_flip_char(tty, | 512 | tty_insert_flip_char(tty, |
1064 | readb(base_addr + (CyRDSR << | 513 | cyy_readb(info, CyRDSR), |
1065 | index)), TTY_PARITY); | 514 | TTY_PARITY); |
1066 | info->icount.rx++; | 515 | info->icount.rx++; |
1067 | info->idle_stats.parity_errs++; | 516 | info->idle_stats.parity_errs++; |
1068 | } else if (data & CyOVERRUN) { | 517 | } else if (data & CyOVERRUN) { |
@@ -1074,8 +523,8 @@ static void cyy_chip_rx(struct cyclades_card *cinfo, int chip, | |||
1074 | the next incoming character. | 523 | the next incoming character. |
1075 | */ | 524 | */ |
1076 | tty_insert_flip_char(tty, | 525 | tty_insert_flip_char(tty, |
1077 | readb(base_addr + (CyRDSR << | 526 | cyy_readb(info, CyRDSR), |
1078 | index)), TTY_FRAME); | 527 | TTY_FRAME); |
1079 | info->icount.rx++; | 528 | info->icount.rx++; |
1080 | info->idle_stats.overruns++; | 529 | info->idle_stats.overruns++; |
1081 | /* These two conditions may imply */ | 530 | /* These two conditions may imply */ |
@@ -1099,7 +548,7 @@ static void cyy_chip_rx(struct cyclades_card *cinfo, int chip, | |||
1099 | } | 548 | } |
1100 | } else { /* normal character reception */ | 549 | } else { /* normal character reception */ |
1101 | /* load # chars available from the chip */ | 550 | /* load # chars available from the chip */ |
1102 | char_count = readb(base_addr + (CyRDCR << index)); | 551 | char_count = cyy_readb(info, CyRDCR); |
1103 | 552 | ||
1104 | #ifdef CY_ENABLE_MONITORING | 553 | #ifdef CY_ENABLE_MONITORING |
1105 | ++info->mon.int_count; | 554 | ++info->mon.int_count; |
@@ -1110,7 +559,7 @@ static void cyy_chip_rx(struct cyclades_card *cinfo, int chip, | |||
1110 | #endif | 559 | #endif |
1111 | len = tty_buffer_request_room(tty, char_count); | 560 | len = tty_buffer_request_room(tty, char_count); |
1112 | while (len--) { | 561 | while (len--) { |
1113 | data = readb(base_addr + (CyRDSR << index)); | 562 | data = cyy_readb(info, CyRDSR); |
1114 | tty_insert_flip_char(tty, data, TTY_NORMAL); | 563 | tty_insert_flip_char(tty, data, TTY_NORMAL); |
1115 | info->idle_stats.recv_bytes++; | 564 | info->idle_stats.recv_bytes++; |
1116 | info->icount.rx++; | 565 | info->icount.rx++; |
@@ -1121,16 +570,18 @@ static void cyy_chip_rx(struct cyclades_card *cinfo, int chip, | |||
1121 | info->idle_stats.recv_idle = jiffies; | 570 | info->idle_stats.recv_idle = jiffies; |
1122 | } | 571 | } |
1123 | tty_schedule_flip(tty); | 572 | tty_schedule_flip(tty); |
573 | tty_kref_put(tty); | ||
1124 | end: | 574 | end: |
1125 | /* end of service */ | 575 | /* end of service */ |
1126 | cy_writeb(base_addr + (CyRIR << index), save_xir & 0x3f); | 576 | cyy_writeb(info, CyRIR, save_xir & 0x3f); |
1127 | cy_writeb(base_addr + (CyCAR << index), save_car); | 577 | cyy_writeb(info, CyCAR, save_car); |
1128 | } | 578 | } |
1129 | 579 | ||
1130 | static void cyy_chip_tx(struct cyclades_card *cinfo, unsigned int chip, | 580 | static void cyy_chip_tx(struct cyclades_card *cinfo, unsigned int chip, |
1131 | void __iomem *base_addr) | 581 | void __iomem *base_addr) |
1132 | { | 582 | { |
1133 | struct cyclades_port *info; | 583 | struct cyclades_port *info; |
584 | struct tty_struct *tty; | ||
1134 | int char_count, index = cinfo->bus_index; | 585 | int char_count, index = cinfo->bus_index; |
1135 | u8 save_xir, channel, save_car, outch; | 586 | u8 save_xir, channel, save_car, outch; |
1136 | 587 | ||
@@ -1154,9 +605,9 @@ static void cyy_chip_tx(struct cyclades_card *cinfo, unsigned int chip, | |||
1154 | goto end; | 605 | goto end; |
1155 | } | 606 | } |
1156 | info = &cinfo->ports[channel + chip * 4]; | 607 | info = &cinfo->ports[channel + chip * 4]; |
1157 | if (info->port.tty == NULL) { | 608 | tty = tty_port_tty_get(&info->port); |
1158 | cy_writeb(base_addr + (CySRER << index), | 609 | if (tty == NULL) { |
1159 | readb(base_addr + (CySRER << index)) & ~CyTxRdy); | 610 | cyy_writeb(info, CySRER, cyy_readb(info, CySRER) & ~CyTxRdy); |
1160 | goto end; | 611 | goto end; |
1161 | } | 612 | } |
1162 | 613 | ||
@@ -1165,7 +616,7 @@ static void cyy_chip_tx(struct cyclades_card *cinfo, unsigned int chip, | |||
1165 | 616 | ||
1166 | if (info->x_char) { /* send special char */ | 617 | if (info->x_char) { /* send special char */ |
1167 | outch = info->x_char; | 618 | outch = info->x_char; |
1168 | cy_writeb(base_addr + (CyTDR << index), outch); | 619 | cyy_writeb(info, CyTDR, outch); |
1169 | char_count--; | 620 | char_count--; |
1170 | info->icount.tx++; | 621 | info->icount.tx++; |
1171 | info->x_char = 0; | 622 | info->x_char = 0; |
@@ -1173,14 +624,14 @@ static void cyy_chip_tx(struct cyclades_card *cinfo, unsigned int chip, | |||
1173 | 624 | ||
1174 | if (info->breakon || info->breakoff) { | 625 | if (info->breakon || info->breakoff) { |
1175 | if (info->breakon) { | 626 | if (info->breakon) { |
1176 | cy_writeb(base_addr + (CyTDR << index), 0); | 627 | cyy_writeb(info, CyTDR, 0); |
1177 | cy_writeb(base_addr + (CyTDR << index), 0x81); | 628 | cyy_writeb(info, CyTDR, 0x81); |
1178 | info->breakon = 0; | 629 | info->breakon = 0; |
1179 | char_count -= 2; | 630 | char_count -= 2; |
1180 | } | 631 | } |
1181 | if (info->breakoff) { | 632 | if (info->breakoff) { |
1182 | cy_writeb(base_addr + (CyTDR << index), 0); | 633 | cyy_writeb(info, CyTDR, 0); |
1183 | cy_writeb(base_addr + (CyTDR << index), 0x83); | 634 | cyy_writeb(info, CyTDR, 0x83); |
1184 | info->breakoff = 0; | 635 | info->breakoff = 0; |
1185 | char_count -= 2; | 636 | char_count -= 2; |
1186 | } | 637 | } |
@@ -1188,27 +639,23 @@ static void cyy_chip_tx(struct cyclades_card *cinfo, unsigned int chip, | |||
1188 | 639 | ||
1189 | while (char_count-- > 0) { | 640 | while (char_count-- > 0) { |
1190 | if (!info->xmit_cnt) { | 641 | if (!info->xmit_cnt) { |
1191 | if (readb(base_addr + (CySRER << index)) & CyTxMpty) { | 642 | if (cyy_readb(info, CySRER) & CyTxMpty) { |
1192 | cy_writeb(base_addr + (CySRER << index), | 643 | cyy_writeb(info, CySRER, |
1193 | readb(base_addr + (CySRER << index)) & | 644 | cyy_readb(info, CySRER) & ~CyTxMpty); |
1194 | ~CyTxMpty); | ||
1195 | } else { | 645 | } else { |
1196 | cy_writeb(base_addr + (CySRER << index), | 646 | cyy_writeb(info, CySRER, CyTxMpty | |
1197 | (readb(base_addr + (CySRER << index)) & | 647 | (cyy_readb(info, CySRER) & ~CyTxRdy)); |
1198 | ~CyTxRdy) | CyTxMpty); | ||
1199 | } | 648 | } |
1200 | goto done; | 649 | goto done; |
1201 | } | 650 | } |
1202 | if (info->port.xmit_buf == NULL) { | 651 | if (info->port.xmit_buf == NULL) { |
1203 | cy_writeb(base_addr + (CySRER << index), | 652 | cyy_writeb(info, CySRER, |
1204 | readb(base_addr + (CySRER << index)) & | 653 | cyy_readb(info, CySRER) & ~CyTxRdy); |
1205 | ~CyTxRdy); | ||
1206 | goto done; | 654 | goto done; |
1207 | } | 655 | } |
1208 | if (info->port.tty->stopped || info->port.tty->hw_stopped) { | 656 | if (tty->stopped || tty->hw_stopped) { |
1209 | cy_writeb(base_addr + (CySRER << index), | 657 | cyy_writeb(info, CySRER, |
1210 | readb(base_addr + (CySRER << index)) & | 658 | cyy_readb(info, CySRER) & ~CyTxRdy); |
1211 | ~CyTxRdy); | ||
1212 | goto done; | 659 | goto done; |
1213 | } | 660 | } |
1214 | /* Because the Embedded Transmit Commands have been enabled, | 661 | /* Because the Embedded Transmit Commands have been enabled, |
@@ -1225,15 +672,15 @@ static void cyy_chip_tx(struct cyclades_card *cinfo, unsigned int chip, | |||
1225 | info->xmit_cnt--; | 672 | info->xmit_cnt--; |
1226 | info->xmit_tail = (info->xmit_tail + 1) & | 673 | info->xmit_tail = (info->xmit_tail + 1) & |
1227 | (SERIAL_XMIT_SIZE - 1); | 674 | (SERIAL_XMIT_SIZE - 1); |
1228 | cy_writeb(base_addr + (CyTDR << index), outch); | 675 | cyy_writeb(info, CyTDR, outch); |
1229 | info->icount.tx++; | 676 | info->icount.tx++; |
1230 | } else { | 677 | } else { |
1231 | if (char_count > 1) { | 678 | if (char_count > 1) { |
1232 | info->xmit_cnt--; | 679 | info->xmit_cnt--; |
1233 | info->xmit_tail = (info->xmit_tail + 1) & | 680 | info->xmit_tail = (info->xmit_tail + 1) & |
1234 | (SERIAL_XMIT_SIZE - 1); | 681 | (SERIAL_XMIT_SIZE - 1); |
1235 | cy_writeb(base_addr + (CyTDR << index), outch); | 682 | cyy_writeb(info, CyTDR, outch); |
1236 | cy_writeb(base_addr + (CyTDR << index), 0); | 683 | cyy_writeb(info, CyTDR, 0); |
1237 | info->icount.tx++; | 684 | info->icount.tx++; |
1238 | char_count--; | 685 | char_count--; |
1239 | } | 686 | } |
@@ -1241,17 +688,19 @@ static void cyy_chip_tx(struct cyclades_card *cinfo, unsigned int chip, | |||
1241 | } | 688 | } |
1242 | 689 | ||
1243 | done: | 690 | done: |
1244 | tty_wakeup(info->port.tty); | 691 | tty_wakeup(tty); |
692 | tty_kref_put(tty); | ||
1245 | end: | 693 | end: |
1246 | /* end of service */ | 694 | /* end of service */ |
1247 | cy_writeb(base_addr + (CyTIR << index), save_xir & 0x3f); | 695 | cyy_writeb(info, CyTIR, save_xir & 0x3f); |
1248 | cy_writeb(base_addr + (CyCAR << index), save_car); | 696 | cyy_writeb(info, CyCAR, save_car); |
1249 | } | 697 | } |
1250 | 698 | ||
1251 | static void cyy_chip_modem(struct cyclades_card *cinfo, int chip, | 699 | static void cyy_chip_modem(struct cyclades_card *cinfo, int chip, |
1252 | void __iomem *base_addr) | 700 | void __iomem *base_addr) |
1253 | { | 701 | { |
1254 | struct cyclades_port *info; | 702 | struct cyclades_port *info; |
703 | struct tty_struct *tty; | ||
1255 | int index = cinfo->bus_index; | 704 | int index = cinfo->bus_index; |
1256 | u8 save_xir, channel, save_car, mdm_change, mdm_status; | 705 | u8 save_xir, channel, save_car, mdm_change, mdm_status; |
1257 | 706 | ||
@@ -1259,13 +708,14 @@ static void cyy_chip_modem(struct cyclades_card *cinfo, int chip, | |||
1259 | save_xir = readb(base_addr + (CyMIR << index)); | 708 | save_xir = readb(base_addr + (CyMIR << index)); |
1260 | channel = save_xir & CyIRChannel; | 709 | channel = save_xir & CyIRChannel; |
1261 | info = &cinfo->ports[channel + chip * 4]; | 710 | info = &cinfo->ports[channel + chip * 4]; |
1262 | save_car = readb(base_addr + (CyCAR << index)); | 711 | save_car = cyy_readb(info, CyCAR); |
1263 | cy_writeb(base_addr + (CyCAR << index), save_xir); | 712 | cyy_writeb(info, CyCAR, save_xir); |
1264 | 713 | ||
1265 | mdm_change = readb(base_addr + (CyMISR << index)); | 714 | mdm_change = cyy_readb(info, CyMISR); |
1266 | mdm_status = readb(base_addr + (CyMSVR1 << index)); | 715 | mdm_status = cyy_readb(info, CyMSVR1); |
1267 | 716 | ||
1268 | if (!info->port.tty) | 717 | tty = tty_port_tty_get(&info->port); |
718 | if (!tty) | ||
1269 | goto end; | 719 | goto end; |
1270 | 720 | ||
1271 | if (mdm_change & CyANY_DELTA) { | 721 | if (mdm_change & CyANY_DELTA) { |
@@ -1279,35 +729,32 @@ static void cyy_chip_modem(struct cyclades_card *cinfo, int chip, | |||
1279 | if (mdm_change & CyRI) | 729 | if (mdm_change & CyRI) |
1280 | info->icount.rng++; | 730 | info->icount.rng++; |
1281 | 731 | ||
1282 | wake_up_interruptible(&info->delta_msr_wait); | 732 | wake_up_interruptible(&info->port.delta_msr_wait); |
1283 | } | 733 | } |
1284 | 734 | ||
1285 | if ((mdm_change & CyDCD) && (info->port.flags & ASYNC_CHECK_CD)) { | 735 | if ((mdm_change & CyDCD) && (info->port.flags & ASYNC_CHECK_CD)) { |
1286 | if (!(mdm_status & CyDCD)) { | 736 | if (mdm_status & CyDCD) |
1287 | tty_hangup(info->port.tty); | 737 | wake_up_interruptible(&info->port.open_wait); |
1288 | info->port.flags &= ~ASYNC_NORMAL_ACTIVE; | 738 | else |
1289 | } | 739 | tty_hangup(tty); |
1290 | wake_up_interruptible(&info->port.open_wait); | ||
1291 | } | 740 | } |
1292 | if ((mdm_change & CyCTS) && (info->port.flags & ASYNC_CTS_FLOW)) { | 741 | if ((mdm_change & CyCTS) && (info->port.flags & ASYNC_CTS_FLOW)) { |
1293 | if (info->port.tty->hw_stopped) { | 742 | if (tty->hw_stopped) { |
1294 | if (mdm_status & CyCTS) { | 743 | if (mdm_status & CyCTS) { |
1295 | /* cy_start isn't used | 744 | /* cy_start isn't used |
1296 | because... !!! */ | 745 | because... !!! */ |
1297 | info->port.tty->hw_stopped = 0; | 746 | tty->hw_stopped = 0; |
1298 | cy_writeb(base_addr + (CySRER << index), | 747 | cyy_writeb(info, CySRER, |
1299 | readb(base_addr + (CySRER << index)) | | 748 | cyy_readb(info, CySRER) | CyTxRdy); |
1300 | CyTxRdy); | 749 | tty_wakeup(tty); |
1301 | tty_wakeup(info->port.tty); | ||
1302 | } | 750 | } |
1303 | } else { | 751 | } else { |
1304 | if (!(mdm_status & CyCTS)) { | 752 | if (!(mdm_status & CyCTS)) { |
1305 | /* cy_stop isn't used | 753 | /* cy_stop isn't used |
1306 | because ... !!! */ | 754 | because ... !!! */ |
1307 | info->port.tty->hw_stopped = 1; | 755 | tty->hw_stopped = 1; |
1308 | cy_writeb(base_addr + (CySRER << index), | 756 | cyy_writeb(info, CySRER, |
1309 | readb(base_addr + (CySRER << index)) & | 757 | cyy_readb(info, CySRER) & ~CyTxRdy); |
1310 | ~CyTxRdy); | ||
1311 | } | 758 | } |
1312 | } | 759 | } |
1313 | } | 760 | } |
@@ -1315,10 +762,11 @@ static void cyy_chip_modem(struct cyclades_card *cinfo, int chip, | |||
1315 | } | 762 | } |
1316 | if (mdm_change & CyRI) { | 763 | if (mdm_change & CyRI) { |
1317 | }*/ | 764 | }*/ |
765 | tty_kref_put(tty); | ||
1318 | end: | 766 | end: |
1319 | /* end of service */ | 767 | /* end of service */ |
1320 | cy_writeb(base_addr + (CyMIR << index), save_xir & 0x3f); | 768 | cyy_writeb(info, CyMIR, save_xir & 0x3f); |
1321 | cy_writeb(base_addr + (CyCAR << index), save_car); | 769 | cyy_writeb(info, CyCAR, save_car); |
1322 | } | 770 | } |
1323 | 771 | ||
1324 | /* The real interrupt service routine is called | 772 | /* The real interrupt service routine is called |
@@ -1389,6 +837,56 @@ static irqreturn_t cyy_interrupt(int irq, void *dev_id) | |||
1389 | return IRQ_HANDLED; | 837 | return IRQ_HANDLED; |
1390 | } /* cyy_interrupt */ | 838 | } /* cyy_interrupt */ |
1391 | 839 | ||
840 | static void cyy_change_rts_dtr(struct cyclades_port *info, unsigned int set, | ||
841 | unsigned int clear) | ||
842 | { | ||
843 | struct cyclades_card *card = info->card; | ||
844 | int channel = info->line - card->first_line; | ||
845 | u32 rts, dtr, msvrr, msvrd; | ||
846 | |||
847 | channel &= 0x03; | ||
848 | |||
849 | if (info->rtsdtr_inv) { | ||
850 | msvrr = CyMSVR2; | ||
851 | msvrd = CyMSVR1; | ||
852 | rts = CyDTR; | ||
853 | dtr = CyRTS; | ||
854 | } else { | ||
855 | msvrr = CyMSVR1; | ||
856 | msvrd = CyMSVR2; | ||
857 | rts = CyRTS; | ||
858 | dtr = CyDTR; | ||
859 | } | ||
860 | if (set & TIOCM_RTS) { | ||
861 | cyy_writeb(info, CyCAR, channel); | ||
862 | cyy_writeb(info, msvrr, rts); | ||
863 | } | ||
864 | if (clear & TIOCM_RTS) { | ||
865 | cyy_writeb(info, CyCAR, channel); | ||
866 | cyy_writeb(info, msvrr, ~rts); | ||
867 | } | ||
868 | if (set & TIOCM_DTR) { | ||
869 | cyy_writeb(info, CyCAR, channel); | ||
870 | cyy_writeb(info, msvrd, dtr); | ||
871 | #ifdef CY_DEBUG_DTR | ||
872 | printk(KERN_DEBUG "cyc:set_modem_info raising DTR\n"); | ||
873 | printk(KERN_DEBUG " status: 0x%x, 0x%x\n", | ||
874 | cyy_readb(info, CyMSVR1), | ||
875 | cyy_readb(info, CyMSVR2)); | ||
876 | #endif | ||
877 | } | ||
878 | if (clear & TIOCM_DTR) { | ||
879 | cyy_writeb(info, CyCAR, channel); | ||
880 | cyy_writeb(info, msvrd, ~dtr); | ||
881 | #ifdef CY_DEBUG_DTR | ||
882 | printk(KERN_DEBUG "cyc:set_modem_info dropping DTR\n"); | ||
883 | printk(KERN_DEBUG " status: 0x%x, 0x%x\n", | ||
884 | cyy_readb(info, CyMSVR1), | ||
885 | cyy_readb(info, CyMSVR2)); | ||
886 | #endif | ||
887 | } | ||
888 | } | ||
889 | |||
1392 | /***********************************************************/ | 890 | /***********************************************************/ |
1393 | /********* End of block of Cyclom-Y specific code **********/ | 891 | /********* End of block of Cyclom-Y specific code **********/ |
1394 | /******** Start of block of Cyclades-Z specific code *******/ | 892 | /******** Start of block of Cyclades-Z specific code *******/ |
@@ -1398,15 +896,9 @@ static int | |||
1398 | cyz_fetch_msg(struct cyclades_card *cinfo, | 896 | cyz_fetch_msg(struct cyclades_card *cinfo, |
1399 | __u32 *channel, __u8 *cmd, __u32 *param) | 897 | __u32 *channel, __u8 *cmd, __u32 *param) |
1400 | { | 898 | { |
1401 | struct FIRM_ID __iomem *firm_id; | 899 | struct BOARD_CTRL __iomem *board_ctrl = cinfo->board_ctrl; |
1402 | struct ZFW_CTRL __iomem *zfw_ctrl; | ||
1403 | struct BOARD_CTRL __iomem *board_ctrl; | ||
1404 | unsigned long loc_doorbell; | 900 | unsigned long loc_doorbell; |
1405 | 901 | ||
1406 | firm_id = cinfo->base_addr + ID_ADDRESS; | ||
1407 | zfw_ctrl = cinfo->base_addr + (readl(&firm_id->zfwctrl_addr) & 0xfffff); | ||
1408 | board_ctrl = &zfw_ctrl->board_ctrl; | ||
1409 | |||
1410 | loc_doorbell = readl(&cinfo->ctl_addr.p9060->loc_doorbell); | 902 | loc_doorbell = readl(&cinfo->ctl_addr.p9060->loc_doorbell); |
1411 | if (loc_doorbell) { | 903 | if (loc_doorbell) { |
1412 | *cmd = (char)(0xff & loc_doorbell); | 904 | *cmd = (char)(0xff & loc_doorbell); |
@@ -1422,19 +914,13 @@ static int | |||
1422 | cyz_issue_cmd(struct cyclades_card *cinfo, | 914 | cyz_issue_cmd(struct cyclades_card *cinfo, |
1423 | __u32 channel, __u8 cmd, __u32 param) | 915 | __u32 channel, __u8 cmd, __u32 param) |
1424 | { | 916 | { |
1425 | struct FIRM_ID __iomem *firm_id; | 917 | struct BOARD_CTRL __iomem *board_ctrl = cinfo->board_ctrl; |
1426 | struct ZFW_CTRL __iomem *zfw_ctrl; | ||
1427 | struct BOARD_CTRL __iomem *board_ctrl; | ||
1428 | __u32 __iomem *pci_doorbell; | 918 | __u32 __iomem *pci_doorbell; |
1429 | unsigned int index; | 919 | unsigned int index; |
1430 | 920 | ||
1431 | firm_id = cinfo->base_addr + ID_ADDRESS; | ||
1432 | if (!cyz_is_loaded(cinfo)) | 921 | if (!cyz_is_loaded(cinfo)) |
1433 | return -1; | 922 | return -1; |
1434 | 923 | ||
1435 | zfw_ctrl = cinfo->base_addr + (readl(&firm_id->zfwctrl_addr) & 0xfffff); | ||
1436 | board_ctrl = &zfw_ctrl->board_ctrl; | ||
1437 | |||
1438 | index = 0; | 924 | index = 0; |
1439 | pci_doorbell = &cinfo->ctl_addr.p9060->pci_doorbell; | 925 | pci_doorbell = &cinfo->ctl_addr.p9060->pci_doorbell; |
1440 | while ((readl(pci_doorbell) & 0xff) != 0) { | 926 | while ((readl(pci_doorbell) & 0xff) != 0) { |
@@ -1449,11 +935,10 @@ cyz_issue_cmd(struct cyclades_card *cinfo, | |||
1449 | return 0; | 935 | return 0; |
1450 | } /* cyz_issue_cmd */ | 936 | } /* cyz_issue_cmd */ |
1451 | 937 | ||
1452 | static void cyz_handle_rx(struct cyclades_port *info, | 938 | static void cyz_handle_rx(struct cyclades_port *info, struct tty_struct *tty) |
1453 | struct BUF_CTRL __iomem *buf_ctrl) | ||
1454 | { | 939 | { |
940 | struct BUF_CTRL __iomem *buf_ctrl = info->u.cyz.buf_ctrl; | ||
1455 | struct cyclades_card *cinfo = info->card; | 941 | struct cyclades_card *cinfo = info->card; |
1456 | struct tty_struct *tty = info->port.tty; | ||
1457 | unsigned int char_count; | 942 | unsigned int char_count; |
1458 | int len; | 943 | int len; |
1459 | #ifdef BLOCKMOVE | 944 | #ifdef BLOCKMOVE |
@@ -1542,11 +1027,10 @@ static void cyz_handle_rx(struct cyclades_port *info, | |||
1542 | } | 1027 | } |
1543 | } | 1028 | } |
1544 | 1029 | ||
1545 | static void cyz_handle_tx(struct cyclades_port *info, | 1030 | static void cyz_handle_tx(struct cyclades_port *info, struct tty_struct *tty) |
1546 | struct BUF_CTRL __iomem *buf_ctrl) | ||
1547 | { | 1031 | { |
1032 | struct BUF_CTRL __iomem *buf_ctrl = info->u.cyz.buf_ctrl; | ||
1548 | struct cyclades_card *cinfo = info->card; | 1033 | struct cyclades_card *cinfo = info->card; |
1549 | struct tty_struct *tty = info->port.tty; | ||
1550 | u8 data; | 1034 | u8 data; |
1551 | unsigned int char_count; | 1035 | unsigned int char_count; |
1552 | #ifdef BLOCKMOVE | 1036 | #ifdef BLOCKMOVE |
@@ -1621,34 +1105,24 @@ ztxdone: | |||
1621 | 1105 | ||
1622 | static void cyz_handle_cmd(struct cyclades_card *cinfo) | 1106 | static void cyz_handle_cmd(struct cyclades_card *cinfo) |
1623 | { | 1107 | { |
1108 | struct BOARD_CTRL __iomem *board_ctrl = cinfo->board_ctrl; | ||
1624 | struct tty_struct *tty; | 1109 | struct tty_struct *tty; |
1625 | struct cyclades_port *info; | 1110 | struct cyclades_port *info; |
1626 | static struct FIRM_ID __iomem *firm_id; | ||
1627 | static struct ZFW_CTRL __iomem *zfw_ctrl; | ||
1628 | static struct BOARD_CTRL __iomem *board_ctrl; | ||
1629 | static struct CH_CTRL __iomem *ch_ctrl; | ||
1630 | static struct BUF_CTRL __iomem *buf_ctrl; | ||
1631 | __u32 channel, param, fw_ver; | 1111 | __u32 channel, param, fw_ver; |
1632 | __u8 cmd; | 1112 | __u8 cmd; |
1633 | int special_count; | 1113 | int special_count; |
1634 | int delta_count; | 1114 | int delta_count; |
1635 | 1115 | ||
1636 | firm_id = cinfo->base_addr + ID_ADDRESS; | ||
1637 | zfw_ctrl = cinfo->base_addr + (readl(&firm_id->zfwctrl_addr) & 0xfffff); | ||
1638 | board_ctrl = &zfw_ctrl->board_ctrl; | ||
1639 | fw_ver = readl(&board_ctrl->fw_version); | 1116 | fw_ver = readl(&board_ctrl->fw_version); |
1640 | 1117 | ||
1641 | while (cyz_fetch_msg(cinfo, &channel, &cmd, ¶m) == 1) { | 1118 | while (cyz_fetch_msg(cinfo, &channel, &cmd, ¶m) == 1) { |
1642 | special_count = 0; | 1119 | special_count = 0; |
1643 | delta_count = 0; | 1120 | delta_count = 0; |
1644 | info = &cinfo->ports[channel]; | 1121 | info = &cinfo->ports[channel]; |
1645 | tty = info->port.tty; | 1122 | tty = tty_port_tty_get(&info->port); |
1646 | if (tty == NULL) | 1123 | if (tty == NULL) |
1647 | continue; | 1124 | continue; |
1648 | 1125 | ||
1649 | ch_ctrl = &(zfw_ctrl->ch_ctrl[channel]); | ||
1650 | buf_ctrl = &(zfw_ctrl->buf_ctrl[channel]); | ||
1651 | |||
1652 | switch (cmd) { | 1126 | switch (cmd) { |
1653 | case C_CM_PR_ERROR: | 1127 | case C_CM_PR_ERROR: |
1654 | tty_insert_flip_char(tty, 0, TTY_PARITY); | 1128 | tty_insert_flip_char(tty, 0, TTY_PARITY); |
@@ -1669,15 +1143,12 @@ static void cyz_handle_cmd(struct cyclades_card *cinfo) | |||
1669 | info->icount.dcd++; | 1143 | info->icount.dcd++; |
1670 | delta_count++; | 1144 | delta_count++; |
1671 | if (info->port.flags & ASYNC_CHECK_CD) { | 1145 | if (info->port.flags & ASYNC_CHECK_CD) { |
1672 | if ((fw_ver > 241 ? ((u_long) param) : | 1146 | u32 dcd = fw_ver > 241 ? param : |
1673 | readl(&ch_ctrl->rs_status)) & | 1147 | readl(&info->u.cyz.ch_ctrl->rs_status); |
1674 | C_RS_DCD) { | 1148 | if (dcd & C_RS_DCD) |
1675 | wake_up_interruptible(&info->port.open_wait); | 1149 | wake_up_interruptible(&info->port.open_wait); |
1676 | } else { | 1150 | else |
1677 | tty_hangup(info->port.tty); | 1151 | tty_hangup(tty); |
1678 | wake_up_interruptible(&info->port.open_wait); | ||
1679 | info->port.flags &= ~ASYNC_NORMAL_ACTIVE; | ||
1680 | } | ||
1681 | } | 1152 | } |
1682 | break; | 1153 | break; |
1683 | case C_CM_MCTS: | 1154 | case C_CM_MCTS: |
@@ -1706,7 +1177,7 @@ static void cyz_handle_cmd(struct cyclades_card *cinfo) | |||
1706 | printk(KERN_DEBUG "cyz_interrupt: rcvd intr, card %d, " | 1177 | printk(KERN_DEBUG "cyz_interrupt: rcvd intr, card %d, " |
1707 | "port %ld\n", info->card, channel); | 1178 | "port %ld\n", info->card, channel); |
1708 | #endif | 1179 | #endif |
1709 | cyz_handle_rx(info, buf_ctrl); | 1180 | cyz_handle_rx(info, tty); |
1710 | break; | 1181 | break; |
1711 | case C_CM_TXBEMPTY: | 1182 | case C_CM_TXBEMPTY: |
1712 | case C_CM_TXLOWWM: | 1183 | case C_CM_TXLOWWM: |
@@ -1716,7 +1187,7 @@ static void cyz_handle_cmd(struct cyclades_card *cinfo) | |||
1716 | printk(KERN_DEBUG "cyz_interrupt: xmit intr, card %d, " | 1187 | printk(KERN_DEBUG "cyz_interrupt: xmit intr, card %d, " |
1717 | "port %ld\n", info->card, channel); | 1188 | "port %ld\n", info->card, channel); |
1718 | #endif | 1189 | #endif |
1719 | cyz_handle_tx(info, buf_ctrl); | 1190 | cyz_handle_tx(info, tty); |
1720 | break; | 1191 | break; |
1721 | #endif /* CONFIG_CYZ_INTR */ | 1192 | #endif /* CONFIG_CYZ_INTR */ |
1722 | case C_CM_FATAL: | 1193 | case C_CM_FATAL: |
@@ -1726,9 +1197,10 @@ static void cyz_handle_cmd(struct cyclades_card *cinfo) | |||
1726 | break; | 1197 | break; |
1727 | } | 1198 | } |
1728 | if (delta_count) | 1199 | if (delta_count) |
1729 | wake_up_interruptible(&info->delta_msr_wait); | 1200 | wake_up_interruptible(&info->port.delta_msr_wait); |
1730 | if (special_count) | 1201 | if (special_count) |
1731 | tty_schedule_flip(tty); | 1202 | tty_schedule_flip(tty); |
1203 | tty_kref_put(tty); | ||
1732 | } | 1204 | } |
1733 | } | 1205 | } |
1734 | 1206 | ||
@@ -1774,10 +1246,6 @@ static void cyz_poll(unsigned long arg) | |||
1774 | { | 1246 | { |
1775 | struct cyclades_card *cinfo; | 1247 | struct cyclades_card *cinfo; |
1776 | struct cyclades_port *info; | 1248 | struct cyclades_port *info; |
1777 | struct tty_struct *tty; | ||
1778 | struct FIRM_ID __iomem *firm_id; | ||
1779 | struct ZFW_CTRL __iomem *zfw_ctrl; | ||
1780 | struct BUF_CTRL __iomem *buf_ctrl; | ||
1781 | unsigned long expires = jiffies + HZ; | 1249 | unsigned long expires = jiffies + HZ; |
1782 | unsigned int port, card; | 1250 | unsigned int port, card; |
1783 | 1251 | ||
@@ -1789,10 +1257,6 @@ static void cyz_poll(unsigned long arg) | |||
1789 | if (!cyz_is_loaded(cinfo)) | 1257 | if (!cyz_is_loaded(cinfo)) |
1790 | continue; | 1258 | continue; |
1791 | 1259 | ||
1792 | firm_id = cinfo->base_addr + ID_ADDRESS; | ||
1793 | zfw_ctrl = cinfo->base_addr + | ||
1794 | (readl(&firm_id->zfwctrl_addr) & 0xfffff); | ||
1795 | |||
1796 | /* Skip first polling cycle to avoid racing conditions with the FW */ | 1260 | /* Skip first polling cycle to avoid racing conditions with the FW */ |
1797 | if (!cinfo->intr_enabled) { | 1261 | if (!cinfo->intr_enabled) { |
1798 | cinfo->intr_enabled = 1; | 1262 | cinfo->intr_enabled = 1; |
@@ -1802,13 +1266,17 @@ static void cyz_poll(unsigned long arg) | |||
1802 | cyz_handle_cmd(cinfo); | 1266 | cyz_handle_cmd(cinfo); |
1803 | 1267 | ||
1804 | for (port = 0; port < cinfo->nports; port++) { | 1268 | for (port = 0; port < cinfo->nports; port++) { |
1269 | struct tty_struct *tty; | ||
1270 | |||
1805 | info = &cinfo->ports[port]; | 1271 | info = &cinfo->ports[port]; |
1806 | tty = info->port.tty; | 1272 | tty = tty_port_tty_get(&info->port); |
1807 | buf_ctrl = &(zfw_ctrl->buf_ctrl[port]); | 1273 | /* OK to pass NULL to the handle functions below. |
1274 | They need to drop the data in that case. */ | ||
1808 | 1275 | ||
1809 | if (!info->throttle) | 1276 | if (!info->throttle) |
1810 | cyz_handle_rx(info, buf_ctrl); | 1277 | cyz_handle_rx(info, tty); |
1811 | cyz_handle_tx(info, buf_ctrl); | 1278 | cyz_handle_tx(info, tty); |
1279 | tty_kref_put(tty); | ||
1812 | } | 1280 | } |
1813 | /* poll every 'cyz_polling_cycle' period */ | 1281 | /* poll every 'cyz_polling_cycle' period */ |
1814 | expires = jiffies + cyz_polling_cycle; | 1282 | expires = jiffies + cyz_polling_cycle; |
@@ -1824,13 +1292,12 @@ static void cyz_poll(unsigned long arg) | |||
1824 | /* This is called whenever a port becomes active; | 1292 | /* This is called whenever a port becomes active; |
1825 | interrupts are enabled and DTR & RTS are turned on. | 1293 | interrupts are enabled and DTR & RTS are turned on. |
1826 | */ | 1294 | */ |
1827 | static int startup(struct cyclades_port *info) | 1295 | static int cy_startup(struct cyclades_port *info, struct tty_struct *tty) |
1828 | { | 1296 | { |
1829 | struct cyclades_card *card; | 1297 | struct cyclades_card *card; |
1830 | unsigned long flags; | 1298 | unsigned long flags; |
1831 | int retval = 0; | 1299 | int retval = 0; |
1832 | void __iomem *base_addr; | 1300 | int channel; |
1833 | int chip, channel, index; | ||
1834 | unsigned long page; | 1301 | unsigned long page; |
1835 | 1302 | ||
1836 | card = info->card; | 1303 | card = info->card; |
@@ -1842,15 +1309,11 @@ static int startup(struct cyclades_port *info) | |||
1842 | 1309 | ||
1843 | spin_lock_irqsave(&card->card_lock, flags); | 1310 | spin_lock_irqsave(&card->card_lock, flags); |
1844 | 1311 | ||
1845 | if (info->port.flags & ASYNC_INITIALIZED) { | 1312 | if (info->port.flags & ASYNC_INITIALIZED) |
1846 | free_page(page); | ||
1847 | goto errout; | 1313 | goto errout; |
1848 | } | ||
1849 | 1314 | ||
1850 | if (!info->type) { | 1315 | if (!info->type) { |
1851 | if (info->port.tty) | 1316 | set_bit(TTY_IO_ERROR, &tty->flags); |
1852 | set_bit(TTY_IO_ERROR, &info->port.tty->flags); | ||
1853 | free_page(page); | ||
1854 | goto errout; | 1317 | goto errout; |
1855 | } | 1318 | } |
1856 | 1319 | ||
@@ -1861,96 +1324,53 @@ static int startup(struct cyclades_port *info) | |||
1861 | 1324 | ||
1862 | spin_unlock_irqrestore(&card->card_lock, flags); | 1325 | spin_unlock_irqrestore(&card->card_lock, flags); |
1863 | 1326 | ||
1864 | set_line_char(info); | 1327 | cy_set_line_char(info, tty); |
1865 | 1328 | ||
1866 | if (!cy_is_Z(card)) { | 1329 | if (!cy_is_Z(card)) { |
1867 | chip = channel >> 2; | ||
1868 | channel &= 0x03; | 1330 | channel &= 0x03; |
1869 | index = card->bus_index; | ||
1870 | base_addr = card->base_addr + (cy_chip_offset[chip] << index); | ||
1871 | 1331 | ||
1872 | #ifdef CY_DEBUG_OPEN | ||
1873 | printk(KERN_DEBUG "cyc startup card %d, chip %d, channel %d, " | ||
1874 | "base_addr %p\n", | ||
1875 | card, chip, channel, base_addr); | ||
1876 | #endif | ||
1877 | spin_lock_irqsave(&card->card_lock, flags); | 1332 | spin_lock_irqsave(&card->card_lock, flags); |
1878 | 1333 | ||
1879 | cy_writeb(base_addr + (CyCAR << index), (u_char) channel); | 1334 | cyy_writeb(info, CyCAR, channel); |
1880 | 1335 | ||
1881 | cy_writeb(base_addr + (CyRTPR << index), | 1336 | cyy_writeb(info, CyRTPR, |
1882 | (info->default_timeout ? info->default_timeout : 0x02)); | 1337 | (info->default_timeout ? info->default_timeout : 0x02)); |
1883 | /* 10ms rx timeout */ | 1338 | /* 10ms rx timeout */ |
1884 | 1339 | ||
1885 | cyy_issue_cmd(base_addr, CyCHAN_CTL | CyENB_RCVR | CyENB_XMTR, | 1340 | cyy_issue_cmd(info, CyCHAN_CTL | CyENB_RCVR | CyENB_XMTR); |
1886 | index); | ||
1887 | |||
1888 | cy_writeb(base_addr + (CyCAR << index), (u_char) channel); | ||
1889 | cy_writeb(base_addr + (CyMSVR1 << index), CyRTS); | ||
1890 | cy_writeb(base_addr + (CyMSVR2 << index), CyDTR); | ||
1891 | |||
1892 | #ifdef CY_DEBUG_DTR | ||
1893 | printk(KERN_DEBUG "cyc:startup raising DTR\n"); | ||
1894 | printk(KERN_DEBUG " status: 0x%x, 0x%x\n", | ||
1895 | readb(base_addr + (CyMSVR1 << index)), | ||
1896 | readb(base_addr + (CyMSVR2 << index))); | ||
1897 | #endif | ||
1898 | |||
1899 | cy_writeb(base_addr + (CySRER << index), | ||
1900 | readb(base_addr + (CySRER << index)) | CyRxData); | ||
1901 | info->port.flags |= ASYNC_INITIALIZED; | ||
1902 | |||
1903 | if (info->port.tty) | ||
1904 | clear_bit(TTY_IO_ERROR, &info->port.tty->flags); | ||
1905 | info->xmit_cnt = info->xmit_head = info->xmit_tail = 0; | ||
1906 | info->breakon = info->breakoff = 0; | ||
1907 | memset((char *)&info->idle_stats, 0, sizeof(info->idle_stats)); | ||
1908 | info->idle_stats.in_use = | ||
1909 | info->idle_stats.recv_idle = | ||
1910 | info->idle_stats.xmit_idle = jiffies; | ||
1911 | 1341 | ||
1912 | spin_unlock_irqrestore(&card->card_lock, flags); | 1342 | cyy_change_rts_dtr(info, TIOCM_RTS | TIOCM_DTR, 0); |
1913 | 1343 | ||
1344 | cyy_writeb(info, CySRER, cyy_readb(info, CySRER) | CyRxData); | ||
1914 | } else { | 1345 | } else { |
1915 | struct FIRM_ID __iomem *firm_id; | 1346 | struct CH_CTRL __iomem *ch_ctrl = info->u.cyz.ch_ctrl; |
1916 | struct ZFW_CTRL __iomem *zfw_ctrl; | ||
1917 | struct BOARD_CTRL __iomem *board_ctrl; | ||
1918 | struct CH_CTRL __iomem *ch_ctrl; | ||
1919 | 1347 | ||
1920 | base_addr = card->base_addr; | ||
1921 | |||
1922 | firm_id = base_addr + ID_ADDRESS; | ||
1923 | if (!cyz_is_loaded(card)) | 1348 | if (!cyz_is_loaded(card)) |
1924 | return -ENODEV; | 1349 | return -ENODEV; |
1925 | 1350 | ||
1926 | zfw_ctrl = card->base_addr + | ||
1927 | (readl(&firm_id->zfwctrl_addr) & 0xfffff); | ||
1928 | board_ctrl = &zfw_ctrl->board_ctrl; | ||
1929 | ch_ctrl = zfw_ctrl->ch_ctrl; | ||
1930 | |||
1931 | #ifdef CY_DEBUG_OPEN | 1351 | #ifdef CY_DEBUG_OPEN |
1932 | printk(KERN_DEBUG "cyc startup Z card %d, channel %d, " | 1352 | printk(KERN_DEBUG "cyc startup Z card %d, channel %d, " |
1933 | "base_addr %p\n", card, channel, base_addr); | 1353 | "base_addr %p\n", card, channel, card->base_addr); |
1934 | #endif | 1354 | #endif |
1935 | spin_lock_irqsave(&card->card_lock, flags); | 1355 | spin_lock_irqsave(&card->card_lock, flags); |
1936 | 1356 | ||
1937 | cy_writel(&ch_ctrl[channel].op_mode, C_CH_ENABLE); | 1357 | cy_writel(&ch_ctrl->op_mode, C_CH_ENABLE); |
1938 | #ifdef Z_WAKE | 1358 | #ifdef Z_WAKE |
1939 | #ifdef CONFIG_CYZ_INTR | 1359 | #ifdef CONFIG_CYZ_INTR |
1940 | cy_writel(&ch_ctrl[channel].intr_enable, | 1360 | cy_writel(&ch_ctrl->intr_enable, |
1941 | C_IN_TXBEMPTY | C_IN_TXLOWWM | C_IN_RXHIWM | | 1361 | C_IN_TXBEMPTY | C_IN_TXLOWWM | C_IN_RXHIWM | |
1942 | C_IN_RXNNDT | C_IN_IOCTLW | C_IN_MDCD); | 1362 | C_IN_RXNNDT | C_IN_IOCTLW | C_IN_MDCD); |
1943 | #else | 1363 | #else |
1944 | cy_writel(&ch_ctrl[channel].intr_enable, | 1364 | cy_writel(&ch_ctrl->intr_enable, |
1945 | C_IN_IOCTLW | C_IN_MDCD); | 1365 | C_IN_IOCTLW | C_IN_MDCD); |
1946 | #endif /* CONFIG_CYZ_INTR */ | 1366 | #endif /* CONFIG_CYZ_INTR */ |
1947 | #else | 1367 | #else |
1948 | #ifdef CONFIG_CYZ_INTR | 1368 | #ifdef CONFIG_CYZ_INTR |
1949 | cy_writel(&ch_ctrl[channel].intr_enable, | 1369 | cy_writel(&ch_ctrl->intr_enable, |
1950 | C_IN_TXBEMPTY | C_IN_TXLOWWM | C_IN_RXHIWM | | 1370 | C_IN_TXBEMPTY | C_IN_TXLOWWM | C_IN_RXHIWM | |
1951 | C_IN_RXNNDT | C_IN_MDCD); | 1371 | C_IN_RXNNDT | C_IN_MDCD); |
1952 | #else | 1372 | #else |
1953 | cy_writel(&ch_ctrl[channel].intr_enable, C_IN_MDCD); | 1373 | cy_writel(&ch_ctrl->intr_enable, C_IN_MDCD); |
1954 | #endif /* CONFIG_CYZ_INTR */ | 1374 | #endif /* CONFIG_CYZ_INTR */ |
1955 | #endif /* Z_WAKE */ | 1375 | #endif /* Z_WAKE */ |
1956 | 1376 | ||
@@ -1969,32 +1389,22 @@ static int startup(struct cyclades_port *info) | |||
1969 | 1389 | ||
1970 | /* set timeout !!! */ | 1390 | /* set timeout !!! */ |
1971 | /* set RTS and DTR !!! */ | 1391 | /* set RTS and DTR !!! */ |
1972 | cy_writel(&ch_ctrl[channel].rs_control, | 1392 | tty_port_raise_dtr_rts(&info->port); |
1973 | readl(&ch_ctrl[channel].rs_control) | C_RS_RTS | | ||
1974 | C_RS_DTR); | ||
1975 | retval = cyz_issue_cmd(card, channel, C_CM_IOCTLM, 0L); | ||
1976 | if (retval != 0) { | ||
1977 | printk(KERN_ERR "cyc:startup(3) retval on ttyC%d was " | ||
1978 | "%x\n", info->line, retval); | ||
1979 | } | ||
1980 | #ifdef CY_DEBUG_DTR | ||
1981 | printk(KERN_DEBUG "cyc:startup raising Z DTR\n"); | ||
1982 | #endif | ||
1983 | 1393 | ||
1984 | /* enable send, recv, modem !!! */ | 1394 | /* enable send, recv, modem !!! */ |
1395 | } | ||
1985 | 1396 | ||
1986 | info->port.flags |= ASYNC_INITIALIZED; | 1397 | info->port.flags |= ASYNC_INITIALIZED; |
1987 | if (info->port.tty) | ||
1988 | clear_bit(TTY_IO_ERROR, &info->port.tty->flags); | ||
1989 | info->xmit_cnt = info->xmit_head = info->xmit_tail = 0; | ||
1990 | info->breakon = info->breakoff = 0; | ||
1991 | memset((char *)&info->idle_stats, 0, sizeof(info->idle_stats)); | ||
1992 | info->idle_stats.in_use = | ||
1993 | info->idle_stats.recv_idle = | ||
1994 | info->idle_stats.xmit_idle = jiffies; | ||
1995 | 1398 | ||
1996 | spin_unlock_irqrestore(&card->card_lock, flags); | 1399 | clear_bit(TTY_IO_ERROR, &tty->flags); |
1997 | } | 1400 | info->xmit_cnt = info->xmit_head = info->xmit_tail = 0; |
1401 | info->breakon = info->breakoff = 0; | ||
1402 | memset((char *)&info->idle_stats, 0, sizeof(info->idle_stats)); | ||
1403 | info->idle_stats.in_use = | ||
1404 | info->idle_stats.recv_idle = | ||
1405 | info->idle_stats.xmit_idle = jiffies; | ||
1406 | |||
1407 | spin_unlock_irqrestore(&card->card_lock, flags); | ||
1998 | 1408 | ||
1999 | #ifdef CY_DEBUG_OPEN | 1409 | #ifdef CY_DEBUG_OPEN |
2000 | printk(KERN_DEBUG "cyc startup done\n"); | 1410 | printk(KERN_DEBUG "cyc startup done\n"); |
@@ -2003,28 +1413,20 @@ static int startup(struct cyclades_port *info) | |||
2003 | 1413 | ||
2004 | errout: | 1414 | errout: |
2005 | spin_unlock_irqrestore(&card->card_lock, flags); | 1415 | spin_unlock_irqrestore(&card->card_lock, flags); |
1416 | free_page(page); | ||
2006 | return retval; | 1417 | return retval; |
2007 | } /* startup */ | 1418 | } /* startup */ |
2008 | 1419 | ||
2009 | static void start_xmit(struct cyclades_port *info) | 1420 | static void start_xmit(struct cyclades_port *info) |
2010 | { | 1421 | { |
2011 | struct cyclades_card *card; | 1422 | struct cyclades_card *card = info->card; |
2012 | unsigned long flags; | 1423 | unsigned long flags; |
2013 | void __iomem *base_addr; | 1424 | int channel = info->line - card->first_line; |
2014 | int chip, channel, index; | ||
2015 | 1425 | ||
2016 | card = info->card; | ||
2017 | channel = info->line - card->first_line; | ||
2018 | if (!cy_is_Z(card)) { | 1426 | if (!cy_is_Z(card)) { |
2019 | chip = channel >> 2; | ||
2020 | channel &= 0x03; | ||
2021 | index = card->bus_index; | ||
2022 | base_addr = card->base_addr + (cy_chip_offset[chip] << index); | ||
2023 | |||
2024 | spin_lock_irqsave(&card->card_lock, flags); | 1427 | spin_lock_irqsave(&card->card_lock, flags); |
2025 | cy_writeb(base_addr + (CyCAR << index), channel); | 1428 | cyy_writeb(info, CyCAR, channel & 0x03); |
2026 | cy_writeb(base_addr + (CySRER << index), | 1429 | cyy_writeb(info, CySRER, cyy_readb(info, CySRER) | CyTxRdy); |
2027 | readb(base_addr + (CySRER << index)) | CyTxRdy); | ||
2028 | spin_unlock_irqrestore(&card->card_lock, flags); | 1430 | spin_unlock_irqrestore(&card->card_lock, flags); |
2029 | } else { | 1431 | } else { |
2030 | #ifdef CONFIG_CYZ_INTR | 1432 | #ifdef CONFIG_CYZ_INTR |
@@ -2047,12 +1449,11 @@ static void start_xmit(struct cyclades_port *info) | |||
2047 | * This routine shuts down a serial port; interrupts are disabled, | 1449 | * This routine shuts down a serial port; interrupts are disabled, |
2048 | * and DTR is dropped if the hangup on close termio flag is on. | 1450 | * and DTR is dropped if the hangup on close termio flag is on. |
2049 | */ | 1451 | */ |
2050 | static void shutdown(struct cyclades_port *info) | 1452 | static void cy_shutdown(struct cyclades_port *info, struct tty_struct *tty) |
2051 | { | 1453 | { |
2052 | struct cyclades_card *card; | 1454 | struct cyclades_card *card; |
2053 | unsigned long flags; | 1455 | unsigned long flags; |
2054 | void __iomem *base_addr; | 1456 | int channel; |
2055 | int chip, channel, index; | ||
2056 | 1457 | ||
2057 | if (!(info->port.flags & ASYNC_INITIALIZED)) | 1458 | if (!(info->port.flags & ASYNC_INITIALIZED)) |
2058 | return; | 1459 | return; |
@@ -2060,21 +1461,10 @@ static void shutdown(struct cyclades_port *info) | |||
2060 | card = info->card; | 1461 | card = info->card; |
2061 | channel = info->line - card->first_line; | 1462 | channel = info->line - card->first_line; |
2062 | if (!cy_is_Z(card)) { | 1463 | if (!cy_is_Z(card)) { |
2063 | chip = channel >> 2; | ||
2064 | channel &= 0x03; | ||
2065 | index = card->bus_index; | ||
2066 | base_addr = card->base_addr + (cy_chip_offset[chip] << index); | ||
2067 | |||
2068 | #ifdef CY_DEBUG_OPEN | ||
2069 | printk(KERN_DEBUG "cyc shutdown Y card %d, chip %d, " | ||
2070 | "channel %d, base_addr %p\n", | ||
2071 | card, chip, channel, base_addr); | ||
2072 | #endif | ||
2073 | |||
2074 | spin_lock_irqsave(&card->card_lock, flags); | 1464 | spin_lock_irqsave(&card->card_lock, flags); |
2075 | 1465 | ||
2076 | /* Clear delta_msr_wait queue to avoid mem leaks. */ | 1466 | /* Clear delta_msr_wait queue to avoid mem leaks. */ |
2077 | wake_up_interruptible(&info->delta_msr_wait); | 1467 | wake_up_interruptible(&info->port.delta_msr_wait); |
2078 | 1468 | ||
2079 | if (info->port.xmit_buf) { | 1469 | if (info->port.xmit_buf) { |
2080 | unsigned char *temp; | 1470 | unsigned char *temp; |
@@ -2082,47 +1472,25 @@ static void shutdown(struct cyclades_port *info) | |||
2082 | info->port.xmit_buf = NULL; | 1472 | info->port.xmit_buf = NULL; |
2083 | free_page((unsigned long)temp); | 1473 | free_page((unsigned long)temp); |
2084 | } | 1474 | } |
2085 | cy_writeb(base_addr + (CyCAR << index), (u_char) channel); | 1475 | if (tty->termios->c_cflag & HUPCL) |
2086 | if (!info->port.tty || (info->port.tty->termios->c_cflag & HUPCL)) { | 1476 | cyy_change_rts_dtr(info, 0, TIOCM_RTS | TIOCM_DTR); |
2087 | cy_writeb(base_addr + (CyMSVR1 << index), ~CyRTS); | 1477 | |
2088 | cy_writeb(base_addr + (CyMSVR2 << index), ~CyDTR); | 1478 | cyy_issue_cmd(info, CyCHAN_CTL | CyDIS_RCVR); |
2089 | #ifdef CY_DEBUG_DTR | ||
2090 | printk(KERN_DEBUG "cyc shutdown dropping DTR\n"); | ||
2091 | printk(KERN_DEBUG " status: 0x%x, 0x%x\n", | ||
2092 | readb(base_addr + (CyMSVR1 << index)), | ||
2093 | readb(base_addr + (CyMSVR2 << index))); | ||
2094 | #endif | ||
2095 | } | ||
2096 | cyy_issue_cmd(base_addr, CyCHAN_CTL | CyDIS_RCVR, index); | ||
2097 | /* it may be appropriate to clear _XMIT at | 1479 | /* it may be appropriate to clear _XMIT at |
2098 | some later date (after testing)!!! */ | 1480 | some later date (after testing)!!! */ |
2099 | 1481 | ||
2100 | if (info->port.tty) | 1482 | set_bit(TTY_IO_ERROR, &tty->flags); |
2101 | set_bit(TTY_IO_ERROR, &info->port.tty->flags); | ||
2102 | info->port.flags &= ~ASYNC_INITIALIZED; | 1483 | info->port.flags &= ~ASYNC_INITIALIZED; |
2103 | spin_unlock_irqrestore(&card->card_lock, flags); | 1484 | spin_unlock_irqrestore(&card->card_lock, flags); |
2104 | } else { | 1485 | } else { |
2105 | struct FIRM_ID __iomem *firm_id; | ||
2106 | struct ZFW_CTRL __iomem *zfw_ctrl; | ||
2107 | struct BOARD_CTRL __iomem *board_ctrl; | ||
2108 | struct CH_CTRL __iomem *ch_ctrl; | ||
2109 | int retval; | ||
2110 | |||
2111 | base_addr = card->base_addr; | ||
2112 | #ifdef CY_DEBUG_OPEN | 1486 | #ifdef CY_DEBUG_OPEN |
2113 | printk(KERN_DEBUG "cyc shutdown Z card %d, channel %d, " | 1487 | printk(KERN_DEBUG "cyc shutdown Z card %d, channel %d, " |
2114 | "base_addr %p\n", card, channel, base_addr); | 1488 | "base_addr %p\n", card, channel, card->base_addr); |
2115 | #endif | 1489 | #endif |
2116 | 1490 | ||
2117 | firm_id = base_addr + ID_ADDRESS; | ||
2118 | if (!cyz_is_loaded(card)) | 1491 | if (!cyz_is_loaded(card)) |
2119 | return; | 1492 | return; |
2120 | 1493 | ||
2121 | zfw_ctrl = card->base_addr + | ||
2122 | (readl(&firm_id->zfwctrl_addr) & 0xfffff); | ||
2123 | board_ctrl = &zfw_ctrl->board_ctrl; | ||
2124 | ch_ctrl = zfw_ctrl->ch_ctrl; | ||
2125 | |||
2126 | spin_lock_irqsave(&card->card_lock, flags); | 1494 | spin_lock_irqsave(&card->card_lock, flags); |
2127 | 1495 | ||
2128 | if (info->port.xmit_buf) { | 1496 | if (info->port.xmit_buf) { |
@@ -2132,23 +1500,10 @@ static void shutdown(struct cyclades_port *info) | |||
2132 | free_page((unsigned long)temp); | 1500 | free_page((unsigned long)temp); |
2133 | } | 1501 | } |
2134 | 1502 | ||
2135 | if (!info->port.tty || (info->port.tty->termios->c_cflag & HUPCL)) { | 1503 | if (tty->termios->c_cflag & HUPCL) |
2136 | cy_writel(&ch_ctrl[channel].rs_control, | 1504 | tty_port_lower_dtr_rts(&info->port); |
2137 | (__u32)(readl(&ch_ctrl[channel].rs_control) & | ||
2138 | ~(C_RS_RTS | C_RS_DTR))); | ||
2139 | retval = cyz_issue_cmd(info->card, channel, | ||
2140 | C_CM_IOCTLM, 0L); | ||
2141 | if (retval != 0) { | ||
2142 | printk(KERN_ERR"cyc:shutdown retval on ttyC%d " | ||
2143 | "was %x\n", info->line, retval); | ||
2144 | } | ||
2145 | #ifdef CY_DEBUG_DTR | ||
2146 | printk(KERN_DEBUG "cyc:shutdown dropping Z DTR\n"); | ||
2147 | #endif | ||
2148 | } | ||
2149 | 1505 | ||
2150 | if (info->port.tty) | 1506 | set_bit(TTY_IO_ERROR, &tty->flags); |
2151 | set_bit(TTY_IO_ERROR, &info->port.tty->flags); | ||
2152 | info->port.flags &= ~ASYNC_INITIALIZED; | 1507 | info->port.flags &= ~ASYNC_INITIALIZED; |
2153 | 1508 | ||
2154 | spin_unlock_irqrestore(&card->card_lock, flags); | 1509 | spin_unlock_irqrestore(&card->card_lock, flags); |
@@ -2165,199 +1520,6 @@ static void shutdown(struct cyclades_port *info) | |||
2165 | * ------------------------------------------------------------ | 1520 | * ------------------------------------------------------------ |
2166 | */ | 1521 | */ |
2167 | 1522 | ||
2168 | static int | ||
2169 | block_til_ready(struct tty_struct *tty, struct file *filp, | ||
2170 | struct cyclades_port *info) | ||
2171 | { | ||
2172 | DECLARE_WAITQUEUE(wait, current); | ||
2173 | struct cyclades_card *cinfo; | ||
2174 | unsigned long flags; | ||
2175 | int chip, channel, index; | ||
2176 | int retval; | ||
2177 | void __iomem *base_addr; | ||
2178 | |||
2179 | cinfo = info->card; | ||
2180 | channel = info->line - cinfo->first_line; | ||
2181 | |||
2182 | /* | ||
2183 | * If the device is in the middle of being closed, then block | ||
2184 | * until it's done, and then try again. | ||
2185 | */ | ||
2186 | if (tty_hung_up_p(filp) || (info->port.flags & ASYNC_CLOSING)) { | ||
2187 | wait_event_interruptible(info->port.close_wait, | ||
2188 | !(info->port.flags & ASYNC_CLOSING)); | ||
2189 | return (info->port.flags & ASYNC_HUP_NOTIFY) ? -EAGAIN: -ERESTARTSYS; | ||
2190 | } | ||
2191 | |||
2192 | /* | ||
2193 | * If non-blocking mode is set, then make the check up front | ||
2194 | * and then exit. | ||
2195 | */ | ||
2196 | if ((filp->f_flags & O_NONBLOCK) || | ||
2197 | (tty->flags & (1 << TTY_IO_ERROR))) { | ||
2198 | info->port.flags |= ASYNC_NORMAL_ACTIVE; | ||
2199 | return 0; | ||
2200 | } | ||
2201 | |||
2202 | /* | ||
2203 | * Block waiting for the carrier detect and the line to become | ||
2204 | * free (i.e., not in use by the callout). While we are in | ||
2205 | * this loop, info->port.count is dropped by one, so that | ||
2206 | * cy_close() knows when to free things. We restore it upon | ||
2207 | * exit, either normal or abnormal. | ||
2208 | */ | ||
2209 | retval = 0; | ||
2210 | add_wait_queue(&info->port.open_wait, &wait); | ||
2211 | #ifdef CY_DEBUG_OPEN | ||
2212 | printk(KERN_DEBUG "cyc block_til_ready before block: ttyC%d, " | ||
2213 | "count = %d\n", info->line, info->port.count); | ||
2214 | #endif | ||
2215 | spin_lock_irqsave(&cinfo->card_lock, flags); | ||
2216 | if (!tty_hung_up_p(filp)) | ||
2217 | info->port.count--; | ||
2218 | spin_unlock_irqrestore(&cinfo->card_lock, flags); | ||
2219 | #ifdef CY_DEBUG_COUNT | ||
2220 | printk(KERN_DEBUG "cyc block_til_ready: (%d): decrementing count to " | ||
2221 | "%d\n", current->pid, info->port.count); | ||
2222 | #endif | ||
2223 | info->port.blocked_open++; | ||
2224 | |||
2225 | if (!cy_is_Z(cinfo)) { | ||
2226 | chip = channel >> 2; | ||
2227 | channel &= 0x03; | ||
2228 | index = cinfo->bus_index; | ||
2229 | base_addr = cinfo->base_addr + (cy_chip_offset[chip] << index); | ||
2230 | |||
2231 | while (1) { | ||
2232 | spin_lock_irqsave(&cinfo->card_lock, flags); | ||
2233 | if ((tty->termios->c_cflag & CBAUD)) { | ||
2234 | cy_writeb(base_addr + (CyCAR << index), | ||
2235 | (u_char) channel); | ||
2236 | cy_writeb(base_addr + (CyMSVR1 << index), | ||
2237 | CyRTS); | ||
2238 | cy_writeb(base_addr + (CyMSVR2 << index), | ||
2239 | CyDTR); | ||
2240 | #ifdef CY_DEBUG_DTR | ||
2241 | printk(KERN_DEBUG "cyc:block_til_ready raising " | ||
2242 | "DTR\n"); | ||
2243 | printk(KERN_DEBUG " status: 0x%x, 0x%x\n", | ||
2244 | readb(base_addr + (CyMSVR1 << index)), | ||
2245 | readb(base_addr + (CyMSVR2 << index))); | ||
2246 | #endif | ||
2247 | } | ||
2248 | spin_unlock_irqrestore(&cinfo->card_lock, flags); | ||
2249 | |||
2250 | set_current_state(TASK_INTERRUPTIBLE); | ||
2251 | if (tty_hung_up_p(filp) || | ||
2252 | !(info->port.flags & ASYNC_INITIALIZED)) { | ||
2253 | retval = ((info->port.flags & ASYNC_HUP_NOTIFY) ? | ||
2254 | -EAGAIN : -ERESTARTSYS); | ||
2255 | break; | ||
2256 | } | ||
2257 | |||
2258 | spin_lock_irqsave(&cinfo->card_lock, flags); | ||
2259 | cy_writeb(base_addr + (CyCAR << index), | ||
2260 | (u_char) channel); | ||
2261 | if (!(info->port.flags & ASYNC_CLOSING) && (C_CLOCAL(tty) || | ||
2262 | (readb(base_addr + | ||
2263 | (CyMSVR1 << index)) & CyDCD))) { | ||
2264 | spin_unlock_irqrestore(&cinfo->card_lock, flags); | ||
2265 | break; | ||
2266 | } | ||
2267 | spin_unlock_irqrestore(&cinfo->card_lock, flags); | ||
2268 | |||
2269 | if (signal_pending(current)) { | ||
2270 | retval = -ERESTARTSYS; | ||
2271 | break; | ||
2272 | } | ||
2273 | #ifdef CY_DEBUG_OPEN | ||
2274 | printk(KERN_DEBUG "cyc block_til_ready blocking: " | ||
2275 | "ttyC%d, count = %d\n", | ||
2276 | info->line, info->port.count); | ||
2277 | #endif | ||
2278 | schedule(); | ||
2279 | } | ||
2280 | } else { | ||
2281 | struct FIRM_ID __iomem *firm_id; | ||
2282 | struct ZFW_CTRL __iomem *zfw_ctrl; | ||
2283 | struct BOARD_CTRL __iomem *board_ctrl; | ||
2284 | struct CH_CTRL __iomem *ch_ctrl; | ||
2285 | |||
2286 | base_addr = cinfo->base_addr; | ||
2287 | firm_id = base_addr + ID_ADDRESS; | ||
2288 | if (!cyz_is_loaded(cinfo)) { | ||
2289 | __set_current_state(TASK_RUNNING); | ||
2290 | remove_wait_queue(&info->port.open_wait, &wait); | ||
2291 | return -EINVAL; | ||
2292 | } | ||
2293 | |||
2294 | zfw_ctrl = base_addr + (readl(&firm_id->zfwctrl_addr) | ||
2295 | & 0xfffff); | ||
2296 | board_ctrl = &zfw_ctrl->board_ctrl; | ||
2297 | ch_ctrl = zfw_ctrl->ch_ctrl; | ||
2298 | |||
2299 | while (1) { | ||
2300 | if ((tty->termios->c_cflag & CBAUD)) { | ||
2301 | cy_writel(&ch_ctrl[channel].rs_control, | ||
2302 | readl(&ch_ctrl[channel].rs_control) | | ||
2303 | C_RS_RTS | C_RS_DTR); | ||
2304 | retval = cyz_issue_cmd(cinfo, | ||
2305 | channel, C_CM_IOCTLM, 0L); | ||
2306 | if (retval != 0) { | ||
2307 | printk(KERN_ERR "cyc:block_til_ready " | ||
2308 | "retval on ttyC%d was %x\n", | ||
2309 | info->line, retval); | ||
2310 | } | ||
2311 | #ifdef CY_DEBUG_DTR | ||
2312 | printk(KERN_DEBUG "cyc:block_til_ready raising " | ||
2313 | "Z DTR\n"); | ||
2314 | #endif | ||
2315 | } | ||
2316 | |||
2317 | set_current_state(TASK_INTERRUPTIBLE); | ||
2318 | if (tty_hung_up_p(filp) || | ||
2319 | !(info->port.flags & ASYNC_INITIALIZED)) { | ||
2320 | retval = ((info->port.flags & ASYNC_HUP_NOTIFY) ? | ||
2321 | -EAGAIN : -ERESTARTSYS); | ||
2322 | break; | ||
2323 | } | ||
2324 | if (!(info->port.flags & ASYNC_CLOSING) && (C_CLOCAL(tty) || | ||
2325 | (readl(&ch_ctrl[channel].rs_status) & | ||
2326 | C_RS_DCD))) { | ||
2327 | break; | ||
2328 | } | ||
2329 | if (signal_pending(current)) { | ||
2330 | retval = -ERESTARTSYS; | ||
2331 | break; | ||
2332 | } | ||
2333 | #ifdef CY_DEBUG_OPEN | ||
2334 | printk(KERN_DEBUG "cyc block_til_ready blocking: " | ||
2335 | "ttyC%d, count = %d\n", | ||
2336 | info->line, info->port.count); | ||
2337 | #endif | ||
2338 | schedule(); | ||
2339 | } | ||
2340 | } | ||
2341 | __set_current_state(TASK_RUNNING); | ||
2342 | remove_wait_queue(&info->port.open_wait, &wait); | ||
2343 | if (!tty_hung_up_p(filp)) { | ||
2344 | info->port.count++; | ||
2345 | #ifdef CY_DEBUG_COUNT | ||
2346 | printk(KERN_DEBUG "cyc:block_til_ready (%d): incrementing " | ||
2347 | "count to %d\n", current->pid, info->port.count); | ||
2348 | #endif | ||
2349 | } | ||
2350 | info->port.blocked_open--; | ||
2351 | #ifdef CY_DEBUG_OPEN | ||
2352 | printk(KERN_DEBUG "cyc:block_til_ready after blocking: ttyC%d, " | ||
2353 | "count = %d\n", info->line, info->port.count); | ||
2354 | #endif | ||
2355 | if (retval) | ||
2356 | return retval; | ||
2357 | info->port.flags |= ASYNC_NORMAL_ACTIVE; | ||
2358 | return 0; | ||
2359 | } /* block_til_ready */ | ||
2360 | |||
2361 | /* | 1523 | /* |
2362 | * This routine is called whenever a serial port is opened. It | 1524 | * This routine is called whenever a serial port is opened. It |
2363 | * performs the serial-specific initialization for the tty structure. | 1525 | * performs the serial-specific initialization for the tty structure. |
@@ -2436,7 +1598,6 @@ static int cy_open(struct tty_struct *tty, struct file *filp) | |||
2436 | printk(KERN_DEBUG "cyc:cy_open ttyC%d\n", info->line); | 1598 | printk(KERN_DEBUG "cyc:cy_open ttyC%d\n", info->line); |
2437 | #endif | 1599 | #endif |
2438 | tty->driver_data = info; | 1600 | tty->driver_data = info; |
2439 | info->port.tty = tty; | ||
2440 | if (serial_paranoia_check(info, tty->name, "cy_open")) | 1601 | if (serial_paranoia_check(info, tty->name, "cy_open")) |
2441 | return -ENODEV; | 1602 | return -ENODEV; |
2442 | 1603 | ||
@@ -2462,11 +1623,11 @@ static int cy_open(struct tty_struct *tty, struct file *filp) | |||
2462 | /* | 1623 | /* |
2463 | * Start up serial port | 1624 | * Start up serial port |
2464 | */ | 1625 | */ |
2465 | retval = startup(info); | 1626 | retval = cy_startup(info, tty); |
2466 | if (retval) | 1627 | if (retval) |
2467 | return retval; | 1628 | return retval; |
2468 | 1629 | ||
2469 | retval = block_til_ready(tty, filp, info); | 1630 | retval = tty_port_block_til_ready(&info->port, tty, filp); |
2470 | if (retval) { | 1631 | if (retval) { |
2471 | #ifdef CY_DEBUG_OPEN | 1632 | #ifdef CY_DEBUG_OPEN |
2472 | printk(KERN_DEBUG "cyc:cy_open returning after block_til_ready " | 1633 | printk(KERN_DEBUG "cyc:cy_open returning after block_til_ready " |
@@ -2476,6 +1637,7 @@ static int cy_open(struct tty_struct *tty, struct file *filp) | |||
2476 | } | 1637 | } |
2477 | 1638 | ||
2478 | info->throttle = 0; | 1639 | info->throttle = 0; |
1640 | tty_port_tty_set(&info->port, tty); | ||
2479 | 1641 | ||
2480 | #ifdef CY_DEBUG_OPEN | 1642 | #ifdef CY_DEBUG_OPEN |
2481 | printk(KERN_DEBUG "cyc:cy_open done\n"); | 1643 | printk(KERN_DEBUG "cyc:cy_open done\n"); |
@@ -2490,8 +1652,6 @@ static void cy_wait_until_sent(struct tty_struct *tty, int timeout) | |||
2490 | { | 1652 | { |
2491 | struct cyclades_card *card; | 1653 | struct cyclades_card *card; |
2492 | struct cyclades_port *info = tty->driver_data; | 1654 | struct cyclades_port *info = tty->driver_data; |
2493 | void __iomem *base_addr; | ||
2494 | int chip, channel, index; | ||
2495 | unsigned long orig_jiffies; | 1655 | unsigned long orig_jiffies; |
2496 | int char_time; | 1656 | int char_time; |
2497 | 1657 | ||
@@ -2535,13 +1695,8 @@ static void cy_wait_until_sent(struct tty_struct *tty, int timeout) | |||
2535 | timeout, char_time, jiffies); | 1695 | timeout, char_time, jiffies); |
2536 | #endif | 1696 | #endif |
2537 | card = info->card; | 1697 | card = info->card; |
2538 | channel = (info->line) - (card->first_line); | ||
2539 | if (!cy_is_Z(card)) { | 1698 | if (!cy_is_Z(card)) { |
2540 | chip = channel >> 2; | 1699 | while (cyy_readb(info, CySRER) & CyTxRdy) { |
2541 | channel &= 0x03; | ||
2542 | index = card->bus_index; | ||
2543 | base_addr = card->base_addr + (cy_chip_offset[chip] << index); | ||
2544 | while (readb(base_addr + (CySRER << index)) & CyTxRdy) { | ||
2545 | #ifdef CY_DEBUG_WAIT_UNTIL_SENT | 1700 | #ifdef CY_DEBUG_WAIT_UNTIL_SENT |
2546 | printk(KERN_DEBUG "Not clean (jiff=%lu)...", jiffies); | 1701 | printk(KERN_DEBUG "Not clean (jiff=%lu)...", jiffies); |
2547 | #endif | 1702 | #endif |
@@ -2595,103 +1750,37 @@ static void cy_flush_buffer(struct tty_struct *tty) | |||
2595 | } /* cy_flush_buffer */ | 1750 | } /* cy_flush_buffer */ |
2596 | 1751 | ||
2597 | 1752 | ||
2598 | /* | 1753 | static void cy_do_close(struct tty_port *port) |
2599 | * This routine is called when a particular tty device is closed. | ||
2600 | */ | ||
2601 | static void cy_close(struct tty_struct *tty, struct file *filp) | ||
2602 | { | 1754 | { |
2603 | struct cyclades_port *info = tty->driver_data; | 1755 | struct cyclades_port *info = container_of(port, struct cyclades_port, |
1756 | port); | ||
2604 | struct cyclades_card *card; | 1757 | struct cyclades_card *card; |
2605 | unsigned long flags; | 1758 | unsigned long flags; |
2606 | 1759 | int channel; | |
2607 | #ifdef CY_DEBUG_OTHER | ||
2608 | printk(KERN_DEBUG "cyc:cy_close ttyC%d\n", info->line); | ||
2609 | #endif | ||
2610 | |||
2611 | if (!info || serial_paranoia_check(info, tty->name, "cy_close")) | ||
2612 | return; | ||
2613 | 1760 | ||
2614 | card = info->card; | 1761 | card = info->card; |
2615 | 1762 | channel = info->line - card->first_line; | |
2616 | spin_lock_irqsave(&card->card_lock, flags); | ||
2617 | /* If the TTY is being hung up, nothing to do */ | ||
2618 | if (tty_hung_up_p(filp)) { | ||
2619 | spin_unlock_irqrestore(&card->card_lock, flags); | ||
2620 | return; | ||
2621 | } | ||
2622 | #ifdef CY_DEBUG_OPEN | ||
2623 | printk(KERN_DEBUG "cyc:cy_close ttyC%d, count = %d\n", info->line, | ||
2624 | info->port.count); | ||
2625 | #endif | ||
2626 | if ((tty->count == 1) && (info->port.count != 1)) { | ||
2627 | /* | ||
2628 | * Uh, oh. tty->count is 1, which means that the tty | ||
2629 | * structure will be freed. Info->count should always | ||
2630 | * be one in these conditions. If it's greater than | ||
2631 | * one, we've got real problems, since it means the | ||
2632 | * serial port won't be shutdown. | ||
2633 | */ | ||
2634 | printk(KERN_ERR "cyc:cy_close: bad serial port count; " | ||
2635 | "tty->count is 1, info->port.count is %d\n", info->port.count); | ||
2636 | info->port.count = 1; | ||
2637 | } | ||
2638 | #ifdef CY_DEBUG_COUNT | ||
2639 | printk(KERN_DEBUG "cyc:cy_close at (%d): decrementing count to %d\n", | ||
2640 | current->pid, info->port.count - 1); | ||
2641 | #endif | ||
2642 | if (--info->port.count < 0) { | ||
2643 | #ifdef CY_DEBUG_COUNT | ||
2644 | printk(KERN_DEBUG "cyc:cyc_close setting count to 0\n"); | ||
2645 | #endif | ||
2646 | info->port.count = 0; | ||
2647 | } | ||
2648 | if (info->port.count) { | ||
2649 | spin_unlock_irqrestore(&card->card_lock, flags); | ||
2650 | return; | ||
2651 | } | ||
2652 | info->port.flags |= ASYNC_CLOSING; | ||
2653 | |||
2654 | /* | ||
2655 | * Now we wait for the transmit buffer to clear; and we notify | ||
2656 | * the line discipline to only process XON/XOFF characters. | ||
2657 | */ | ||
2658 | tty->closing = 1; | ||
2659 | spin_unlock_irqrestore(&card->card_lock, flags); | ||
2660 | if (info->port.closing_wait != CY_CLOSING_WAIT_NONE) | ||
2661 | tty_wait_until_sent(tty, info->port.closing_wait); | ||
2662 | |||
2663 | spin_lock_irqsave(&card->card_lock, flags); | 1763 | spin_lock_irqsave(&card->card_lock, flags); |
2664 | 1764 | ||
2665 | if (!cy_is_Z(card)) { | 1765 | if (!cy_is_Z(card)) { |
2666 | int channel = info->line - card->first_line; | ||
2667 | int index = card->bus_index; | ||
2668 | void __iomem *base_addr = card->base_addr + | ||
2669 | (cy_chip_offset[channel >> 2] << index); | ||
2670 | /* Stop accepting input */ | 1766 | /* Stop accepting input */ |
2671 | channel &= 0x03; | 1767 | cyy_writeb(info, CyCAR, channel & 0x03); |
2672 | cy_writeb(base_addr + (CyCAR << index), (u_char) channel); | 1768 | cyy_writeb(info, CySRER, cyy_readb(info, CySRER) & ~CyRxData); |
2673 | cy_writeb(base_addr + (CySRER << index), | ||
2674 | readb(base_addr + (CySRER << index)) & ~CyRxData); | ||
2675 | if (info->port.flags & ASYNC_INITIALIZED) { | 1769 | if (info->port.flags & ASYNC_INITIALIZED) { |
2676 | /* Waiting for on-board buffers to be empty before | 1770 | /* Waiting for on-board buffers to be empty before |
2677 | closing the port */ | 1771 | closing the port */ |
2678 | spin_unlock_irqrestore(&card->card_lock, flags); | 1772 | spin_unlock_irqrestore(&card->card_lock, flags); |
2679 | cy_wait_until_sent(tty, info->timeout); | 1773 | cy_wait_until_sent(port->tty, info->timeout); |
2680 | spin_lock_irqsave(&card->card_lock, flags); | 1774 | spin_lock_irqsave(&card->card_lock, flags); |
2681 | } | 1775 | } |
2682 | } else { | 1776 | } else { |
2683 | #ifdef Z_WAKE | 1777 | #ifdef Z_WAKE |
2684 | /* Waiting for on-board buffers to be empty before closing | 1778 | /* Waiting for on-board buffers to be empty before closing |
2685 | the port */ | 1779 | the port */ |
2686 | void __iomem *base_addr = card->base_addr; | 1780 | struct CH_CTRL __iomem *ch_ctrl = info->u.cyz.ch_ctrl; |
2687 | struct FIRM_ID __iomem *firm_id = base_addr + ID_ADDRESS; | ||
2688 | struct ZFW_CTRL __iomem *zfw_ctrl = | ||
2689 | base_addr + (readl(&firm_id->zfwctrl_addr) & 0xfffff); | ||
2690 | struct CH_CTRL __iomem *ch_ctrl = zfw_ctrl->ch_ctrl; | ||
2691 | int channel = info->line - card->first_line; | ||
2692 | int retval; | 1781 | int retval; |
2693 | 1782 | ||
2694 | if (readl(&ch_ctrl[channel].flow_status) != C_FS_TXIDLE) { | 1783 | if (readl(&ch_ctrl->flow_status) != C_FS_TXIDLE) { |
2695 | retval = cyz_issue_cmd(card, channel, C_CM_IOCTLW, 0L); | 1784 | retval = cyz_issue_cmd(card, channel, C_CM_IOCTLW, 0L); |
2696 | if (retval != 0) { | 1785 | if (retval != 0) { |
2697 | printk(KERN_DEBUG "cyc:cy_close retval on " | 1786 | printk(KERN_DEBUG "cyc:cy_close retval on " |
@@ -2703,32 +1792,19 @@ static void cy_close(struct tty_struct *tty, struct file *filp) | |||
2703 | } | 1792 | } |
2704 | #endif | 1793 | #endif |
2705 | } | 1794 | } |
2706 | |||
2707 | spin_unlock_irqrestore(&card->card_lock, flags); | 1795 | spin_unlock_irqrestore(&card->card_lock, flags); |
2708 | shutdown(info); | 1796 | cy_shutdown(info, port->tty); |
2709 | cy_flush_buffer(tty); | 1797 | } |
2710 | tty_ldisc_flush(tty); | ||
2711 | spin_lock_irqsave(&card->card_lock, flags); | ||
2712 | |||
2713 | tty->closing = 0; | ||
2714 | info->port.tty = NULL; | ||
2715 | if (info->port.blocked_open) { | ||
2716 | spin_unlock_irqrestore(&card->card_lock, flags); | ||
2717 | if (info->port.close_delay) { | ||
2718 | msleep_interruptible(jiffies_to_msecs | ||
2719 | (info->port.close_delay)); | ||
2720 | } | ||
2721 | wake_up_interruptible(&info->port.open_wait); | ||
2722 | spin_lock_irqsave(&card->card_lock, flags); | ||
2723 | } | ||
2724 | info->port.flags &= ~(ASYNC_NORMAL_ACTIVE | ASYNC_CLOSING); | ||
2725 | wake_up_interruptible(&info->port.close_wait); | ||
2726 | |||
2727 | #ifdef CY_DEBUG_OTHER | ||
2728 | printk(KERN_DEBUG "cyc:cy_close done\n"); | ||
2729 | #endif | ||
2730 | 1798 | ||
2731 | spin_unlock_irqrestore(&card->card_lock, flags); | 1799 | /* |
1800 | * This routine is called when a particular tty device is closed. | ||
1801 | */ | ||
1802 | static void cy_close(struct tty_struct *tty, struct file *filp) | ||
1803 | { | ||
1804 | struct cyclades_port *info = tty->driver_data; | ||
1805 | if (!info || serial_paranoia_check(info, tty->name, "cy_close")) | ||
1806 | return; | ||
1807 | tty_port_close(&info->port, tty, filp); | ||
2732 | } /* cy_close */ | 1808 | } /* cy_close */ |
2733 | 1809 | ||
2734 | /* This routine gets called when tty_write has put something into | 1810 | /* This routine gets called when tty_write has put something into |
@@ -2871,18 +1947,13 @@ static int cy_write_room(struct tty_struct *tty) | |||
2871 | 1947 | ||
2872 | static int cy_chars_in_buffer(struct tty_struct *tty) | 1948 | static int cy_chars_in_buffer(struct tty_struct *tty) |
2873 | { | 1949 | { |
2874 | struct cyclades_card *card; | ||
2875 | struct cyclades_port *info = tty->driver_data; | 1950 | struct cyclades_port *info = tty->driver_data; |
2876 | int channel; | ||
2877 | 1951 | ||
2878 | if (serial_paranoia_check(info, tty->name, "cy_chars_in_buffer")) | 1952 | if (serial_paranoia_check(info, tty->name, "cy_chars_in_buffer")) |
2879 | return 0; | 1953 | return 0; |
2880 | 1954 | ||
2881 | card = info->card; | ||
2882 | channel = (info->line) - (card->first_line); | ||
2883 | |||
2884 | #ifdef Z_EXT_CHARS_IN_BUFFER | 1955 | #ifdef Z_EXT_CHARS_IN_BUFFER |
2885 | if (!cy_is_Z(card)) { | 1956 | if (!cy_is_Z(info->card)) { |
2886 | #endif /* Z_EXT_CHARS_IN_BUFFER */ | 1957 | #endif /* Z_EXT_CHARS_IN_BUFFER */ |
2887 | #ifdef CY_DEBUG_IO | 1958 | #ifdef CY_DEBUG_IO |
2888 | printk(KERN_DEBUG "cyc:cy_chars_in_buffer ttyC%d %d\n", | 1959 | printk(KERN_DEBUG "cyc:cy_chars_in_buffer ttyC%d %d\n", |
@@ -2891,20 +1962,11 @@ static int cy_chars_in_buffer(struct tty_struct *tty) | |||
2891 | return info->xmit_cnt; | 1962 | return info->xmit_cnt; |
2892 | #ifdef Z_EXT_CHARS_IN_BUFFER | 1963 | #ifdef Z_EXT_CHARS_IN_BUFFER |
2893 | } else { | 1964 | } else { |
2894 | static struct FIRM_ID *firm_id; | 1965 | struct BUF_CTRL __iomem *buf_ctrl = info->u.cyz.buf_ctrl; |
2895 | static struct ZFW_CTRL *zfw_ctrl; | ||
2896 | static struct CH_CTRL *ch_ctrl; | ||
2897 | static struct BUF_CTRL *buf_ctrl; | ||
2898 | int char_count; | 1966 | int char_count; |
2899 | __u32 tx_put, tx_get, tx_bufsize; | 1967 | __u32 tx_put, tx_get, tx_bufsize; |
2900 | 1968 | ||
2901 | lock_kernel(); | 1969 | lock_kernel(); |
2902 | firm_id = card->base_addr + ID_ADDRESS; | ||
2903 | zfw_ctrl = card->base_addr + | ||
2904 | (readl(&firm_id->zfwctrl_addr) & 0xfffff); | ||
2905 | ch_ctrl = &(zfw_ctrl->ch_ctrl[channel]); | ||
2906 | buf_ctrl = &(zfw_ctrl->buf_ctrl[channel]); | ||
2907 | |||
2908 | tx_get = readl(&buf_ctrl->tx_get); | 1970 | tx_get = readl(&buf_ctrl->tx_get); |
2909 | tx_put = readl(&buf_ctrl->tx_put); | 1971 | tx_put = readl(&buf_ctrl->tx_put); |
2910 | tx_bufsize = readl(&buf_ctrl->tx_bufsize); | 1972 | tx_bufsize = readl(&buf_ctrl->tx_bufsize); |
@@ -2957,48 +2019,44 @@ static void cyy_baud_calc(struct cyclades_port *info, __u32 baud) | |||
2957 | * This routine finds or computes the various line characteristics. | 2019 | * This routine finds or computes the various line characteristics. |
2958 | * It used to be called config_setup | 2020 | * It used to be called config_setup |
2959 | */ | 2021 | */ |
2960 | static void set_line_char(struct cyclades_port *info) | 2022 | static void cy_set_line_char(struct cyclades_port *info, struct tty_struct *tty) |
2961 | { | 2023 | { |
2962 | struct cyclades_card *card; | 2024 | struct cyclades_card *card; |
2963 | unsigned long flags; | 2025 | unsigned long flags; |
2964 | void __iomem *base_addr; | 2026 | int channel; |
2965 | int chip, channel, index; | ||
2966 | unsigned cflag, iflag; | 2027 | unsigned cflag, iflag; |
2967 | int baud, baud_rate = 0; | 2028 | int baud, baud_rate = 0; |
2968 | int i; | 2029 | int i; |
2969 | 2030 | ||
2970 | if (!info->port.tty || !info->port.tty->termios) | 2031 | if (!tty->termios) /* XXX can this happen at all? */ |
2971 | return; | 2032 | return; |
2972 | 2033 | ||
2973 | if (info->line == -1) | 2034 | if (info->line == -1) |
2974 | return; | 2035 | return; |
2975 | 2036 | ||
2976 | cflag = info->port.tty->termios->c_cflag; | 2037 | cflag = tty->termios->c_cflag; |
2977 | iflag = info->port.tty->termios->c_iflag; | 2038 | iflag = tty->termios->c_iflag; |
2978 | 2039 | ||
2979 | /* | 2040 | /* |
2980 | * Set up the tty->alt_speed kludge | 2041 | * Set up the tty->alt_speed kludge |
2981 | */ | 2042 | */ |
2982 | if (info->port.tty) { | 2043 | if ((info->port.flags & ASYNC_SPD_MASK) == ASYNC_SPD_HI) |
2983 | if ((info->port.flags & ASYNC_SPD_MASK) == ASYNC_SPD_HI) | 2044 | tty->alt_speed = 57600; |
2984 | info->port.tty->alt_speed = 57600; | 2045 | if ((info->port.flags & ASYNC_SPD_MASK) == ASYNC_SPD_VHI) |
2985 | if ((info->port.flags & ASYNC_SPD_MASK) == ASYNC_SPD_VHI) | 2046 | tty->alt_speed = 115200; |
2986 | info->port.tty->alt_speed = 115200; | 2047 | if ((info->port.flags & ASYNC_SPD_MASK) == ASYNC_SPD_SHI) |
2987 | if ((info->port.flags & ASYNC_SPD_MASK) == ASYNC_SPD_SHI) | 2048 | tty->alt_speed = 230400; |
2988 | info->port.tty->alt_speed = 230400; | 2049 | if ((info->port.flags & ASYNC_SPD_MASK) == ASYNC_SPD_WARP) |
2989 | if ((info->port.flags & ASYNC_SPD_MASK) == ASYNC_SPD_WARP) | 2050 | tty->alt_speed = 460800; |
2990 | info->port.tty->alt_speed = 460800; | ||
2991 | } | ||
2992 | 2051 | ||
2993 | card = info->card; | 2052 | card = info->card; |
2994 | channel = info->line - card->first_line; | 2053 | channel = info->line - card->first_line; |
2995 | 2054 | ||
2996 | if (!cy_is_Z(card)) { | 2055 | if (!cy_is_Z(card)) { |
2997 | 2056 | u32 cflags; | |
2998 | index = card->bus_index; | ||
2999 | 2057 | ||
3000 | /* baud rate */ | 2058 | /* baud rate */ |
3001 | baud = tty_get_baud_rate(info->port.tty); | 2059 | baud = tty_get_baud_rate(tty); |
3002 | if (baud == 38400 && (info->port.flags & ASYNC_SPD_MASK) == | 2060 | if (baud == 38400 && (info->port.flags & ASYNC_SPD_MASK) == |
3003 | ASYNC_SPD_CUST) { | 2061 | ASYNC_SPD_CUST) { |
3004 | if (info->custom_divisor) | 2062 | if (info->custom_divisor) |
@@ -3107,124 +2165,68 @@ static void set_line_char(struct cyclades_port *info) | |||
3107 | cable. Contact Marcio Saito for details. | 2165 | cable. Contact Marcio Saito for details. |
3108 | ***********************************************/ | 2166 | ***********************************************/ |
3109 | 2167 | ||
3110 | chip = channel >> 2; | ||
3111 | channel &= 0x03; | 2168 | channel &= 0x03; |
3112 | base_addr = card->base_addr + (cy_chip_offset[chip] << index); | ||
3113 | 2169 | ||
3114 | spin_lock_irqsave(&card->card_lock, flags); | 2170 | spin_lock_irqsave(&card->card_lock, flags); |
3115 | cy_writeb(base_addr + (CyCAR << index), (u_char) channel); | 2171 | cyy_writeb(info, CyCAR, channel); |
3116 | 2172 | ||
3117 | /* tx and rx baud rate */ | 2173 | /* tx and rx baud rate */ |
3118 | 2174 | ||
3119 | cy_writeb(base_addr + (CyTCOR << index), info->tco); | 2175 | cyy_writeb(info, CyTCOR, info->tco); |
3120 | cy_writeb(base_addr + (CyTBPR << index), info->tbpr); | 2176 | cyy_writeb(info, CyTBPR, info->tbpr); |
3121 | cy_writeb(base_addr + (CyRCOR << index), info->rco); | 2177 | cyy_writeb(info, CyRCOR, info->rco); |
3122 | cy_writeb(base_addr + (CyRBPR << index), info->rbpr); | 2178 | cyy_writeb(info, CyRBPR, info->rbpr); |
3123 | 2179 | ||
3124 | /* set line characteristics according configuration */ | 2180 | /* set line characteristics according configuration */ |
3125 | 2181 | ||
3126 | cy_writeb(base_addr + (CySCHR1 << index), | 2182 | cyy_writeb(info, CySCHR1, START_CHAR(tty)); |
3127 | START_CHAR(info->port.tty)); | 2183 | cyy_writeb(info, CySCHR2, STOP_CHAR(tty)); |
3128 | cy_writeb(base_addr + (CySCHR2 << index), STOP_CHAR(info->port.tty)); | 2184 | cyy_writeb(info, CyCOR1, info->cor1); |
3129 | cy_writeb(base_addr + (CyCOR1 << index), info->cor1); | 2185 | cyy_writeb(info, CyCOR2, info->cor2); |
3130 | cy_writeb(base_addr + (CyCOR2 << index), info->cor2); | 2186 | cyy_writeb(info, CyCOR3, info->cor3); |
3131 | cy_writeb(base_addr + (CyCOR3 << index), info->cor3); | 2187 | cyy_writeb(info, CyCOR4, info->cor4); |
3132 | cy_writeb(base_addr + (CyCOR4 << index), info->cor4); | 2188 | cyy_writeb(info, CyCOR5, info->cor5); |
3133 | cy_writeb(base_addr + (CyCOR5 << index), info->cor5); | ||
3134 | 2189 | ||
3135 | cyy_issue_cmd(base_addr, CyCOR_CHANGE | CyCOR1ch | CyCOR2ch | | 2190 | cyy_issue_cmd(info, CyCOR_CHANGE | CyCOR1ch | CyCOR2ch | |
3136 | CyCOR3ch, index); | 2191 | CyCOR3ch); |
3137 | 2192 | ||
3138 | /* !!! Is this needed? */ | 2193 | /* !!! Is this needed? */ |
3139 | cy_writeb(base_addr + (CyCAR << index), (u_char) channel); | 2194 | cyy_writeb(info, CyCAR, channel); |
3140 | cy_writeb(base_addr + (CyRTPR << index), | 2195 | cyy_writeb(info, CyRTPR, |
3141 | (info->default_timeout ? info->default_timeout : 0x02)); | 2196 | (info->default_timeout ? info->default_timeout : 0x02)); |
3142 | /* 10ms rx timeout */ | 2197 | /* 10ms rx timeout */ |
3143 | 2198 | ||
3144 | if (C_CLOCAL(info->port.tty)) { | 2199 | cflags = CyCTS; |
3145 | /* without modem intr */ | 2200 | if (!C_CLOCAL(tty)) |
3146 | cy_writeb(base_addr + (CySRER << index), | 2201 | cflags |= CyDSR | CyRI | CyDCD; |
3147 | readb(base_addr + (CySRER << index)) | CyMdmCh); | 2202 | /* without modem intr */ |
3148 | /* act on 1->0 modem transitions */ | 2203 | cyy_writeb(info, CySRER, cyy_readb(info, CySRER) | CyMdmCh); |
3149 | if ((cflag & CRTSCTS) && info->rflow) { | 2204 | /* act on 1->0 modem transitions */ |
3150 | cy_writeb(base_addr + (CyMCOR1 << index), | 2205 | if ((cflag & CRTSCTS) && info->rflow) |
3151 | (CyCTS | rflow_thr[i])); | 2206 | cyy_writeb(info, CyMCOR1, cflags | rflow_thr[i]); |
3152 | } else { | 2207 | else |
3153 | cy_writeb(base_addr + (CyMCOR1 << index), | 2208 | cyy_writeb(info, CyMCOR1, cflags); |
3154 | CyCTS); | 2209 | /* act on 0->1 modem transitions */ |
3155 | } | 2210 | cyy_writeb(info, CyMCOR2, cflags); |
3156 | /* act on 0->1 modem transitions */ | ||
3157 | cy_writeb(base_addr + (CyMCOR2 << index), CyCTS); | ||
3158 | } else { | ||
3159 | /* without modem intr */ | ||
3160 | cy_writeb(base_addr + (CySRER << index), | ||
3161 | readb(base_addr + | ||
3162 | (CySRER << index)) | CyMdmCh); | ||
3163 | /* act on 1->0 modem transitions */ | ||
3164 | if ((cflag & CRTSCTS) && info->rflow) { | ||
3165 | cy_writeb(base_addr + (CyMCOR1 << index), | ||
3166 | (CyDSR | CyCTS | CyRI | CyDCD | | ||
3167 | rflow_thr[i])); | ||
3168 | } else { | ||
3169 | cy_writeb(base_addr + (CyMCOR1 << index), | ||
3170 | CyDSR | CyCTS | CyRI | CyDCD); | ||
3171 | } | ||
3172 | /* act on 0->1 modem transitions */ | ||
3173 | cy_writeb(base_addr + (CyMCOR2 << index), | ||
3174 | CyDSR | CyCTS | CyRI | CyDCD); | ||
3175 | } | ||
3176 | 2211 | ||
3177 | if (i == 0) { /* baud rate is zero, turn off line */ | 2212 | if (i == 0) /* baud rate is zero, turn off line */ |
3178 | if (info->rtsdtr_inv) { | 2213 | cyy_change_rts_dtr(info, 0, TIOCM_DTR); |
3179 | cy_writeb(base_addr + (CyMSVR1 << index), | 2214 | else |
3180 | ~CyRTS); | 2215 | cyy_change_rts_dtr(info, TIOCM_DTR, 0); |
3181 | } else { | ||
3182 | cy_writeb(base_addr + (CyMSVR2 << index), | ||
3183 | ~CyDTR); | ||
3184 | } | ||
3185 | #ifdef CY_DEBUG_DTR | ||
3186 | printk(KERN_DEBUG "cyc:set_line_char dropping DTR\n"); | ||
3187 | printk(KERN_DEBUG " status: 0x%x, 0x%x\n", | ||
3188 | readb(base_addr + (CyMSVR1 << index)), | ||
3189 | readb(base_addr + (CyMSVR2 << index))); | ||
3190 | #endif | ||
3191 | } else { | ||
3192 | if (info->rtsdtr_inv) { | ||
3193 | cy_writeb(base_addr + (CyMSVR1 << index), | ||
3194 | CyRTS); | ||
3195 | } else { | ||
3196 | cy_writeb(base_addr + (CyMSVR2 << index), | ||
3197 | CyDTR); | ||
3198 | } | ||
3199 | #ifdef CY_DEBUG_DTR | ||
3200 | printk(KERN_DEBUG "cyc:set_line_char raising DTR\n"); | ||
3201 | printk(KERN_DEBUG " status: 0x%x, 0x%x\n", | ||
3202 | readb(base_addr + (CyMSVR1 << index)), | ||
3203 | readb(base_addr + (CyMSVR2 << index))); | ||
3204 | #endif | ||
3205 | } | ||
3206 | 2216 | ||
3207 | if (info->port.tty) | 2217 | clear_bit(TTY_IO_ERROR, &tty->flags); |
3208 | clear_bit(TTY_IO_ERROR, &info->port.tty->flags); | ||
3209 | spin_unlock_irqrestore(&card->card_lock, flags); | 2218 | spin_unlock_irqrestore(&card->card_lock, flags); |
3210 | 2219 | ||
3211 | } else { | 2220 | } else { |
3212 | struct FIRM_ID __iomem *firm_id; | 2221 | struct CH_CTRL __iomem *ch_ctrl = info->u.cyz.ch_ctrl; |
3213 | struct ZFW_CTRL __iomem *zfw_ctrl; | ||
3214 | struct CH_CTRL __iomem *ch_ctrl; | ||
3215 | __u32 sw_flow; | 2222 | __u32 sw_flow; |
3216 | int retval; | 2223 | int retval; |
3217 | 2224 | ||
3218 | firm_id = card->base_addr + ID_ADDRESS; | ||
3219 | if (!cyz_is_loaded(card)) | 2225 | if (!cyz_is_loaded(card)) |
3220 | return; | 2226 | return; |
3221 | 2227 | ||
3222 | zfw_ctrl = card->base_addr + | ||
3223 | (readl(&firm_id->zfwctrl_addr) & 0xfffff); | ||
3224 | ch_ctrl = &(zfw_ctrl->ch_ctrl[channel]); | ||
3225 | |||
3226 | /* baud rate */ | 2228 | /* baud rate */ |
3227 | baud = tty_get_baud_rate(info->port.tty); | 2229 | baud = tty_get_baud_rate(tty); |
3228 | if (baud == 38400 && (info->port.flags & ASYNC_SPD_MASK) == | 2230 | if (baud == 38400 && (info->port.flags & ASYNC_SPD_MASK) == |
3229 | ASYNC_SPD_CUST) { | 2231 | ASYNC_SPD_CUST) { |
3230 | if (info->custom_divisor) | 2232 | if (info->custom_divisor) |
@@ -3335,45 +2337,38 @@ static void set_line_char(struct cyclades_port *info) | |||
3335 | "was %x\n", info->line, retval); | 2337 | "was %x\n", info->line, retval); |
3336 | } | 2338 | } |
3337 | 2339 | ||
3338 | if (info->port.tty) | 2340 | clear_bit(TTY_IO_ERROR, &tty->flags); |
3339 | clear_bit(TTY_IO_ERROR, &info->port.tty->flags); | ||
3340 | } | 2341 | } |
3341 | } /* set_line_char */ | 2342 | } /* set_line_char */ |
3342 | 2343 | ||
3343 | static int | 2344 | static int cy_get_serial_info(struct cyclades_port *info, |
3344 | get_serial_info(struct cyclades_port *info, | ||
3345 | struct serial_struct __user *retinfo) | 2345 | struct serial_struct __user *retinfo) |
3346 | { | 2346 | { |
3347 | struct serial_struct tmp; | ||
3348 | struct cyclades_card *cinfo = info->card; | 2347 | struct cyclades_card *cinfo = info->card; |
3349 | 2348 | struct serial_struct tmp = { | |
3350 | if (!retinfo) | 2349 | .type = info->type, |
3351 | return -EFAULT; | 2350 | .line = info->line, |
3352 | memset(&tmp, 0, sizeof(tmp)); | 2351 | .port = (info->card - cy_card) * 0x100 + info->line - |
3353 | tmp.type = info->type; | 2352 | cinfo->first_line, |
3354 | tmp.line = info->line; | 2353 | .irq = cinfo->irq, |
3355 | tmp.port = (info->card - cy_card) * 0x100 + info->line - | 2354 | .flags = info->port.flags, |
3356 | cinfo->first_line; | 2355 | .close_delay = info->port.close_delay, |
3357 | tmp.irq = cinfo->irq; | 2356 | .closing_wait = info->port.closing_wait, |
3358 | tmp.flags = info->port.flags; | 2357 | .baud_base = info->baud, |
3359 | tmp.close_delay = info->port.close_delay; | 2358 | .custom_divisor = info->custom_divisor, |
3360 | tmp.closing_wait = info->port.closing_wait; | 2359 | .hub6 = 0, /*!!! */ |
3361 | tmp.baud_base = info->baud; | 2360 | }; |
3362 | tmp.custom_divisor = info->custom_divisor; | ||
3363 | tmp.hub6 = 0; /*!!! */ | ||
3364 | return copy_to_user(retinfo, &tmp, sizeof(*retinfo)) ? -EFAULT : 0; | 2361 | return copy_to_user(retinfo, &tmp, sizeof(*retinfo)) ? -EFAULT : 0; |
3365 | } /* get_serial_info */ | 2362 | } |
3366 | 2363 | ||
3367 | static int | 2364 | static int |
3368 | set_serial_info(struct cyclades_port *info, | 2365 | cy_set_serial_info(struct cyclades_port *info, struct tty_struct *tty, |
3369 | struct serial_struct __user *new_info) | 2366 | struct serial_struct __user *new_info) |
3370 | { | 2367 | { |
3371 | struct serial_struct new_serial; | 2368 | struct serial_struct new_serial; |
3372 | struct cyclades_port old_info; | ||
3373 | 2369 | ||
3374 | if (copy_from_user(&new_serial, new_info, sizeof(new_serial))) | 2370 | if (copy_from_user(&new_serial, new_info, sizeof(new_serial))) |
3375 | return -EFAULT; | 2371 | return -EFAULT; |
3376 | old_info = *info; | ||
3377 | 2372 | ||
3378 | if (!capable(CAP_SYS_ADMIN)) { | 2373 | if (!capable(CAP_SYS_ADMIN)) { |
3379 | if (new_serial.close_delay != info->port.close_delay || | 2374 | if (new_serial.close_delay != info->port.close_delay || |
@@ -3403,10 +2398,10 @@ set_serial_info(struct cyclades_port *info, | |||
3403 | 2398 | ||
3404 | check_and_exit: | 2399 | check_and_exit: |
3405 | if (info->port.flags & ASYNC_INITIALIZED) { | 2400 | if (info->port.flags & ASYNC_INITIALIZED) { |
3406 | set_line_char(info); | 2401 | cy_set_line_char(info, tty); |
3407 | return 0; | 2402 | return 0; |
3408 | } else { | 2403 | } else { |
3409 | return startup(info); | 2404 | return cy_startup(info, tty); |
3410 | } | 2405 | } |
3411 | } /* set_serial_info */ | 2406 | } /* set_serial_info */ |
3412 | 2407 | ||
@@ -3422,24 +2417,14 @@ check_and_exit: | |||
3422 | */ | 2417 | */ |
3423 | static int get_lsr_info(struct cyclades_port *info, unsigned int __user *value) | 2418 | static int get_lsr_info(struct cyclades_port *info, unsigned int __user *value) |
3424 | { | 2419 | { |
3425 | struct cyclades_card *card; | 2420 | struct cyclades_card *card = info->card; |
3426 | int chip, channel, index; | ||
3427 | unsigned char status; | ||
3428 | unsigned int result; | 2421 | unsigned int result; |
3429 | unsigned long flags; | 2422 | unsigned long flags; |
3430 | void __iomem *base_addr; | 2423 | u8 status; |
3431 | 2424 | ||
3432 | card = info->card; | ||
3433 | channel = (info->line) - (card->first_line); | ||
3434 | if (!cy_is_Z(card)) { | 2425 | if (!cy_is_Z(card)) { |
3435 | chip = channel >> 2; | ||
3436 | channel &= 0x03; | ||
3437 | index = card->bus_index; | ||
3438 | base_addr = card->base_addr + (cy_chip_offset[chip] << index); | ||
3439 | |||
3440 | spin_lock_irqsave(&card->card_lock, flags); | 2426 | spin_lock_irqsave(&card->card_lock, flags); |
3441 | status = readb(base_addr + (CySRER << index)) & | 2427 | status = cyy_readb(info, CySRER) & (CyTxRdy | CyTxMpty); |
3442 | (CyTxRdy | CyTxMpty); | ||
3443 | spin_unlock_irqrestore(&card->card_lock, flags); | 2428 | spin_unlock_irqrestore(&card->card_lock, flags); |
3444 | result = (status ? 0 : TIOCSER_TEMT); | 2429 | result = (status ? 0 : TIOCSER_TEMT); |
3445 | } else { | 2430 | } else { |
@@ -3453,34 +2438,23 @@ static int cy_tiocmget(struct tty_struct *tty, struct file *file) | |||
3453 | { | 2438 | { |
3454 | struct cyclades_port *info = tty->driver_data; | 2439 | struct cyclades_port *info = tty->driver_data; |
3455 | struct cyclades_card *card; | 2440 | struct cyclades_card *card; |
3456 | int chip, channel, index; | 2441 | int result; |
3457 | void __iomem *base_addr; | ||
3458 | unsigned long flags; | ||
3459 | unsigned char status; | ||
3460 | unsigned long lstatus; | ||
3461 | unsigned int result; | ||
3462 | struct FIRM_ID __iomem *firm_id; | ||
3463 | struct ZFW_CTRL __iomem *zfw_ctrl; | ||
3464 | struct BOARD_CTRL __iomem *board_ctrl; | ||
3465 | struct CH_CTRL __iomem *ch_ctrl; | ||
3466 | 2442 | ||
3467 | if (serial_paranoia_check(info, tty->name, __func__)) | 2443 | if (serial_paranoia_check(info, tty->name, __func__)) |
3468 | return -ENODEV; | 2444 | return -ENODEV; |
3469 | 2445 | ||
3470 | lock_kernel(); | ||
3471 | |||
3472 | card = info->card; | 2446 | card = info->card; |
3473 | channel = info->line - card->first_line; | 2447 | |
2448 | lock_kernel(); | ||
3474 | if (!cy_is_Z(card)) { | 2449 | if (!cy_is_Z(card)) { |
3475 | chip = channel >> 2; | 2450 | unsigned long flags; |
3476 | channel &= 0x03; | 2451 | int channel = info->line - card->first_line; |
3477 | index = card->bus_index; | 2452 | u8 status; |
3478 | base_addr = card->base_addr + (cy_chip_offset[chip] << index); | ||
3479 | 2453 | ||
3480 | spin_lock_irqsave(&card->card_lock, flags); | 2454 | spin_lock_irqsave(&card->card_lock, flags); |
3481 | cy_writeb(base_addr + (CyCAR << index), (u_char) channel); | 2455 | cyy_writeb(info, CyCAR, channel & 0x03); |
3482 | status = readb(base_addr + (CyMSVR1 << index)); | 2456 | status = cyy_readb(info, CyMSVR1); |
3483 | status |= readb(base_addr + (CyMSVR2 << index)); | 2457 | status |= cyy_readb(info, CyMSVR2); |
3484 | spin_unlock_irqrestore(&card->card_lock, flags); | 2458 | spin_unlock_irqrestore(&card->card_lock, flags); |
3485 | 2459 | ||
3486 | if (info->rtsdtr_inv) { | 2460 | if (info->rtsdtr_inv) { |
@@ -3495,27 +2469,22 @@ static int cy_tiocmget(struct tty_struct *tty, struct file *file) | |||
3495 | ((status & CyDSR) ? TIOCM_DSR : 0) | | 2469 | ((status & CyDSR) ? TIOCM_DSR : 0) | |
3496 | ((status & CyCTS) ? TIOCM_CTS : 0); | 2470 | ((status & CyCTS) ? TIOCM_CTS : 0); |
3497 | } else { | 2471 | } else { |
3498 | base_addr = card->base_addr; | 2472 | u32 lstatus; |
3499 | firm_id = card->base_addr + ID_ADDRESS; | 2473 | |
3500 | if (cyz_is_loaded(card)) { | 2474 | if (!cyz_is_loaded(card)) { |
3501 | zfw_ctrl = card->base_addr + | 2475 | result = -ENODEV; |
3502 | (readl(&firm_id->zfwctrl_addr) & 0xfffff); | 2476 | goto end; |
3503 | board_ctrl = &zfw_ctrl->board_ctrl; | ||
3504 | ch_ctrl = zfw_ctrl->ch_ctrl; | ||
3505 | lstatus = readl(&ch_ctrl[channel].rs_status); | ||
3506 | result = ((lstatus & C_RS_RTS) ? TIOCM_RTS : 0) | | ||
3507 | ((lstatus & C_RS_DTR) ? TIOCM_DTR : 0) | | ||
3508 | ((lstatus & C_RS_DCD) ? TIOCM_CAR : 0) | | ||
3509 | ((lstatus & C_RS_RI) ? TIOCM_RNG : 0) | | ||
3510 | ((lstatus & C_RS_DSR) ? TIOCM_DSR : 0) | | ||
3511 | ((lstatus & C_RS_CTS) ? TIOCM_CTS : 0); | ||
3512 | } else { | ||
3513 | result = 0; | ||
3514 | unlock_kernel(); | ||
3515 | return -ENODEV; | ||
3516 | } | 2477 | } |
3517 | 2478 | ||
2479 | lstatus = readl(&info->u.cyz.ch_ctrl->rs_status); | ||
2480 | result = ((lstatus & C_RS_RTS) ? TIOCM_RTS : 0) | | ||
2481 | ((lstatus & C_RS_DTR) ? TIOCM_DTR : 0) | | ||
2482 | ((lstatus & C_RS_DCD) ? TIOCM_CAR : 0) | | ||
2483 | ((lstatus & C_RS_RI) ? TIOCM_RNG : 0) | | ||
2484 | ((lstatus & C_RS_DSR) ? TIOCM_DSR : 0) | | ||
2485 | ((lstatus & C_RS_CTS) ? TIOCM_CTS : 0); | ||
3518 | } | 2486 | } |
2487 | end: | ||
3519 | unlock_kernel(); | 2488 | unlock_kernel(); |
3520 | return result; | 2489 | return result; |
3521 | } /* cy_tiomget */ | 2490 | } /* cy_tiomget */ |
@@ -3526,150 +2495,53 @@ cy_tiocmset(struct tty_struct *tty, struct file *file, | |||
3526 | { | 2495 | { |
3527 | struct cyclades_port *info = tty->driver_data; | 2496 | struct cyclades_port *info = tty->driver_data; |
3528 | struct cyclades_card *card; | 2497 | struct cyclades_card *card; |
3529 | int chip, channel, index; | ||
3530 | void __iomem *base_addr; | ||
3531 | unsigned long flags; | 2498 | unsigned long flags; |
3532 | struct FIRM_ID __iomem *firm_id; | ||
3533 | struct ZFW_CTRL __iomem *zfw_ctrl; | ||
3534 | struct BOARD_CTRL __iomem *board_ctrl; | ||
3535 | struct CH_CTRL __iomem *ch_ctrl; | ||
3536 | int retval; | ||
3537 | 2499 | ||
3538 | if (serial_paranoia_check(info, tty->name, __func__)) | 2500 | if (serial_paranoia_check(info, tty->name, __func__)) |
3539 | return -ENODEV; | 2501 | return -ENODEV; |
3540 | 2502 | ||
3541 | card = info->card; | 2503 | card = info->card; |
3542 | channel = (info->line) - (card->first_line); | ||
3543 | if (!cy_is_Z(card)) { | 2504 | if (!cy_is_Z(card)) { |
3544 | chip = channel >> 2; | 2505 | spin_lock_irqsave(&card->card_lock, flags); |
3545 | channel &= 0x03; | 2506 | cyy_change_rts_dtr(info, set, clear); |
3546 | index = card->bus_index; | 2507 | spin_unlock_irqrestore(&card->card_lock, flags); |
3547 | base_addr = card->base_addr + (cy_chip_offset[chip] << index); | 2508 | } else { |
2509 | struct CH_CTRL __iomem *ch_ctrl = info->u.cyz.ch_ctrl; | ||
2510 | int retval, channel = info->line - card->first_line; | ||
2511 | u32 rs; | ||
3548 | 2512 | ||
3549 | if (set & TIOCM_RTS) { | 2513 | if (!cyz_is_loaded(card)) |
3550 | spin_lock_irqsave(&card->card_lock, flags); | 2514 | return -ENODEV; |
3551 | cy_writeb(base_addr + (CyCAR << index), | 2515 | |
3552 | (u_char) channel); | 2516 | spin_lock_irqsave(&card->card_lock, flags); |
3553 | if (info->rtsdtr_inv) { | 2517 | rs = readl(&ch_ctrl->rs_control); |
3554 | cy_writeb(base_addr + (CyMSVR2 << index), | 2518 | if (set & TIOCM_RTS) |
3555 | CyDTR); | 2519 | rs |= C_RS_RTS; |
3556 | } else { | 2520 | if (clear & TIOCM_RTS) |
3557 | cy_writeb(base_addr + (CyMSVR1 << index), | 2521 | rs &= ~C_RS_RTS; |
3558 | CyRTS); | ||
3559 | } | ||
3560 | spin_unlock_irqrestore(&card->card_lock, flags); | ||
3561 | } | ||
3562 | if (clear & TIOCM_RTS) { | ||
3563 | spin_lock_irqsave(&card->card_lock, flags); | ||
3564 | cy_writeb(base_addr + (CyCAR << index), | ||
3565 | (u_char) channel); | ||
3566 | if (info->rtsdtr_inv) { | ||
3567 | cy_writeb(base_addr + (CyMSVR2 << index), | ||
3568 | ~CyDTR); | ||
3569 | } else { | ||
3570 | cy_writeb(base_addr + (CyMSVR1 << index), | ||
3571 | ~CyRTS); | ||
3572 | } | ||
3573 | spin_unlock_irqrestore(&card->card_lock, flags); | ||
3574 | } | ||
3575 | if (set & TIOCM_DTR) { | 2522 | if (set & TIOCM_DTR) { |
3576 | spin_lock_irqsave(&card->card_lock, flags); | 2523 | rs |= C_RS_DTR; |
3577 | cy_writeb(base_addr + (CyCAR << index), | ||
3578 | (u_char) channel); | ||
3579 | if (info->rtsdtr_inv) { | ||
3580 | cy_writeb(base_addr + (CyMSVR1 << index), | ||
3581 | CyRTS); | ||
3582 | } else { | ||
3583 | cy_writeb(base_addr + (CyMSVR2 << index), | ||
3584 | CyDTR); | ||
3585 | } | ||
3586 | #ifdef CY_DEBUG_DTR | 2524 | #ifdef CY_DEBUG_DTR |
3587 | printk(KERN_DEBUG "cyc:set_modem_info raising DTR\n"); | 2525 | printk(KERN_DEBUG "cyc:set_modem_info raising Z DTR\n"); |
3588 | printk(KERN_DEBUG " status: 0x%x, 0x%x\n", | ||
3589 | readb(base_addr + (CyMSVR1 << index)), | ||
3590 | readb(base_addr + (CyMSVR2 << index))); | ||
3591 | #endif | 2526 | #endif |
3592 | spin_unlock_irqrestore(&card->card_lock, flags); | ||
3593 | } | 2527 | } |
3594 | if (clear & TIOCM_DTR) { | 2528 | if (clear & TIOCM_DTR) { |
3595 | spin_lock_irqsave(&card->card_lock, flags); | 2529 | rs &= ~C_RS_DTR; |
3596 | cy_writeb(base_addr + (CyCAR << index), | ||
3597 | (u_char) channel); | ||
3598 | if (info->rtsdtr_inv) { | ||
3599 | cy_writeb(base_addr + (CyMSVR1 << index), | ||
3600 | ~CyRTS); | ||
3601 | } else { | ||
3602 | cy_writeb(base_addr + (CyMSVR2 << index), | ||
3603 | ~CyDTR); | ||
3604 | } | ||
3605 | |||
3606 | #ifdef CY_DEBUG_DTR | 2530 | #ifdef CY_DEBUG_DTR |
3607 | printk(KERN_DEBUG "cyc:set_modem_info dropping DTR\n"); | 2531 | printk(KERN_DEBUG "cyc:set_modem_info clearing " |
3608 | printk(KERN_DEBUG " status: 0x%x, 0x%x\n", | 2532 | "Z DTR\n"); |
3609 | readb(base_addr + (CyMSVR1 << index)), | ||
3610 | readb(base_addr + (CyMSVR2 << index))); | ||
3611 | #endif | 2533 | #endif |
3612 | spin_unlock_irqrestore(&card->card_lock, flags); | ||
3613 | } | 2534 | } |
3614 | } else { | 2535 | cy_writel(&ch_ctrl->rs_control, rs); |
3615 | base_addr = card->base_addr; | ||
3616 | |||
3617 | firm_id = card->base_addr + ID_ADDRESS; | ||
3618 | if (cyz_is_loaded(card)) { | ||
3619 | zfw_ctrl = card->base_addr + | ||
3620 | (readl(&firm_id->zfwctrl_addr) & 0xfffff); | ||
3621 | board_ctrl = &zfw_ctrl->board_ctrl; | ||
3622 | ch_ctrl = zfw_ctrl->ch_ctrl; | ||
3623 | |||
3624 | if (set & TIOCM_RTS) { | ||
3625 | spin_lock_irqsave(&card->card_lock, flags); | ||
3626 | cy_writel(&ch_ctrl[channel].rs_control, | ||
3627 | readl(&ch_ctrl[channel].rs_control) | | ||
3628 | C_RS_RTS); | ||
3629 | spin_unlock_irqrestore(&card->card_lock, flags); | ||
3630 | } | ||
3631 | if (clear & TIOCM_RTS) { | ||
3632 | spin_lock_irqsave(&card->card_lock, flags); | ||
3633 | cy_writel(&ch_ctrl[channel].rs_control, | ||
3634 | readl(&ch_ctrl[channel].rs_control) & | ||
3635 | ~C_RS_RTS); | ||
3636 | spin_unlock_irqrestore(&card->card_lock, flags); | ||
3637 | } | ||
3638 | if (set & TIOCM_DTR) { | ||
3639 | spin_lock_irqsave(&card->card_lock, flags); | ||
3640 | cy_writel(&ch_ctrl[channel].rs_control, | ||
3641 | readl(&ch_ctrl[channel].rs_control) | | ||
3642 | C_RS_DTR); | ||
3643 | #ifdef CY_DEBUG_DTR | ||
3644 | printk(KERN_DEBUG "cyc:set_modem_info raising " | ||
3645 | "Z DTR\n"); | ||
3646 | #endif | ||
3647 | spin_unlock_irqrestore(&card->card_lock, flags); | ||
3648 | } | ||
3649 | if (clear & TIOCM_DTR) { | ||
3650 | spin_lock_irqsave(&card->card_lock, flags); | ||
3651 | cy_writel(&ch_ctrl[channel].rs_control, | ||
3652 | readl(&ch_ctrl[channel].rs_control) & | ||
3653 | ~C_RS_DTR); | ||
3654 | #ifdef CY_DEBUG_DTR | ||
3655 | printk(KERN_DEBUG "cyc:set_modem_info clearing " | ||
3656 | "Z DTR\n"); | ||
3657 | #endif | ||
3658 | spin_unlock_irqrestore(&card->card_lock, flags); | ||
3659 | } | ||
3660 | } else { | ||
3661 | return -ENODEV; | ||
3662 | } | ||
3663 | spin_lock_irqsave(&card->card_lock, flags); | ||
3664 | retval = cyz_issue_cmd(card, channel, C_CM_IOCTLM, 0L); | 2536 | retval = cyz_issue_cmd(card, channel, C_CM_IOCTLM, 0L); |
2537 | spin_unlock_irqrestore(&card->card_lock, flags); | ||
3665 | if (retval != 0) { | 2538 | if (retval != 0) { |
3666 | printk(KERN_ERR "cyc:set_modem_info retval on ttyC%d " | 2539 | printk(KERN_ERR "cyc:set_modem_info retval on ttyC%d " |
3667 | "was %x\n", info->line, retval); | 2540 | "was %x\n", info->line, retval); |
3668 | } | 2541 | } |
3669 | spin_unlock_irqrestore(&card->card_lock, flags); | ||
3670 | } | 2542 | } |
3671 | return 0; | 2543 | return 0; |
3672 | } /* cy_tiocmset */ | 2544 | } |
3673 | 2545 | ||
3674 | /* | 2546 | /* |
3675 | * cy_break() --- routine which turns the break handling on or off | 2547 | * cy_break() --- routine which turns the break handling on or off |
@@ -3734,41 +2606,18 @@ static int cy_break(struct tty_struct *tty, int break_state) | |||
3734 | return retval; | 2606 | return retval; |
3735 | } /* cy_break */ | 2607 | } /* cy_break */ |
3736 | 2608 | ||
3737 | static int get_mon_info(struct cyclades_port *info, | ||
3738 | struct cyclades_monitor __user *mon) | ||
3739 | { | ||
3740 | |||
3741 | if (copy_to_user(mon, &info->mon, sizeof(struct cyclades_monitor))) | ||
3742 | return -EFAULT; | ||
3743 | info->mon.int_count = 0; | ||
3744 | info->mon.char_count = 0; | ||
3745 | info->mon.char_max = 0; | ||
3746 | info->mon.char_last = 0; | ||
3747 | return 0; | ||
3748 | } /* get_mon_info */ | ||
3749 | |||
3750 | static int set_threshold(struct cyclades_port *info, unsigned long value) | 2609 | static int set_threshold(struct cyclades_port *info, unsigned long value) |
3751 | { | 2610 | { |
3752 | struct cyclades_card *card; | 2611 | struct cyclades_card *card = info->card; |
3753 | void __iomem *base_addr; | ||
3754 | int channel, chip, index; | ||
3755 | unsigned long flags; | 2612 | unsigned long flags; |
3756 | 2613 | ||
3757 | card = info->card; | ||
3758 | channel = info->line - card->first_line; | ||
3759 | if (!cy_is_Z(card)) { | 2614 | if (!cy_is_Z(card)) { |
3760 | chip = channel >> 2; | ||
3761 | channel &= 0x03; | ||
3762 | index = card->bus_index; | ||
3763 | base_addr = | ||
3764 | card->base_addr + (cy_chip_offset[chip] << index); | ||
3765 | |||
3766 | info->cor3 &= ~CyREC_FIFO; | 2615 | info->cor3 &= ~CyREC_FIFO; |
3767 | info->cor3 |= value & CyREC_FIFO; | 2616 | info->cor3 |= value & CyREC_FIFO; |
3768 | 2617 | ||
3769 | spin_lock_irqsave(&card->card_lock, flags); | 2618 | spin_lock_irqsave(&card->card_lock, flags); |
3770 | cy_writeb(base_addr + (CyCOR3 << index), info->cor3); | 2619 | cyy_writeb(info, CyCOR3, info->cor3); |
3771 | cyy_issue_cmd(base_addr, CyCOR_CHANGE | CyCOR3ch, index); | 2620 | cyy_issue_cmd(info, CyCOR_CHANGE | CyCOR3ch); |
3772 | spin_unlock_irqrestore(&card->card_lock, flags); | 2621 | spin_unlock_irqrestore(&card->card_lock, flags); |
3773 | } | 2622 | } |
3774 | return 0; | 2623 | return 0; |
@@ -3777,55 +2626,23 @@ static int set_threshold(struct cyclades_port *info, unsigned long value) | |||
3777 | static int get_threshold(struct cyclades_port *info, | 2626 | static int get_threshold(struct cyclades_port *info, |
3778 | unsigned long __user *value) | 2627 | unsigned long __user *value) |
3779 | { | 2628 | { |
3780 | struct cyclades_card *card; | 2629 | struct cyclades_card *card = info->card; |
3781 | void __iomem *base_addr; | ||
3782 | int channel, chip, index; | ||
3783 | unsigned long tmp; | ||
3784 | 2630 | ||
3785 | card = info->card; | ||
3786 | channel = info->line - card->first_line; | ||
3787 | if (!cy_is_Z(card)) { | 2631 | if (!cy_is_Z(card)) { |
3788 | chip = channel >> 2; | 2632 | u8 tmp = cyy_readb(info, CyCOR3) & CyREC_FIFO; |
3789 | channel &= 0x03; | ||
3790 | index = card->bus_index; | ||
3791 | base_addr = card->base_addr + (cy_chip_offset[chip] << index); | ||
3792 | |||
3793 | tmp = readb(base_addr + (CyCOR3 << index)) & CyREC_FIFO; | ||
3794 | return put_user(tmp, value); | 2633 | return put_user(tmp, value); |
3795 | } | 2634 | } |
3796 | return 0; | 2635 | return 0; |
3797 | } /* get_threshold */ | 2636 | } /* get_threshold */ |
3798 | 2637 | ||
3799 | static int set_default_threshold(struct cyclades_port *info, | ||
3800 | unsigned long value) | ||
3801 | { | ||
3802 | info->default_threshold = value & 0x0f; | ||
3803 | return 0; | ||
3804 | } /* set_default_threshold */ | ||
3805 | |||
3806 | static int get_default_threshold(struct cyclades_port *info, | ||
3807 | unsigned long __user *value) | ||
3808 | { | ||
3809 | return put_user(info->default_threshold, value); | ||
3810 | } /* get_default_threshold */ | ||
3811 | |||
3812 | static int set_timeout(struct cyclades_port *info, unsigned long value) | 2638 | static int set_timeout(struct cyclades_port *info, unsigned long value) |
3813 | { | 2639 | { |
3814 | struct cyclades_card *card; | 2640 | struct cyclades_card *card = info->card; |
3815 | void __iomem *base_addr; | ||
3816 | int channel, chip, index; | ||
3817 | unsigned long flags; | 2641 | unsigned long flags; |
3818 | 2642 | ||
3819 | card = info->card; | ||
3820 | channel = info->line - card->first_line; | ||
3821 | if (!cy_is_Z(card)) { | 2643 | if (!cy_is_Z(card)) { |
3822 | chip = channel >> 2; | ||
3823 | channel &= 0x03; | ||
3824 | index = card->bus_index; | ||
3825 | base_addr = card->base_addr + (cy_chip_offset[chip] << index); | ||
3826 | |||
3827 | spin_lock_irqsave(&card->card_lock, flags); | 2644 | spin_lock_irqsave(&card->card_lock, flags); |
3828 | cy_writeb(base_addr + (CyRTPR << index), value & 0xff); | 2645 | cyy_writeb(info, CyRTPR, value & 0xff); |
3829 | spin_unlock_irqrestore(&card->card_lock, flags); | 2646 | spin_unlock_irqrestore(&card->card_lock, flags); |
3830 | } | 2647 | } |
3831 | return 0; | 2648 | return 0; |
@@ -3834,36 +2651,35 @@ static int set_timeout(struct cyclades_port *info, unsigned long value) | |||
3834 | static int get_timeout(struct cyclades_port *info, | 2651 | static int get_timeout(struct cyclades_port *info, |
3835 | unsigned long __user *value) | 2652 | unsigned long __user *value) |
3836 | { | 2653 | { |
3837 | struct cyclades_card *card; | 2654 | struct cyclades_card *card = info->card; |
3838 | void __iomem *base_addr; | ||
3839 | int channel, chip, index; | ||
3840 | unsigned long tmp; | ||
3841 | 2655 | ||
3842 | card = info->card; | ||
3843 | channel = info->line - card->first_line; | ||
3844 | if (!cy_is_Z(card)) { | 2656 | if (!cy_is_Z(card)) { |
3845 | chip = channel >> 2; | 2657 | u8 tmp = cyy_readb(info, CyRTPR); |
3846 | channel &= 0x03; | ||
3847 | index = card->bus_index; | ||
3848 | base_addr = card->base_addr + (cy_chip_offset[chip] << index); | ||
3849 | |||
3850 | tmp = readb(base_addr + (CyRTPR << index)); | ||
3851 | return put_user(tmp, value); | 2658 | return put_user(tmp, value); |
3852 | } | 2659 | } |
3853 | return 0; | 2660 | return 0; |
3854 | } /* get_timeout */ | 2661 | } /* get_timeout */ |
3855 | 2662 | ||
3856 | static int set_default_timeout(struct cyclades_port *info, unsigned long value) | 2663 | static int cy_cflags_changed(struct cyclades_port *info, unsigned long arg, |
2664 | struct cyclades_icount *cprev) | ||
3857 | { | 2665 | { |
3858 | info->default_timeout = value & 0xff; | 2666 | struct cyclades_icount cnow; |
3859 | return 0; | 2667 | unsigned long flags; |
3860 | } /* set_default_timeout */ | 2668 | int ret; |
3861 | 2669 | ||
3862 | static int get_default_timeout(struct cyclades_port *info, | 2670 | spin_lock_irqsave(&info->card->card_lock, flags); |
3863 | unsigned long __user *value) | 2671 | cnow = info->icount; /* atomic copy */ |
3864 | { | 2672 | spin_unlock_irqrestore(&info->card->card_lock, flags); |
3865 | return put_user(info->default_timeout, value); | 2673 | |
3866 | } /* get_default_timeout */ | 2674 | ret = ((arg & TIOCM_RNG) && (cnow.rng != cprev->rng)) || |
2675 | ((arg & TIOCM_DSR) && (cnow.dsr != cprev->dsr)) || | ||
2676 | ((arg & TIOCM_CD) && (cnow.dcd != cprev->dcd)) || | ||
2677 | ((arg & TIOCM_CTS) && (cnow.cts != cprev->cts)); | ||
2678 | |||
2679 | *cprev = cnow; | ||
2680 | |||
2681 | return ret; | ||
2682 | } | ||
3867 | 2683 | ||
3868 | /* | 2684 | /* |
3869 | * This routine allows the tty driver to implement device- | 2685 | * This routine allows the tty driver to implement device- |
@@ -3875,8 +2691,7 @@ cy_ioctl(struct tty_struct *tty, struct file *file, | |||
3875 | unsigned int cmd, unsigned long arg) | 2691 | unsigned int cmd, unsigned long arg) |
3876 | { | 2692 | { |
3877 | struct cyclades_port *info = tty->driver_data; | 2693 | struct cyclades_port *info = tty->driver_data; |
3878 | struct cyclades_icount cprev, cnow; /* kernel counter temps */ | 2694 | struct cyclades_icount cnow; /* kernel counter temps */ |
3879 | struct serial_icounter_struct __user *p_cuser; /* user space */ | ||
3880 | int ret_val = 0; | 2695 | int ret_val = 0; |
3881 | unsigned long flags; | 2696 | unsigned long flags; |
3882 | void __user *argp = (void __user *)arg; | 2697 | void __user *argp = (void __user *)arg; |
@@ -3892,7 +2707,11 @@ cy_ioctl(struct tty_struct *tty, struct file *file, | |||
3892 | 2707 | ||
3893 | switch (cmd) { | 2708 | switch (cmd) { |
3894 | case CYGETMON: | 2709 | case CYGETMON: |
3895 | ret_val = get_mon_info(info, argp); | 2710 | if (copy_to_user(argp, &info->mon, sizeof(info->mon))) { |
2711 | ret_val = -EFAULT; | ||
2712 | break; | ||
2713 | } | ||
2714 | memset(&info->mon, 0, sizeof(info->mon)); | ||
3896 | break; | 2715 | break; |
3897 | case CYGETTHRESH: | 2716 | case CYGETTHRESH: |
3898 | ret_val = get_threshold(info, argp); | 2717 | ret_val = get_threshold(info, argp); |
@@ -3901,10 +2720,11 @@ cy_ioctl(struct tty_struct *tty, struct file *file, | |||
3901 | ret_val = set_threshold(info, arg); | 2720 | ret_val = set_threshold(info, arg); |
3902 | break; | 2721 | break; |
3903 | case CYGETDEFTHRESH: | 2722 | case CYGETDEFTHRESH: |
3904 | ret_val = get_default_threshold(info, argp); | 2723 | ret_val = put_user(info->default_threshold, |
2724 | (unsigned long __user *)argp); | ||
3905 | break; | 2725 | break; |
3906 | case CYSETDEFTHRESH: | 2726 | case CYSETDEFTHRESH: |
3907 | ret_val = set_default_threshold(info, arg); | 2727 | info->default_threshold = arg & 0x0f; |
3908 | break; | 2728 | break; |
3909 | case CYGETTIMEOUT: | 2729 | case CYGETTIMEOUT: |
3910 | ret_val = get_timeout(info, argp); | 2730 | ret_val = get_timeout(info, argp); |
@@ -3913,21 +2733,20 @@ cy_ioctl(struct tty_struct *tty, struct file *file, | |||
3913 | ret_val = set_timeout(info, arg); | 2733 | ret_val = set_timeout(info, arg); |
3914 | break; | 2734 | break; |
3915 | case CYGETDEFTIMEOUT: | 2735 | case CYGETDEFTIMEOUT: |
3916 | ret_val = get_default_timeout(info, argp); | 2736 | ret_val = put_user(info->default_timeout, |
2737 | (unsigned long __user *)argp); | ||
3917 | break; | 2738 | break; |
3918 | case CYSETDEFTIMEOUT: | 2739 | case CYSETDEFTIMEOUT: |
3919 | ret_val = set_default_timeout(info, arg); | 2740 | info->default_timeout = arg & 0xff; |
3920 | break; | 2741 | break; |
3921 | case CYSETRFLOW: | 2742 | case CYSETRFLOW: |
3922 | info->rflow = (int)arg; | 2743 | info->rflow = (int)arg; |
3923 | ret_val = 0; | ||
3924 | break; | 2744 | break; |
3925 | case CYGETRFLOW: | 2745 | case CYGETRFLOW: |
3926 | ret_val = info->rflow; | 2746 | ret_val = info->rflow; |
3927 | break; | 2747 | break; |
3928 | case CYSETRTSDTR_INV: | 2748 | case CYSETRTSDTR_INV: |
3929 | info->rtsdtr_inv = (int)arg; | 2749 | info->rtsdtr_inv = (int)arg; |
3930 | ret_val = 0; | ||
3931 | break; | 2750 | break; |
3932 | case CYGETRTSDTR_INV: | 2751 | case CYGETRTSDTR_INV: |
3933 | ret_val = info->rtsdtr_inv; | 2752 | ret_val = info->rtsdtr_inv; |
@@ -3938,7 +2757,6 @@ cy_ioctl(struct tty_struct *tty, struct file *file, | |||
3938 | #ifndef CONFIG_CYZ_INTR | 2757 | #ifndef CONFIG_CYZ_INTR |
3939 | case CYZSETPOLLCYCLE: | 2758 | case CYZSETPOLLCYCLE: |
3940 | cyz_polling_cycle = (arg * HZ) / 1000; | 2759 | cyz_polling_cycle = (arg * HZ) / 1000; |
3941 | ret_val = 0; | ||
3942 | break; | 2760 | break; |
3943 | case CYZGETPOLLCYCLE: | 2761 | case CYZGETPOLLCYCLE: |
3944 | ret_val = (cyz_polling_cycle * 1000) / HZ; | 2762 | ret_val = (cyz_polling_cycle * 1000) / HZ; |
@@ -3946,16 +2764,15 @@ cy_ioctl(struct tty_struct *tty, struct file *file, | |||
3946 | #endif /* CONFIG_CYZ_INTR */ | 2764 | #endif /* CONFIG_CYZ_INTR */ |
3947 | case CYSETWAIT: | 2765 | case CYSETWAIT: |
3948 | info->port.closing_wait = (unsigned short)arg * HZ / 100; | 2766 | info->port.closing_wait = (unsigned short)arg * HZ / 100; |
3949 | ret_val = 0; | ||
3950 | break; | 2767 | break; |
3951 | case CYGETWAIT: | 2768 | case CYGETWAIT: |
3952 | ret_val = info->port.closing_wait / (HZ / 100); | 2769 | ret_val = info->port.closing_wait / (HZ / 100); |
3953 | break; | 2770 | break; |
3954 | case TIOCGSERIAL: | 2771 | case TIOCGSERIAL: |
3955 | ret_val = get_serial_info(info, argp); | 2772 | ret_val = cy_get_serial_info(info, argp); |
3956 | break; | 2773 | break; |
3957 | case TIOCSSERIAL: | 2774 | case TIOCSSERIAL: |
3958 | ret_val = set_serial_info(info, argp); | 2775 | ret_val = cy_set_serial_info(info, tty, argp); |
3959 | break; | 2776 | break; |
3960 | case TIOCSERGETLSR: /* Get line status register */ | 2777 | case TIOCSERGETLSR: /* Get line status register */ |
3961 | ret_val = get_lsr_info(info, argp); | 2778 | ret_val = get_lsr_info(info, argp); |
@@ -3971,17 +2788,8 @@ cy_ioctl(struct tty_struct *tty, struct file *file, | |||
3971 | /* note the counters on entry */ | 2788 | /* note the counters on entry */ |
3972 | cnow = info->icount; | 2789 | cnow = info->icount; |
3973 | spin_unlock_irqrestore(&info->card->card_lock, flags); | 2790 | spin_unlock_irqrestore(&info->card->card_lock, flags); |
3974 | ret_val = wait_event_interruptible(info->delta_msr_wait, ({ | 2791 | ret_val = wait_event_interruptible(info->port.delta_msr_wait, |
3975 | cprev = cnow; | 2792 | cy_cflags_changed(info, arg, &cnow)); |
3976 | spin_lock_irqsave(&info->card->card_lock, flags); | ||
3977 | cnow = info->icount; /* atomic copy */ | ||
3978 | spin_unlock_irqrestore(&info->card->card_lock, flags); | ||
3979 | |||
3980 | ((arg & TIOCM_RNG) && (cnow.rng != cprev.rng)) || | ||
3981 | ((arg & TIOCM_DSR) && (cnow.dsr != cprev.dsr)) || | ||
3982 | ((arg & TIOCM_CD) && (cnow.dcd != cprev.dcd)) || | ||
3983 | ((arg & TIOCM_CTS) && (cnow.cts != cprev.cts)); | ||
3984 | })); | ||
3985 | break; | 2793 | break; |
3986 | 2794 | ||
3987 | /* | 2795 | /* |
@@ -3990,46 +2798,29 @@ cy_ioctl(struct tty_struct *tty, struct file *file, | |||
3990 | * NB: both 1->0 and 0->1 transitions are counted except for | 2798 | * NB: both 1->0 and 0->1 transitions are counted except for |
3991 | * RI where only 0->1 is counted. | 2799 | * RI where only 0->1 is counted. |
3992 | */ | 2800 | */ |
3993 | case TIOCGICOUNT: | 2801 | case TIOCGICOUNT: { |
2802 | struct serial_icounter_struct sic = { }; | ||
2803 | |||
3994 | spin_lock_irqsave(&info->card->card_lock, flags); | 2804 | spin_lock_irqsave(&info->card->card_lock, flags); |
3995 | cnow = info->icount; | 2805 | cnow = info->icount; |
3996 | spin_unlock_irqrestore(&info->card->card_lock, flags); | 2806 | spin_unlock_irqrestore(&info->card->card_lock, flags); |
3997 | p_cuser = argp; | 2807 | |
3998 | ret_val = put_user(cnow.cts, &p_cuser->cts); | 2808 | sic.cts = cnow.cts; |
3999 | if (ret_val) | 2809 | sic.dsr = cnow.dsr; |
4000 | break; | 2810 | sic.rng = cnow.rng; |
4001 | ret_val = put_user(cnow.dsr, &p_cuser->dsr); | 2811 | sic.dcd = cnow.dcd; |
4002 | if (ret_val) | 2812 | sic.rx = cnow.rx; |
4003 | break; | 2813 | sic.tx = cnow.tx; |
4004 | ret_val = put_user(cnow.rng, &p_cuser->rng); | 2814 | sic.frame = cnow.frame; |
4005 | if (ret_val) | 2815 | sic.overrun = cnow.overrun; |
4006 | break; | 2816 | sic.parity = cnow.parity; |
4007 | ret_val = put_user(cnow.dcd, &p_cuser->dcd); | 2817 | sic.brk = cnow.brk; |
4008 | if (ret_val) | 2818 | sic.buf_overrun = cnow.buf_overrun; |
4009 | break; | 2819 | |
4010 | ret_val = put_user(cnow.rx, &p_cuser->rx); | 2820 | if (copy_to_user(argp, &sic, sizeof(sic))) |
4011 | if (ret_val) | 2821 | ret_val = -EFAULT; |
4012 | break; | ||
4013 | ret_val = put_user(cnow.tx, &p_cuser->tx); | ||
4014 | if (ret_val) | ||
4015 | break; | ||
4016 | ret_val = put_user(cnow.frame, &p_cuser->frame); | ||
4017 | if (ret_val) | ||
4018 | break; | ||
4019 | ret_val = put_user(cnow.overrun, &p_cuser->overrun); | ||
4020 | if (ret_val) | ||
4021 | break; | ||
4022 | ret_val = put_user(cnow.parity, &p_cuser->parity); | ||
4023 | if (ret_val) | ||
4024 | break; | ||
4025 | ret_val = put_user(cnow.brk, &p_cuser->brk); | ||
4026 | if (ret_val) | ||
4027 | break; | ||
4028 | ret_val = put_user(cnow.buf_overrun, &p_cuser->buf_overrun); | ||
4029 | if (ret_val) | ||
4030 | break; | ||
4031 | ret_val = 0; | ||
4032 | break; | 2822 | break; |
2823 | } | ||
4033 | default: | 2824 | default: |
4034 | ret_val = -ENOIOCTLCMD; | 2825 | ret_val = -ENOIOCTLCMD; |
4035 | } | 2826 | } |
@@ -4055,7 +2846,7 @@ static void cy_set_termios(struct tty_struct *tty, struct ktermios *old_termios) | |||
4055 | printk(KERN_DEBUG "cyc:cy_set_termios ttyC%d\n", info->line); | 2846 | printk(KERN_DEBUG "cyc:cy_set_termios ttyC%d\n", info->line); |
4056 | #endif | 2847 | #endif |
4057 | 2848 | ||
4058 | set_line_char(info); | 2849 | cy_set_line_char(info, tty); |
4059 | 2850 | ||
4060 | if ((old_termios->c_cflag & CRTSCTS) && | 2851 | if ((old_termios->c_cflag & CRTSCTS) && |
4061 | !(tty->termios->c_cflag & CRTSCTS)) { | 2852 | !(tty->termios->c_cflag & CRTSCTS)) { |
@@ -4112,8 +2903,6 @@ static void cy_throttle(struct tty_struct *tty) | |||
4112 | struct cyclades_port *info = tty->driver_data; | 2903 | struct cyclades_port *info = tty->driver_data; |
4113 | struct cyclades_card *card; | 2904 | struct cyclades_card *card; |
4114 | unsigned long flags; | 2905 | unsigned long flags; |
4115 | void __iomem *base_addr; | ||
4116 | int chip, channel, index; | ||
4117 | 2906 | ||
4118 | #ifdef CY_DEBUG_THROTTLE | 2907 | #ifdef CY_DEBUG_THROTTLE |
4119 | char buf[64]; | 2908 | char buf[64]; |
@@ -4135,24 +2924,9 @@ static void cy_throttle(struct tty_struct *tty) | |||
4135 | } | 2924 | } |
4136 | 2925 | ||
4137 | if (tty->termios->c_cflag & CRTSCTS) { | 2926 | if (tty->termios->c_cflag & CRTSCTS) { |
4138 | channel = info->line - card->first_line; | ||
4139 | if (!cy_is_Z(card)) { | 2927 | if (!cy_is_Z(card)) { |
4140 | chip = channel >> 2; | ||
4141 | channel &= 0x03; | ||
4142 | index = card->bus_index; | ||
4143 | base_addr = card->base_addr + | ||
4144 | (cy_chip_offset[chip] << index); | ||
4145 | |||
4146 | spin_lock_irqsave(&card->card_lock, flags); | 2928 | spin_lock_irqsave(&card->card_lock, flags); |
4147 | cy_writeb(base_addr + (CyCAR << index), | 2929 | cyy_change_rts_dtr(info, 0, TIOCM_RTS); |
4148 | (u_char) channel); | ||
4149 | if (info->rtsdtr_inv) { | ||
4150 | cy_writeb(base_addr + (CyMSVR2 << index), | ||
4151 | ~CyDTR); | ||
4152 | } else { | ||
4153 | cy_writeb(base_addr + (CyMSVR1 << index), | ||
4154 | ~CyRTS); | ||
4155 | } | ||
4156 | spin_unlock_irqrestore(&card->card_lock, flags); | 2930 | spin_unlock_irqrestore(&card->card_lock, flags); |
4157 | } else { | 2931 | } else { |
4158 | info->throttle = 1; | 2932 | info->throttle = 1; |
@@ -4170,8 +2944,6 @@ static void cy_unthrottle(struct tty_struct *tty) | |||
4170 | struct cyclades_port *info = tty->driver_data; | 2944 | struct cyclades_port *info = tty->driver_data; |
4171 | struct cyclades_card *card; | 2945 | struct cyclades_card *card; |
4172 | unsigned long flags; | 2946 | unsigned long flags; |
4173 | void __iomem *base_addr; | ||
4174 | int chip, channel, index; | ||
4175 | 2947 | ||
4176 | #ifdef CY_DEBUG_THROTTLE | 2948 | #ifdef CY_DEBUG_THROTTLE |
4177 | char buf[64]; | 2949 | char buf[64]; |
@@ -4192,24 +2964,9 @@ static void cy_unthrottle(struct tty_struct *tty) | |||
4192 | 2964 | ||
4193 | if (tty->termios->c_cflag & CRTSCTS) { | 2965 | if (tty->termios->c_cflag & CRTSCTS) { |
4194 | card = info->card; | 2966 | card = info->card; |
4195 | channel = info->line - card->first_line; | ||
4196 | if (!cy_is_Z(card)) { | 2967 | if (!cy_is_Z(card)) { |
4197 | chip = channel >> 2; | ||
4198 | channel &= 0x03; | ||
4199 | index = card->bus_index; | ||
4200 | base_addr = card->base_addr + | ||
4201 | (cy_chip_offset[chip] << index); | ||
4202 | |||
4203 | spin_lock_irqsave(&card->card_lock, flags); | 2968 | spin_lock_irqsave(&card->card_lock, flags); |
4204 | cy_writeb(base_addr + (CyCAR << index), | 2969 | cyy_change_rts_dtr(info, TIOCM_RTS, 0); |
4205 | (u_char) channel); | ||
4206 | if (info->rtsdtr_inv) { | ||
4207 | cy_writeb(base_addr + (CyMSVR2 << index), | ||
4208 | CyDTR); | ||
4209 | } else { | ||
4210 | cy_writeb(base_addr + (CyMSVR1 << index), | ||
4211 | CyRTS); | ||
4212 | } | ||
4213 | spin_unlock_irqrestore(&card->card_lock, flags); | 2970 | spin_unlock_irqrestore(&card->card_lock, flags); |
4214 | } else { | 2971 | } else { |
4215 | info->throttle = 0; | 2972 | info->throttle = 0; |
@@ -4224,8 +2981,7 @@ static void cy_stop(struct tty_struct *tty) | |||
4224 | { | 2981 | { |
4225 | struct cyclades_card *cinfo; | 2982 | struct cyclades_card *cinfo; |
4226 | struct cyclades_port *info = tty->driver_data; | 2983 | struct cyclades_port *info = tty->driver_data; |
4227 | void __iomem *base_addr; | 2984 | int channel; |
4228 | int chip, channel, index; | ||
4229 | unsigned long flags; | 2985 | unsigned long flags; |
4230 | 2986 | ||
4231 | #ifdef CY_DEBUG_OTHER | 2987 | #ifdef CY_DEBUG_OTHER |
@@ -4238,16 +2994,9 @@ static void cy_stop(struct tty_struct *tty) | |||
4238 | cinfo = info->card; | 2994 | cinfo = info->card; |
4239 | channel = info->line - cinfo->first_line; | 2995 | channel = info->line - cinfo->first_line; |
4240 | if (!cy_is_Z(cinfo)) { | 2996 | if (!cy_is_Z(cinfo)) { |
4241 | index = cinfo->bus_index; | ||
4242 | chip = channel >> 2; | ||
4243 | channel &= 0x03; | ||
4244 | base_addr = cinfo->base_addr + (cy_chip_offset[chip] << index); | ||
4245 | |||
4246 | spin_lock_irqsave(&cinfo->card_lock, flags); | 2997 | spin_lock_irqsave(&cinfo->card_lock, flags); |
4247 | cy_writeb(base_addr + (CyCAR << index), | 2998 | cyy_writeb(info, CyCAR, channel & 0x03); |
4248 | (u_char)(channel & 0x0003)); /* index channel */ | 2999 | cyy_writeb(info, CySRER, cyy_readb(info, CySRER) & ~CyTxRdy); |
4249 | cy_writeb(base_addr + (CySRER << index), | ||
4250 | readb(base_addr + (CySRER << index)) & ~CyTxRdy); | ||
4251 | spin_unlock_irqrestore(&cinfo->card_lock, flags); | 3000 | spin_unlock_irqrestore(&cinfo->card_lock, flags); |
4252 | } | 3001 | } |
4253 | } /* cy_stop */ | 3002 | } /* cy_stop */ |
@@ -4256,8 +3005,7 @@ static void cy_start(struct tty_struct *tty) | |||
4256 | { | 3005 | { |
4257 | struct cyclades_card *cinfo; | 3006 | struct cyclades_card *cinfo; |
4258 | struct cyclades_port *info = tty->driver_data; | 3007 | struct cyclades_port *info = tty->driver_data; |
4259 | void __iomem *base_addr; | 3008 | int channel; |
4260 | int chip, channel, index; | ||
4261 | unsigned long flags; | 3009 | unsigned long flags; |
4262 | 3010 | ||
4263 | #ifdef CY_DEBUG_OTHER | 3011 | #ifdef CY_DEBUG_OTHER |
@@ -4269,17 +3017,10 @@ static void cy_start(struct tty_struct *tty) | |||
4269 | 3017 | ||
4270 | cinfo = info->card; | 3018 | cinfo = info->card; |
4271 | channel = info->line - cinfo->first_line; | 3019 | channel = info->line - cinfo->first_line; |
4272 | index = cinfo->bus_index; | ||
4273 | if (!cy_is_Z(cinfo)) { | 3020 | if (!cy_is_Z(cinfo)) { |
4274 | chip = channel >> 2; | ||
4275 | channel &= 0x03; | ||
4276 | base_addr = cinfo->base_addr + (cy_chip_offset[chip] << index); | ||
4277 | |||
4278 | spin_lock_irqsave(&cinfo->card_lock, flags); | 3021 | spin_lock_irqsave(&cinfo->card_lock, flags); |
4279 | cy_writeb(base_addr + (CyCAR << index), | 3022 | cyy_writeb(info, CyCAR, channel & 0x03); |
4280 | (u_char) (channel & 0x0003)); /* index channel */ | 3023 | cyy_writeb(info, CySRER, cyy_readb(info, CySRER) | CyTxRdy); |
4281 | cy_writeb(base_addr + (CySRER << index), | ||
4282 | readb(base_addr + (CySRER << index)) | CyTxRdy); | ||
4283 | spin_unlock_irqrestore(&cinfo->card_lock, flags); | 3024 | spin_unlock_irqrestore(&cinfo->card_lock, flags); |
4284 | } | 3025 | } |
4285 | } /* cy_start */ | 3026 | } /* cy_start */ |
@@ -4299,17 +3040,84 @@ static void cy_hangup(struct tty_struct *tty) | |||
4299 | return; | 3040 | return; |
4300 | 3041 | ||
4301 | cy_flush_buffer(tty); | 3042 | cy_flush_buffer(tty); |
4302 | shutdown(info); | 3043 | cy_shutdown(info, tty); |
4303 | info->port.count = 0; | 3044 | tty_port_hangup(&info->port); |
4304 | #ifdef CY_DEBUG_COUNT | ||
4305 | printk(KERN_DEBUG "cyc:cy_hangup (%d): setting count to 0\n", | ||
4306 | current->pid); | ||
4307 | #endif | ||
4308 | info->port.tty = NULL; | ||
4309 | info->port.flags &= ~ASYNC_NORMAL_ACTIVE; | ||
4310 | wake_up_interruptible(&info->port.open_wait); | ||
4311 | } /* cy_hangup */ | 3045 | } /* cy_hangup */ |
4312 | 3046 | ||
3047 | static int cyy_carrier_raised(struct tty_port *port) | ||
3048 | { | ||
3049 | struct cyclades_port *info = container_of(port, struct cyclades_port, | ||
3050 | port); | ||
3051 | struct cyclades_card *cinfo = info->card; | ||
3052 | unsigned long flags; | ||
3053 | int channel = info->line - cinfo->first_line; | ||
3054 | u32 cd; | ||
3055 | |||
3056 | spin_lock_irqsave(&cinfo->card_lock, flags); | ||
3057 | cyy_writeb(info, CyCAR, channel & 0x03); | ||
3058 | cd = cyy_readb(info, CyMSVR1) & CyDCD; | ||
3059 | spin_unlock_irqrestore(&cinfo->card_lock, flags); | ||
3060 | |||
3061 | return cd; | ||
3062 | } | ||
3063 | |||
3064 | static void cyy_dtr_rts(struct tty_port *port, int raise) | ||
3065 | { | ||
3066 | struct cyclades_port *info = container_of(port, struct cyclades_port, | ||
3067 | port); | ||
3068 | struct cyclades_card *cinfo = info->card; | ||
3069 | unsigned long flags; | ||
3070 | |||
3071 | spin_lock_irqsave(&cinfo->card_lock, flags); | ||
3072 | cyy_change_rts_dtr(info, raise ? TIOCM_RTS | TIOCM_DTR : 0, | ||
3073 | raise ? 0 : TIOCM_RTS | TIOCM_DTR); | ||
3074 | spin_unlock_irqrestore(&cinfo->card_lock, flags); | ||
3075 | } | ||
3076 | |||
3077 | static int cyz_carrier_raised(struct tty_port *port) | ||
3078 | { | ||
3079 | struct cyclades_port *info = container_of(port, struct cyclades_port, | ||
3080 | port); | ||
3081 | |||
3082 | return readl(&info->u.cyz.ch_ctrl->rs_status) & C_RS_DCD; | ||
3083 | } | ||
3084 | |||
3085 | static void cyz_dtr_rts(struct tty_port *port, int raise) | ||
3086 | { | ||
3087 | struct cyclades_port *info = container_of(port, struct cyclades_port, | ||
3088 | port); | ||
3089 | struct cyclades_card *cinfo = info->card; | ||
3090 | struct CH_CTRL __iomem *ch_ctrl = info->u.cyz.ch_ctrl; | ||
3091 | int ret, channel = info->line - cinfo->first_line; | ||
3092 | u32 rs; | ||
3093 | |||
3094 | rs = readl(&ch_ctrl->rs_control); | ||
3095 | if (raise) | ||
3096 | rs |= C_RS_RTS | C_RS_DTR; | ||
3097 | else | ||
3098 | rs &= ~(C_RS_RTS | C_RS_DTR); | ||
3099 | cy_writel(&ch_ctrl->rs_control, rs); | ||
3100 | ret = cyz_issue_cmd(cinfo, channel, C_CM_IOCTLM, 0L); | ||
3101 | if (ret != 0) | ||
3102 | printk(KERN_ERR "%s: retval on ttyC%d was %x\n", | ||
3103 | __func__, info->line, ret); | ||
3104 | #ifdef CY_DEBUG_DTR | ||
3105 | printk(KERN_DEBUG "%s: raising Z DTR\n", __func__); | ||
3106 | #endif | ||
3107 | } | ||
3108 | |||
3109 | static const struct tty_port_operations cyy_port_ops = { | ||
3110 | .carrier_raised = cyy_carrier_raised, | ||
3111 | .dtr_rts = cyy_dtr_rts, | ||
3112 | .shutdown = cy_do_close, | ||
3113 | }; | ||
3114 | |||
3115 | static const struct tty_port_operations cyz_port_ops = { | ||
3116 | .carrier_raised = cyz_carrier_raised, | ||
3117 | .dtr_rts = cyz_dtr_rts, | ||
3118 | .shutdown = cy_do_close, | ||
3119 | }; | ||
3120 | |||
4313 | /* | 3121 | /* |
4314 | * --------------------------------------------------------------------- | 3122 | * --------------------------------------------------------------------- |
4315 | * cy_init() and friends | 3123 | * cy_init() and friends |
@@ -4321,8 +3129,7 @@ static void cy_hangup(struct tty_struct *tty) | |||
4321 | static int __devinit cy_init_card(struct cyclades_card *cinfo) | 3129 | static int __devinit cy_init_card(struct cyclades_card *cinfo) |
4322 | { | 3130 | { |
4323 | struct cyclades_port *info; | 3131 | struct cyclades_port *info; |
4324 | unsigned int port; | 3132 | unsigned int channel, port; |
4325 | unsigned short chip_number; | ||
4326 | 3133 | ||
4327 | spin_lock_init(&cinfo->card_lock); | 3134 | spin_lock_init(&cinfo->card_lock); |
4328 | cinfo->intr_enabled = 0; | 3135 | cinfo->intr_enabled = 0; |
@@ -4334,9 +3141,9 @@ static int __devinit cy_init_card(struct cyclades_card *cinfo) | |||
4334 | return -ENOMEM; | 3141 | return -ENOMEM; |
4335 | } | 3142 | } |
4336 | 3143 | ||
4337 | for (port = cinfo->first_line; port < cinfo->first_line + cinfo->nports; | 3144 | for (channel = 0, port = cinfo->first_line; channel < cinfo->nports; |
4338 | port++) { | 3145 | channel++, port++) { |
4339 | info = &cinfo->ports[port - cinfo->first_line]; | 3146 | info = &cinfo->ports[channel]; |
4340 | tty_port_init(&info->port); | 3147 | tty_port_init(&info->port); |
4341 | info->magic = CYCLADES_MAGIC; | 3148 | info->magic = CYCLADES_MAGIC; |
4342 | info->card = cinfo; | 3149 | info->card = cinfo; |
@@ -4346,10 +3153,19 @@ static int __devinit cy_init_card(struct cyclades_card *cinfo) | |||
4346 | info->port.close_delay = 5 * HZ / 10; | 3153 | info->port.close_delay = 5 * HZ / 10; |
4347 | info->port.flags = STD_COM_FLAGS; | 3154 | info->port.flags = STD_COM_FLAGS; |
4348 | init_completion(&info->shutdown_wait); | 3155 | init_completion(&info->shutdown_wait); |
4349 | init_waitqueue_head(&info->delta_msr_wait); | ||
4350 | 3156 | ||
4351 | if (cy_is_Z(cinfo)) { | 3157 | if (cy_is_Z(cinfo)) { |
3158 | struct FIRM_ID *firm_id = cinfo->base_addr + ID_ADDRESS; | ||
3159 | struct ZFW_CTRL *zfw_ctrl; | ||
3160 | |||
3161 | info->port.ops = &cyz_port_ops; | ||
4352 | info->type = PORT_STARTECH; | 3162 | info->type = PORT_STARTECH; |
3163 | |||
3164 | zfw_ctrl = cinfo->base_addr + | ||
3165 | (readl(&firm_id->zfwctrl_addr) & 0xfffff); | ||
3166 | info->u.cyz.ch_ctrl = &zfw_ctrl->ch_ctrl[channel]; | ||
3167 | info->u.cyz.buf_ctrl = &zfw_ctrl->buf_ctrl[channel]; | ||
3168 | |||
4353 | if (cinfo->hw_ver == ZO_V1) | 3169 | if (cinfo->hw_ver == ZO_V1) |
4354 | info->xmit_fifo_size = CYZ_FIFO_SIZE; | 3170 | info->xmit_fifo_size = CYZ_FIFO_SIZE; |
4355 | else | 3171 | else |
@@ -4359,17 +3175,20 @@ static int __devinit cy_init_card(struct cyclades_card *cinfo) | |||
4359 | cyz_rx_restart, (unsigned long)info); | 3175 | cyz_rx_restart, (unsigned long)info); |
4360 | #endif | 3176 | #endif |
4361 | } else { | 3177 | } else { |
3178 | unsigned short chip_number; | ||
4362 | int index = cinfo->bus_index; | 3179 | int index = cinfo->bus_index; |
3180 | |||
3181 | info->port.ops = &cyy_port_ops; | ||
4363 | info->type = PORT_CIRRUS; | 3182 | info->type = PORT_CIRRUS; |
4364 | info->xmit_fifo_size = CyMAX_CHAR_FIFO; | 3183 | info->xmit_fifo_size = CyMAX_CHAR_FIFO; |
4365 | info->cor1 = CyPARITY_NONE | Cy_1_STOP | Cy_8_BITS; | 3184 | info->cor1 = CyPARITY_NONE | Cy_1_STOP | Cy_8_BITS; |
4366 | info->cor2 = CyETC; | 3185 | info->cor2 = CyETC; |
4367 | info->cor3 = 0x08; /* _very_ small rcv threshold */ | 3186 | info->cor3 = 0x08; /* _very_ small rcv threshold */ |
4368 | 3187 | ||
4369 | chip_number = (port - cinfo->first_line) / 4; | 3188 | chip_number = channel / CyPORTS_PER_CHIP; |
4370 | info->chip_rev = readb(cinfo->base_addr + | 3189 | info->u.cyy.base_addr = cinfo->base_addr + |
4371 | (cy_chip_offset[chip_number] << index) + | 3190 | (cy_chip_offset[chip_number] << index); |
4372 | (CyGFRCR << index)); | 3191 | info->chip_rev = cyy_readb(info, CyGFRCR); |
4373 | 3192 | ||
4374 | if (info->chip_rev >= CD1400_REV_J) { | 3193 | if (info->chip_rev >= CD1400_REV_J) { |
4375 | /* It is a CD1400 rev. J or later */ | 3194 | /* It is a CD1400 rev. J or later */ |
@@ -5060,8 +3879,14 @@ static int __devinit cy_pci_probe(struct pci_dev *pdev, | |||
5060 | } | 3879 | } |
5061 | cy_card[card_no].num_chips = nchan / CyPORTS_PER_CHIP; | 3880 | cy_card[card_no].num_chips = nchan / CyPORTS_PER_CHIP; |
5062 | } else { | 3881 | } else { |
3882 | struct FIRM_ID __iomem *firm_id = addr2 + ID_ADDRESS; | ||
3883 | struct ZFW_CTRL __iomem *zfw_ctrl; | ||
3884 | |||
3885 | zfw_ctrl = addr2 + (readl(&firm_id->zfwctrl_addr) & 0xfffff); | ||
3886 | |||
5063 | cy_card[card_no].hw_ver = mailbox; | 3887 | cy_card[card_no].hw_ver = mailbox; |
5064 | cy_card[card_no].num_chips = (unsigned int)-1; | 3888 | cy_card[card_no].num_chips = (unsigned int)-1; |
3889 | cy_card[card_no].board_ctrl = &zfw_ctrl->board_ctrl; | ||
5065 | #ifdef CONFIG_CYZ_INTR | 3890 | #ifdef CONFIG_CYZ_INTR |
5066 | /* allocate IRQ only if board has an IRQ */ | 3891 | /* allocate IRQ only if board has an IRQ */ |
5067 | if (irq != 0 && irq != 255) { | 3892 | if (irq != 0 && irq != 255) { |
@@ -5191,18 +4016,30 @@ static int cyclades_proc_show(struct seq_file *m, void *v) | |||
5191 | for (j = 0; j < cy_card[i].nports; j++) { | 4016 | for (j = 0; j < cy_card[i].nports; j++) { |
5192 | info = &cy_card[i].ports[j]; | 4017 | info = &cy_card[i].ports[j]; |
5193 | 4018 | ||
5194 | if (info->port.count) | 4019 | if (info->port.count) { |
4020 | /* XXX is the ldisc num worth this? */ | ||
4021 | struct tty_struct *tty; | ||
4022 | struct tty_ldisc *ld; | ||
4023 | int num = 0; | ||
4024 | tty = tty_port_tty_get(&info->port); | ||
4025 | if (tty) { | ||
4026 | ld = tty_ldisc_ref(tty); | ||
4027 | if (ld) { | ||
4028 | num = ld->ops->num; | ||
4029 | tty_ldisc_deref(ld); | ||
4030 | } | ||
4031 | tty_kref_put(tty); | ||
4032 | } | ||
5195 | seq_printf(m, "%3d %8lu %10lu %8lu " | 4033 | seq_printf(m, "%3d %8lu %10lu %8lu " |
5196 | "%10lu %8lu %9lu %6ld\n", info->line, | 4034 | "%10lu %8lu %9lu %6d\n", info->line, |
5197 | (cur_jifs - info->idle_stats.in_use) / | 4035 | (cur_jifs - info->idle_stats.in_use) / |
5198 | HZ, info->idle_stats.xmit_bytes, | 4036 | HZ, info->idle_stats.xmit_bytes, |
5199 | (cur_jifs - info->idle_stats.xmit_idle)/ | 4037 | (cur_jifs - info->idle_stats.xmit_idle)/ |
5200 | HZ, info->idle_stats.recv_bytes, | 4038 | HZ, info->idle_stats.recv_bytes, |
5201 | (cur_jifs - info->idle_stats.recv_idle)/ | 4039 | (cur_jifs - info->idle_stats.recv_idle)/ |
5202 | HZ, info->idle_stats.overruns, | 4040 | HZ, info->idle_stats.overruns, |
5203 | /* FIXME: double check locking */ | 4041 | num); |
5204 | (long)info->port.tty->ldisc->ops->num); | 4042 | } else |
5205 | else | ||
5206 | seq_printf(m, "%3d %8lu %10lu %8lu " | 4043 | seq_printf(m, "%3d %8lu %10lu %8lu " |
5207 | "%10lu %8lu %9lu %6ld\n", | 4044 | "%10lu %8lu %9lu %6ld\n", |
5208 | info->line, 0L, 0L, 0L, 0L, 0L, 0L, 0L); | 4045 | info->line, 0L, 0L, 0L, 0L, 0L, 0L, 0L); |
diff --git a/drivers/char/epca.c b/drivers/char/epca.c index ff647ca1c489..9d589e3144de 100644 --- a/drivers/char/epca.c +++ b/drivers/char/epca.c | |||
@@ -2239,7 +2239,7 @@ static void do_softint(struct work_struct *work) | |||
2239 | struct channel *ch = container_of(work, struct channel, tqueue); | 2239 | struct channel *ch = container_of(work, struct channel, tqueue); |
2240 | /* Called in response to a modem change event */ | 2240 | /* Called in response to a modem change event */ |
2241 | if (ch && ch->magic == EPCA_MAGIC) { | 2241 | if (ch && ch->magic == EPCA_MAGIC) { |
2242 | struct tty_struct *tty = tty_port_tty_get(&ch->port);; | 2242 | struct tty_struct *tty = tty_port_tty_get(&ch->port); |
2243 | 2243 | ||
2244 | if (tty && tty->driver_data) { | 2244 | if (tty && tty->driver_data) { |
2245 | if (test_and_clear_bit(EPCA_EVENT_HANGUP, &ch->event)) { | 2245 | if (test_and_clear_bit(EPCA_EVENT_HANGUP, &ch->event)) { |
diff --git a/drivers/char/esp.c b/drivers/char/esp.c index a5c59fc2b0ff..b19d43cd9542 100644 --- a/drivers/char/esp.c +++ b/drivers/char/esp.c | |||
@@ -572,7 +572,7 @@ static void check_modem_status(struct esp_struct *info) | |||
572 | info->icount.dcd++; | 572 | info->icount.dcd++; |
573 | if (status & UART_MSR_DCTS) | 573 | if (status & UART_MSR_DCTS) |
574 | info->icount.cts++; | 574 | info->icount.cts++; |
575 | wake_up_interruptible(&info->delta_msr_wait); | 575 | wake_up_interruptible(&info->port.delta_msr_wait); |
576 | } | 576 | } |
577 | 577 | ||
578 | if ((info->port.flags & ASYNC_CHECK_CD) && (status & UART_MSR_DDCD)) { | 578 | if ((info->port.flags & ASYNC_CHECK_CD) && (status & UART_MSR_DDCD)) { |
@@ -927,7 +927,7 @@ static void shutdown(struct esp_struct *info) | |||
927 | * clear delta_msr_wait queue to avoid mem leaks: we may free the irq | 927 | * clear delta_msr_wait queue to avoid mem leaks: we may free the irq |
928 | * here so the queue might never be waken up | 928 | * here so the queue might never be waken up |
929 | */ | 929 | */ |
930 | wake_up_interruptible(&info->delta_msr_wait); | 930 | wake_up_interruptible(&info->port.delta_msr_wait); |
931 | wake_up_interruptible(&info->break_wait); | 931 | wake_up_interruptible(&info->break_wait); |
932 | 932 | ||
933 | /* stop a DMA transfer on the port being closed */ | 933 | /* stop a DMA transfer on the port being closed */ |
@@ -1800,7 +1800,7 @@ static int rs_ioctl(struct tty_struct *tty, struct file *file, | |||
1800 | spin_unlock_irqrestore(&info->lock, flags); | 1800 | spin_unlock_irqrestore(&info->lock, flags); |
1801 | while (1) { | 1801 | while (1) { |
1802 | /* FIXME: convert to new style wakeup */ | 1802 | /* FIXME: convert to new style wakeup */ |
1803 | interruptible_sleep_on(&info->delta_msr_wait); | 1803 | interruptible_sleep_on(&info->port.delta_msr_wait); |
1804 | /* see if a signal did it */ | 1804 | /* see if a signal did it */ |
1805 | if (signal_pending(current)) | 1805 | if (signal_pending(current)) |
1806 | return -ERESTARTSYS; | 1806 | return -ERESTARTSYS; |
@@ -2452,7 +2452,6 @@ static int __init espserial_init(void) | |||
2452 | info->config.flow_off = flow_off; | 2452 | info->config.flow_off = flow_off; |
2453 | info->config.pio_threshold = pio_threshold; | 2453 | info->config.pio_threshold = pio_threshold; |
2454 | info->next_port = ports; | 2454 | info->next_port = ports; |
2455 | init_waitqueue_head(&info->delta_msr_wait); | ||
2456 | init_waitqueue_head(&info->break_wait); | 2455 | init_waitqueue_head(&info->break_wait); |
2457 | ports = info; | 2456 | ports = info; |
2458 | printk(KERN_INFO "ttyP%d at 0x%04x (irq = %d) is an ESP ", | 2457 | printk(KERN_INFO "ttyP%d at 0x%04x (irq = %d) is an ESP ", |
diff --git a/drivers/char/generic_nvram.c b/drivers/char/generic_nvram.c index a00869c650d5..ef31738c2cbe 100644 --- a/drivers/char/generic_nvram.c +++ b/drivers/char/generic_nvram.c | |||
@@ -2,7 +2,7 @@ | |||
2 | * Generic /dev/nvram driver for architectures providing some | 2 | * Generic /dev/nvram driver for architectures providing some |
3 | * "generic" hooks, that is : | 3 | * "generic" hooks, that is : |
4 | * | 4 | * |
5 | * nvram_read_byte, nvram_write_byte, nvram_sync | 5 | * nvram_read_byte, nvram_write_byte, nvram_sync, nvram_get_size |
6 | * | 6 | * |
7 | * Note that an additional hook is supported for PowerMac only | 7 | * Note that an additional hook is supported for PowerMac only |
8 | * for getting the nvram "partition" informations | 8 | * for getting the nvram "partition" informations |
@@ -28,6 +28,8 @@ | |||
28 | 28 | ||
29 | #define NVRAM_SIZE 8192 | 29 | #define NVRAM_SIZE 8192 |
30 | 30 | ||
31 | static ssize_t nvram_len; | ||
32 | |||
31 | static loff_t nvram_llseek(struct file *file, loff_t offset, int origin) | 33 | static loff_t nvram_llseek(struct file *file, loff_t offset, int origin) |
32 | { | 34 | { |
33 | lock_kernel(); | 35 | lock_kernel(); |
@@ -36,7 +38,7 @@ static loff_t nvram_llseek(struct file *file, loff_t offset, int origin) | |||
36 | offset += file->f_pos; | 38 | offset += file->f_pos; |
37 | break; | 39 | break; |
38 | case 2: | 40 | case 2: |
39 | offset += NVRAM_SIZE; | 41 | offset += nvram_len; |
40 | break; | 42 | break; |
41 | } | 43 | } |
42 | if (offset < 0) { | 44 | if (offset < 0) { |
@@ -56,9 +58,9 @@ static ssize_t read_nvram(struct file *file, char __user *buf, | |||
56 | 58 | ||
57 | if (!access_ok(VERIFY_WRITE, buf, count)) | 59 | if (!access_ok(VERIFY_WRITE, buf, count)) |
58 | return -EFAULT; | 60 | return -EFAULT; |
59 | if (*ppos >= NVRAM_SIZE) | 61 | if (*ppos >= nvram_len) |
60 | return 0; | 62 | return 0; |
61 | for (i = *ppos; count > 0 && i < NVRAM_SIZE; ++i, ++p, --count) | 63 | for (i = *ppos; count > 0 && i < nvram_len; ++i, ++p, --count) |
62 | if (__put_user(nvram_read_byte(i), p)) | 64 | if (__put_user(nvram_read_byte(i), p)) |
63 | return -EFAULT; | 65 | return -EFAULT; |
64 | *ppos = i; | 66 | *ppos = i; |
@@ -74,9 +76,9 @@ static ssize_t write_nvram(struct file *file, const char __user *buf, | |||
74 | 76 | ||
75 | if (!access_ok(VERIFY_READ, buf, count)) | 77 | if (!access_ok(VERIFY_READ, buf, count)) |
76 | return -EFAULT; | 78 | return -EFAULT; |
77 | if (*ppos >= NVRAM_SIZE) | 79 | if (*ppos >= nvram_len) |
78 | return 0; | 80 | return 0; |
79 | for (i = *ppos; count > 0 && i < NVRAM_SIZE; ++i, ++p, --count) { | 81 | for (i = *ppos; count > 0 && i < nvram_len; ++i, ++p, --count) { |
80 | if (__get_user(c, p)) | 82 | if (__get_user(c, p)) |
81 | return -EFAULT; | 83 | return -EFAULT; |
82 | nvram_write_byte(c, i); | 84 | nvram_write_byte(c, i); |
@@ -133,9 +135,20 @@ static struct miscdevice nvram_dev = { | |||
133 | 135 | ||
134 | int __init nvram_init(void) | 136 | int __init nvram_init(void) |
135 | { | 137 | { |
138 | int ret = 0; | ||
139 | |||
136 | printk(KERN_INFO "Generic non-volatile memory driver v%s\n", | 140 | printk(KERN_INFO "Generic non-volatile memory driver v%s\n", |
137 | NVRAM_VERSION); | 141 | NVRAM_VERSION); |
138 | return misc_register(&nvram_dev); | 142 | ret = misc_register(&nvram_dev); |
143 | if (ret != 0) | ||
144 | goto out; | ||
145 | |||
146 | nvram_len = nvram_get_size(); | ||
147 | if (nvram_len < 0) | ||
148 | nvram_len = NVRAM_SIZE; | ||
149 | |||
150 | out: | ||
151 | return ret; | ||
139 | } | 152 | } |
140 | 153 | ||
141 | void __exit nvram_cleanup(void) | 154 | void __exit nvram_cleanup(void) |
diff --git a/drivers/char/hpet.c b/drivers/char/hpet.c index 4a9f3492b921..70a770ac0138 100644 --- a/drivers/char/hpet.c +++ b/drivers/char/hpet.c | |||
@@ -166,9 +166,8 @@ static irqreturn_t hpet_interrupt(int irq, void *data) | |||
166 | unsigned long m, t; | 166 | unsigned long m, t; |
167 | 167 | ||
168 | t = devp->hd_ireqfreq; | 168 | t = devp->hd_ireqfreq; |
169 | m = read_counter(&devp->hd_hpet->hpet_mc); | 169 | m = read_counter(&devp->hd_timer->hpet_compare); |
170 | write_counter(t + m + devp->hd_hpets->hp_delta, | 170 | write_counter(t + m, &devp->hd_timer->hpet_compare); |
171 | &devp->hd_timer->hpet_compare); | ||
172 | } | 171 | } |
173 | 172 | ||
174 | if (devp->hd_flags & HPET_SHARED_IRQ) | 173 | if (devp->hd_flags & HPET_SHARED_IRQ) |
@@ -504,21 +503,25 @@ static int hpet_ioctl_ieon(struct hpet_dev *devp) | |||
504 | g = v | Tn_32MODE_CNF_MASK | Tn_INT_ENB_CNF_MASK; | 503 | g = v | Tn_32MODE_CNF_MASK | Tn_INT_ENB_CNF_MASK; |
505 | 504 | ||
506 | if (devp->hd_flags & HPET_PERIODIC) { | 505 | if (devp->hd_flags & HPET_PERIODIC) { |
507 | write_counter(t, &timer->hpet_compare); | ||
508 | g |= Tn_TYPE_CNF_MASK; | 506 | g |= Tn_TYPE_CNF_MASK; |
509 | v |= Tn_TYPE_CNF_MASK; | 507 | v |= Tn_TYPE_CNF_MASK | Tn_VAL_SET_CNF_MASK; |
510 | writeq(v, &timer->hpet_config); | ||
511 | v |= Tn_VAL_SET_CNF_MASK; | ||
512 | writeq(v, &timer->hpet_config); | 508 | writeq(v, &timer->hpet_config); |
513 | local_irq_save(flags); | 509 | local_irq_save(flags); |
514 | 510 | ||
515 | /* NOTE: what we modify here is a hidden accumulator | 511 | /* |
512 | * NOTE: First we modify the hidden accumulator | ||
516 | * register supported by periodic-capable comparators. | 513 | * register supported by periodic-capable comparators. |
517 | * We never want to modify the (single) counter; that | 514 | * We never want to modify the (single) counter; that |
518 | * would affect all the comparators. | 515 | * would affect all the comparators. The value written |
516 | * is the counter value when the first interrupt is due. | ||
519 | */ | 517 | */ |
520 | m = read_counter(&hpet->hpet_mc); | 518 | m = read_counter(&hpet->hpet_mc); |
521 | write_counter(t + m + hpetp->hp_delta, &timer->hpet_compare); | 519 | write_counter(t + m + hpetp->hp_delta, &timer->hpet_compare); |
520 | /* | ||
521 | * Then we modify the comparator, indicating the period | ||
522 | * for subsequent interrupt. | ||
523 | */ | ||
524 | write_counter(t, &timer->hpet_compare); | ||
522 | } else { | 525 | } else { |
523 | local_irq_save(flags); | 526 | local_irq_save(flags); |
524 | m = read_counter(&hpet->hpet_mc); | 527 | m = read_counter(&hpet->hpet_mc); |
diff --git a/drivers/char/hvc_console.c b/drivers/char/hvc_console.c index d97779ef72cb..a632f25f144a 100644 --- a/drivers/char/hvc_console.c +++ b/drivers/char/hvc_console.c | |||
@@ -516,8 +516,6 @@ static void hvc_set_winsz(struct work_struct *work) | |||
516 | struct winsize ws; | 516 | struct winsize ws; |
517 | 517 | ||
518 | hp = container_of(work, struct hvc_struct, tty_resize); | 518 | hp = container_of(work, struct hvc_struct, tty_resize); |
519 | if (!hp) | ||
520 | return; | ||
521 | 519 | ||
522 | spin_lock_irqsave(&hp->lock, hvc_flags); | 520 | spin_lock_irqsave(&hp->lock, hvc_flags); |
523 | if (!hp->tty) { | 521 | if (!hp->tty) { |
@@ -680,7 +678,7 @@ int hvc_poll(struct hvc_struct *hp) | |||
680 | EXPORT_SYMBOL_GPL(hvc_poll); | 678 | EXPORT_SYMBOL_GPL(hvc_poll); |
681 | 679 | ||
682 | /** | 680 | /** |
683 | * hvc_resize() - Update terminal window size information. | 681 | * __hvc_resize() - Update terminal window size information. |
684 | * @hp: HVC console pointer | 682 | * @hp: HVC console pointer |
685 | * @ws: Terminal window size structure | 683 | * @ws: Terminal window size structure |
686 | * | 684 | * |
@@ -689,12 +687,12 @@ EXPORT_SYMBOL_GPL(hvc_poll); | |||
689 | * | 687 | * |
690 | * Locking: Locking free; the function MUST be called holding hp->lock | 688 | * Locking: Locking free; the function MUST be called holding hp->lock |
691 | */ | 689 | */ |
692 | void hvc_resize(struct hvc_struct *hp, struct winsize ws) | 690 | void __hvc_resize(struct hvc_struct *hp, struct winsize ws) |
693 | { | 691 | { |
694 | hp->ws = ws; | 692 | hp->ws = ws; |
695 | schedule_work(&hp->tty_resize); | 693 | schedule_work(&hp->tty_resize); |
696 | } | 694 | } |
697 | EXPORT_SYMBOL_GPL(hvc_resize); | 695 | EXPORT_SYMBOL_GPL(__hvc_resize); |
698 | 696 | ||
699 | /* | 697 | /* |
700 | * This kthread is either polling or interrupt driven. This is determined by | 698 | * This kthread is either polling or interrupt driven. This is determined by |
diff --git a/drivers/char/hvc_console.h b/drivers/char/hvc_console.h index 3c85d78c975c..10950ca706d8 100644 --- a/drivers/char/hvc_console.h +++ b/drivers/char/hvc_console.h | |||
@@ -28,6 +28,7 @@ | |||
28 | #define HVC_CONSOLE_H | 28 | #define HVC_CONSOLE_H |
29 | #include <linux/kref.h> | 29 | #include <linux/kref.h> |
30 | #include <linux/tty.h> | 30 | #include <linux/tty.h> |
31 | #include <linux/spinlock.h> | ||
31 | 32 | ||
32 | /* | 33 | /* |
33 | * This is the max number of console adapters that can/will be found as | 34 | * This is the max number of console adapters that can/will be found as |
@@ -88,7 +89,16 @@ int hvc_poll(struct hvc_struct *hp); | |||
88 | void hvc_kick(void); | 89 | void hvc_kick(void); |
89 | 90 | ||
90 | /* Resize hvc tty terminal window */ | 91 | /* Resize hvc tty terminal window */ |
91 | extern void hvc_resize(struct hvc_struct *hp, struct winsize ws); | 92 | extern void __hvc_resize(struct hvc_struct *hp, struct winsize ws); |
93 | |||
94 | static inline void hvc_resize(struct hvc_struct *hp, struct winsize ws) | ||
95 | { | ||
96 | unsigned long flags; | ||
97 | |||
98 | spin_lock_irqsave(&hp->lock, flags); | ||
99 | __hvc_resize(hp, ws); | ||
100 | spin_unlock_irqrestore(&hp->lock, flags); | ||
101 | } | ||
92 | 102 | ||
93 | /* default notifier for irq based notification */ | 103 | /* default notifier for irq based notification */ |
94 | extern int notifier_add_irq(struct hvc_struct *hp, int data); | 104 | extern int notifier_add_irq(struct hvc_struct *hp, int data); |
diff --git a/drivers/char/hvc_iucv.c b/drivers/char/hvc_iucv.c index 0ecac7e532f6..b8a5d654d3d0 100644 --- a/drivers/char/hvc_iucv.c +++ b/drivers/char/hvc_iucv.c | |||
@@ -273,7 +273,9 @@ static int hvc_iucv_write(struct hvc_iucv_private *priv, | |||
273 | case MSG_TYPE_WINSIZE: | 273 | case MSG_TYPE_WINSIZE: |
274 | if (rb->mbuf->datalen != sizeof(struct winsize)) | 274 | if (rb->mbuf->datalen != sizeof(struct winsize)) |
275 | break; | 275 | break; |
276 | hvc_resize(priv->hvc, *((struct winsize *) rb->mbuf->data)); | 276 | /* The caller must ensure that the hvc is locked, which |
277 | * is the case when called from hvc_iucv_get_chars() */ | ||
278 | __hvc_resize(priv->hvc, *((struct winsize *) rb->mbuf->data)); | ||
277 | break; | 279 | break; |
278 | 280 | ||
279 | case MSG_TYPE_ERROR: /* ignored ... */ | 281 | case MSG_TYPE_ERROR: /* ignored ... */ |
diff --git a/drivers/char/hvc_vio.c b/drivers/char/hvc_vio.c index c72b994652ac..10be343d6ae7 100644 --- a/drivers/char/hvc_vio.c +++ b/drivers/char/hvc_vio.c | |||
@@ -120,7 +120,7 @@ static struct vio_driver hvc_vio_driver = { | |||
120 | } | 120 | } |
121 | }; | 121 | }; |
122 | 122 | ||
123 | static int hvc_vio_init(void) | 123 | static int __init hvc_vio_init(void) |
124 | { | 124 | { |
125 | int rc; | 125 | int rc; |
126 | 126 | ||
@@ -134,7 +134,7 @@ static int hvc_vio_init(void) | |||
134 | } | 134 | } |
135 | module_init(hvc_vio_init); /* after drivers/char/hvc_console.c */ | 135 | module_init(hvc_vio_init); /* after drivers/char/hvc_console.c */ |
136 | 136 | ||
137 | static void hvc_vio_exit(void) | 137 | static void __exit hvc_vio_exit(void) |
138 | { | 138 | { |
139 | vio_unregister_driver(&hvc_vio_driver); | 139 | vio_unregister_driver(&hvc_vio_driver); |
140 | } | 140 | } |
diff --git a/drivers/char/hvsi.c b/drivers/char/hvsi.c index 2989056a9e39..793b236c9266 100644 --- a/drivers/char/hvsi.c +++ b/drivers/char/hvsi.c | |||
@@ -1230,11 +1230,12 @@ static struct tty_driver *hvsi_console_device(struct console *console, | |||
1230 | 1230 | ||
1231 | static int __init hvsi_console_setup(struct console *console, char *options) | 1231 | static int __init hvsi_console_setup(struct console *console, char *options) |
1232 | { | 1232 | { |
1233 | struct hvsi_struct *hp = &hvsi_ports[console->index]; | 1233 | struct hvsi_struct *hp; |
1234 | int ret; | 1234 | int ret; |
1235 | 1235 | ||
1236 | if (console->index < 0 || console->index >= hvsi_count) | 1236 | if (console->index < 0 || console->index >= hvsi_count) |
1237 | return -1; | 1237 | return -1; |
1238 | hp = &hvsi_ports[console->index]; | ||
1238 | 1239 | ||
1239 | /* give the FSP a chance to change the baud rate when we re-open */ | 1240 | /* give the FSP a chance to change the baud rate when we re-open */ |
1240 | hvsi_close_protocol(hp); | 1241 | hvsi_close_protocol(hp); |
diff --git a/drivers/char/hw_random/Kconfig b/drivers/char/hw_random/Kconfig index ce66a70184f7..87060266ef91 100644 --- a/drivers/char/hw_random/Kconfig +++ b/drivers/char/hw_random/Kconfig | |||
@@ -126,6 +126,19 @@ config HW_RANDOM_OMAP | |||
126 | 126 | ||
127 | If unsure, say Y. | 127 | If unsure, say Y. |
128 | 128 | ||
129 | config HW_RANDOM_OCTEON | ||
130 | tristate "Octeon Random Number Generator support" | ||
131 | depends on HW_RANDOM && CPU_CAVIUM_OCTEON | ||
132 | default HW_RANDOM | ||
133 | ---help--- | ||
134 | This driver provides kernel-side support for the Random Number | ||
135 | Generator hardware found on Octeon processors. | ||
136 | |||
137 | To compile this driver as a module, choose M here: the | ||
138 | module will be called octeon-rng. | ||
139 | |||
140 | If unsure, say Y. | ||
141 | |||
129 | config HW_RANDOM_PASEMI | 142 | config HW_RANDOM_PASEMI |
130 | tristate "PA Semi HW Random Number Generator support" | 143 | tristate "PA Semi HW Random Number Generator support" |
131 | depends on HW_RANDOM && PPC_PASEMI | 144 | depends on HW_RANDOM && PPC_PASEMI |
diff --git a/drivers/char/hw_random/Makefile b/drivers/char/hw_random/Makefile index 676828ba8123..5eeb1303f0d0 100644 --- a/drivers/char/hw_random/Makefile +++ b/drivers/char/hw_random/Makefile | |||
@@ -17,3 +17,4 @@ obj-$(CONFIG_HW_RANDOM_PASEMI) += pasemi-rng.o | |||
17 | obj-$(CONFIG_HW_RANDOM_VIRTIO) += virtio-rng.o | 17 | obj-$(CONFIG_HW_RANDOM_VIRTIO) += virtio-rng.o |
18 | obj-$(CONFIG_HW_RANDOM_TX4939) += tx4939-rng.o | 18 | obj-$(CONFIG_HW_RANDOM_TX4939) += tx4939-rng.o |
19 | obj-$(CONFIG_HW_RANDOM_MXC_RNGA) += mxc-rnga.o | 19 | obj-$(CONFIG_HW_RANDOM_MXC_RNGA) += mxc-rnga.o |
20 | obj-$(CONFIG_HW_RANDOM_OCTEON) += octeon-rng.o | ||
diff --git a/drivers/char/hw_random/core.c b/drivers/char/hw_random/core.c index fc93e2fc7c71..1573aebd54b5 100644 --- a/drivers/char/hw_random/core.c +++ b/drivers/char/hw_random/core.c | |||
@@ -153,7 +153,7 @@ static const struct file_operations rng_chrdev_ops = { | |||
153 | static struct miscdevice rng_miscdev = { | 153 | static struct miscdevice rng_miscdev = { |
154 | .minor = RNG_MISCDEV_MINOR, | 154 | .minor = RNG_MISCDEV_MINOR, |
155 | .name = RNG_MODULE_NAME, | 155 | .name = RNG_MODULE_NAME, |
156 | .devnode = "hwrng", | 156 | .nodename = "hwrng", |
157 | .fops = &rng_chrdev_ops, | 157 | .fops = &rng_chrdev_ops, |
158 | }; | 158 | }; |
159 | 159 | ||
diff --git a/drivers/char/hw_random/octeon-rng.c b/drivers/char/hw_random/octeon-rng.c new file mode 100644 index 000000000000..54b0d9ba65cf --- /dev/null +++ b/drivers/char/hw_random/octeon-rng.c | |||
@@ -0,0 +1,147 @@ | |||
1 | /* | ||
2 | * Hardware Random Number Generator support for Cavium Networks | ||
3 | * Octeon processor family. | ||
4 | * | ||
5 | * This file is subject to the terms and conditions of the GNU General Public | ||
6 | * License. See the file "COPYING" in the main directory of this archive | ||
7 | * for more details. | ||
8 | * | ||
9 | * Copyright (C) 2009 Cavium Networks | ||
10 | */ | ||
11 | |||
12 | #include <linux/module.h> | ||
13 | #include <linux/init.h> | ||
14 | #include <linux/platform_device.h> | ||
15 | #include <linux/device.h> | ||
16 | #include <linux/hw_random.h> | ||
17 | #include <linux/io.h> | ||
18 | |||
19 | #include <asm/octeon/octeon.h> | ||
20 | #include <asm/octeon/cvmx-rnm-defs.h> | ||
21 | |||
22 | struct octeon_rng { | ||
23 | struct hwrng ops; | ||
24 | void __iomem *control_status; | ||
25 | void __iomem *result; | ||
26 | }; | ||
27 | |||
28 | static int octeon_rng_init(struct hwrng *rng) | ||
29 | { | ||
30 | union cvmx_rnm_ctl_status ctl; | ||
31 | struct octeon_rng *p = container_of(rng, struct octeon_rng, ops); | ||
32 | |||
33 | ctl.u64 = 0; | ||
34 | ctl.s.ent_en = 1; /* Enable the entropy source. */ | ||
35 | ctl.s.rng_en = 1; /* Enable the RNG hardware. */ | ||
36 | cvmx_write_csr((u64)p->control_status, ctl.u64); | ||
37 | return 0; | ||
38 | } | ||
39 | |||
40 | static void octeon_rng_cleanup(struct hwrng *rng) | ||
41 | { | ||
42 | union cvmx_rnm_ctl_status ctl; | ||
43 | struct octeon_rng *p = container_of(rng, struct octeon_rng, ops); | ||
44 | |||
45 | ctl.u64 = 0; | ||
46 | /* Disable everything. */ | ||
47 | cvmx_write_csr((u64)p->control_status, ctl.u64); | ||
48 | } | ||
49 | |||
50 | static int octeon_rng_data_read(struct hwrng *rng, u32 *data) | ||
51 | { | ||
52 | struct octeon_rng *p = container_of(rng, struct octeon_rng, ops); | ||
53 | |||
54 | *data = cvmx_read64_uint32((u64)p->result); | ||
55 | return sizeof(u32); | ||
56 | } | ||
57 | |||
58 | static int __devinit octeon_rng_probe(struct platform_device *pdev) | ||
59 | { | ||
60 | struct resource *res_ports; | ||
61 | struct resource *res_result; | ||
62 | struct octeon_rng *rng; | ||
63 | int ret; | ||
64 | struct hwrng ops = { | ||
65 | .name = "octeon", | ||
66 | .init = octeon_rng_init, | ||
67 | .cleanup = octeon_rng_cleanup, | ||
68 | .data_read = octeon_rng_data_read | ||
69 | }; | ||
70 | |||
71 | rng = devm_kzalloc(&pdev->dev, sizeof(*rng), GFP_KERNEL); | ||
72 | if (!rng) | ||
73 | return -ENOMEM; | ||
74 | |||
75 | res_ports = platform_get_resource(pdev, IORESOURCE_MEM, 0); | ||
76 | if (!res_ports) | ||
77 | goto err_ports; | ||
78 | |||
79 | res_result = platform_get_resource(pdev, IORESOURCE_MEM, 1); | ||
80 | if (!res_result) | ||
81 | goto err_ports; | ||
82 | |||
83 | |||
84 | rng->control_status = devm_ioremap_nocache(&pdev->dev, | ||
85 | res_ports->start, | ||
86 | sizeof(u64)); | ||
87 | if (!rng->control_status) | ||
88 | goto err_ports; | ||
89 | |||
90 | rng->result = devm_ioremap_nocache(&pdev->dev, | ||
91 | res_result->start, | ||
92 | sizeof(u64)); | ||
93 | if (!rng->result) | ||
94 | goto err_r; | ||
95 | |||
96 | rng->ops = ops; | ||
97 | |||
98 | dev_set_drvdata(&pdev->dev, &rng->ops); | ||
99 | ret = hwrng_register(&rng->ops); | ||
100 | if (ret) | ||
101 | goto err; | ||
102 | |||
103 | dev_info(&pdev->dev, "Octeon Random Number Generator\n"); | ||
104 | |||
105 | return 0; | ||
106 | err: | ||
107 | devm_iounmap(&pdev->dev, rng->control_status); | ||
108 | err_r: | ||
109 | devm_iounmap(&pdev->dev, rng->result); | ||
110 | err_ports: | ||
111 | devm_kfree(&pdev->dev, rng); | ||
112 | return -ENOENT; | ||
113 | } | ||
114 | |||
115 | static int __exit octeon_rng_remove(struct platform_device *pdev) | ||
116 | { | ||
117 | struct hwrng *rng = dev_get_drvdata(&pdev->dev); | ||
118 | |||
119 | hwrng_unregister(rng); | ||
120 | |||
121 | return 0; | ||
122 | } | ||
123 | |||
124 | static struct platform_driver octeon_rng_driver = { | ||
125 | .driver = { | ||
126 | .name = "octeon_rng", | ||
127 | .owner = THIS_MODULE, | ||
128 | }, | ||
129 | .probe = octeon_rng_probe, | ||
130 | .remove = __exit_p(octeon_rng_remove), | ||
131 | }; | ||
132 | |||
133 | static int __init octeon_rng_mod_init(void) | ||
134 | { | ||
135 | return platform_driver_register(&octeon_rng_driver); | ||
136 | } | ||
137 | |||
138 | static void __exit octeon_rng_mod_exit(void) | ||
139 | { | ||
140 | platform_driver_unregister(&octeon_rng_driver); | ||
141 | } | ||
142 | |||
143 | module_init(octeon_rng_mod_init); | ||
144 | module_exit(octeon_rng_mod_exit); | ||
145 | |||
146 | MODULE_AUTHOR("David Daney"); | ||
147 | MODULE_LICENSE("GPL"); | ||
diff --git a/drivers/char/hw_random/virtio-rng.c b/drivers/char/hw_random/virtio-rng.c index 32216b623248..962968f05b94 100644 --- a/drivers/char/hw_random/virtio-rng.c +++ b/drivers/char/hw_random/virtio-rng.c | |||
@@ -21,6 +21,7 @@ | |||
21 | #include <linux/scatterlist.h> | 21 | #include <linux/scatterlist.h> |
22 | #include <linux/spinlock.h> | 22 | #include <linux/spinlock.h> |
23 | #include <linux/virtio.h> | 23 | #include <linux/virtio.h> |
24 | #include <linux/virtio_ids.h> | ||
24 | #include <linux/virtio_rng.h> | 25 | #include <linux/virtio_rng.h> |
25 | 26 | ||
26 | /* The host will fill any buffer we give it with sweet, sweet randomness. We | 27 | /* The host will fill any buffer we give it with sweet, sweet randomness. We |
@@ -51,7 +52,7 @@ static void register_buffer(void) | |||
51 | 52 | ||
52 | sg_init_one(&sg, random_data+data_left, RANDOM_DATA_SIZE-data_left); | 53 | sg_init_one(&sg, random_data+data_left, RANDOM_DATA_SIZE-data_left); |
53 | /* There should always be room for one buffer. */ | 54 | /* There should always be room for one buffer. */ |
54 | if (vq->vq_ops->add_buf(vq, &sg, 0, 1, random_data) != 0) | 55 | if (vq->vq_ops->add_buf(vq, &sg, 0, 1, random_data) < 0) |
55 | BUG(); | 56 | BUG(); |
56 | vq->vq_ops->kick(vq); | 57 | vq->vq_ops->kick(vq); |
57 | } | 58 | } |
diff --git a/drivers/char/ipmi/ipmi_poweroff.c b/drivers/char/ipmi/ipmi_poweroff.c index a261bd735dfb..2e66b5f773dd 100644 --- a/drivers/char/ipmi/ipmi_poweroff.c +++ b/drivers/char/ipmi/ipmi_poweroff.c | |||
@@ -691,7 +691,7 @@ static struct ctl_table_header *ipmi_table_header; | |||
691 | /* | 691 | /* |
692 | * Startup and shutdown functions. | 692 | * Startup and shutdown functions. |
693 | */ | 693 | */ |
694 | static int ipmi_poweroff_init(void) | 694 | static int __init ipmi_poweroff_init(void) |
695 | { | 695 | { |
696 | int rv; | 696 | int rv; |
697 | 697 | ||
@@ -725,7 +725,7 @@ static int ipmi_poweroff_init(void) | |||
725 | } | 725 | } |
726 | 726 | ||
727 | #ifdef MODULE | 727 | #ifdef MODULE |
728 | static __exit void ipmi_poweroff_cleanup(void) | 728 | static void __exit ipmi_poweroff_cleanup(void) |
729 | { | 729 | { |
730 | int rv; | 730 | int rv; |
731 | 731 | ||
diff --git a/drivers/char/isicom.c b/drivers/char/isicom.c index 4f1f4cd670da..426bfdd7f3e0 100644 --- a/drivers/char/isicom.c +++ b/drivers/char/isicom.c | |||
@@ -846,37 +846,53 @@ static int isicom_carrier_raised(struct tty_port *port) | |||
846 | return (ip->status & ISI_DCD)?1 : 0; | 846 | return (ip->status & ISI_DCD)?1 : 0; |
847 | } | 847 | } |
848 | 848 | ||
849 | static int isicom_open(struct tty_struct *tty, struct file *filp) | 849 | static struct tty_port *isicom_find_port(struct tty_struct *tty) |
850 | { | 850 | { |
851 | struct isi_port *port; | 851 | struct isi_port *port; |
852 | struct isi_board *card; | 852 | struct isi_board *card; |
853 | unsigned int board; | 853 | unsigned int board; |
854 | int error, line; | 854 | int line = tty->index; |
855 | 855 | ||
856 | line = tty->index; | ||
857 | if (line < 0 || line > PORT_COUNT-1) | 856 | if (line < 0 || line > PORT_COUNT-1) |
858 | return -ENODEV; | 857 | return NULL; |
859 | board = BOARD(line); | 858 | board = BOARD(line); |
860 | card = &isi_card[board]; | 859 | card = &isi_card[board]; |
861 | 860 | ||
862 | if (!(card->status & FIRMWARE_LOADED)) | 861 | if (!(card->status & FIRMWARE_LOADED)) |
863 | return -ENODEV; | 862 | return NULL; |
864 | 863 | ||
865 | /* open on a port greater than the port count for the card !!! */ | 864 | /* open on a port greater than the port count for the card !!! */ |
866 | if (line > ((board * 16) + card->port_count - 1)) | 865 | if (line > ((board * 16) + card->port_count - 1)) |
867 | return -ENODEV; | 866 | return NULL; |
868 | 867 | ||
869 | port = &isi_ports[line]; | 868 | port = &isi_ports[line]; |
870 | if (isicom_paranoia_check(port, tty->name, "isicom_open")) | 869 | if (isicom_paranoia_check(port, tty->name, "isicom_open")) |
871 | return -ENODEV; | 870 | return NULL; |
872 | 871 | ||
872 | return &port->port; | ||
873 | } | ||
874 | |||
875 | static int isicom_open(struct tty_struct *tty, struct file *filp) | ||
876 | { | ||
877 | struct isi_port *port; | ||
878 | struct isi_board *card; | ||
879 | struct tty_port *tport; | ||
880 | int error = 0; | ||
881 | |||
882 | tport = isicom_find_port(tty); | ||
883 | if (tport == NULL) | ||
884 | return -ENODEV; | ||
885 | port = container_of(tport, struct isi_port, port); | ||
886 | card = &isi_card[BOARD(tty->index)]; | ||
873 | isicom_setup_board(card); | 887 | isicom_setup_board(card); |
874 | 888 | ||
875 | /* FIXME: locking on port.count etc */ | 889 | /* FIXME: locking on port.count etc */ |
876 | port->port.count++; | 890 | port->port.count++; |
877 | tty->driver_data = port; | 891 | tty->driver_data = port; |
878 | tty_port_tty_set(&port->port, tty); | 892 | tty_port_tty_set(&port->port, tty); |
879 | error = isicom_setup_port(tty); | 893 | /* FIXME: Locking on Initialized flag */ |
894 | if (!test_bit(ASYNCB_INITIALIZED, &tport->flags)) | ||
895 | error = isicom_setup_port(tty); | ||
880 | if (error == 0) | 896 | if (error == 0) |
881 | error = tty_port_block_til_ready(&port->port, tty, filp); | 897 | error = tty_port_block_til_ready(&port->port, tty, filp); |
882 | return error; | 898 | return error; |
@@ -952,19 +968,12 @@ static void isicom_flush_buffer(struct tty_struct *tty) | |||
952 | tty_wakeup(tty); | 968 | tty_wakeup(tty); |
953 | } | 969 | } |
954 | 970 | ||
955 | static void isicom_close(struct tty_struct *tty, struct file *filp) | 971 | static void isicom_close_port(struct tty_port *port) |
956 | { | 972 | { |
957 | struct isi_port *ip = tty->driver_data; | 973 | struct isi_port *ip = container_of(port, struct isi_port, port); |
958 | struct tty_port *port = &ip->port; | 974 | struct isi_board *card = ip->card; |
959 | struct isi_board *card; | ||
960 | unsigned long flags; | 975 | unsigned long flags; |
961 | 976 | ||
962 | BUG_ON(!ip); | ||
963 | |||
964 | card = ip->card; | ||
965 | if (isicom_paranoia_check(ip, tty->name, "isicom_close")) | ||
966 | return; | ||
967 | |||
968 | /* indicate to the card that no more data can be received | 977 | /* indicate to the card that no more data can be received |
969 | on this port */ | 978 | on this port */ |
970 | spin_lock_irqsave(&card->card_lock, flags); | 979 | spin_lock_irqsave(&card->card_lock, flags); |
@@ -974,9 +983,19 @@ static void isicom_close(struct tty_struct *tty, struct file *filp) | |||
974 | } | 983 | } |
975 | isicom_shutdown_port(ip); | 984 | isicom_shutdown_port(ip); |
976 | spin_unlock_irqrestore(&card->card_lock, flags); | 985 | spin_unlock_irqrestore(&card->card_lock, flags); |
986 | } | ||
987 | |||
988 | static void isicom_close(struct tty_struct *tty, struct file *filp) | ||
989 | { | ||
990 | struct isi_port *ip = tty->driver_data; | ||
991 | struct tty_port *port = &ip->port; | ||
992 | if (isicom_paranoia_check(ip, tty->name, "isicom_close")) | ||
993 | return; | ||
977 | 994 | ||
995 | if (tty_port_close_start(port, tty, filp) == 0) | ||
996 | return; | ||
997 | isicom_close_port(port); | ||
978 | isicom_flush_buffer(tty); | 998 | isicom_flush_buffer(tty); |
979 | |||
980 | tty_port_close_end(port, tty); | 999 | tty_port_close_end(port, tty); |
981 | } | 1000 | } |
982 | 1001 | ||
diff --git a/drivers/char/mbcs.c b/drivers/char/mbcs.c index acd8e9ed474a..87c67b42bc08 100644 --- a/drivers/char/mbcs.c +++ b/drivers/char/mbcs.c | |||
@@ -15,6 +15,7 @@ | |||
15 | #include <linux/moduleparam.h> | 15 | #include <linux/moduleparam.h> |
16 | #include <linux/types.h> | 16 | #include <linux/types.h> |
17 | #include <linux/ioport.h> | 17 | #include <linux/ioport.h> |
18 | #include <linux/kernel.h> | ||
18 | #include <linux/notifier.h> | 19 | #include <linux/notifier.h> |
19 | #include <linux/reboot.h> | 20 | #include <linux/reboot.h> |
20 | #include <linux/init.h> | 21 | #include <linux/init.h> |
@@ -715,8 +716,8 @@ static ssize_t show_algo(struct device *dev, struct device_attribute *attr, char | |||
715 | */ | 716 | */ |
716 | debug0 = *(uint64_t *) soft->debug_addr; | 717 | debug0 = *(uint64_t *) soft->debug_addr; |
717 | 718 | ||
718 | return sprintf(buf, "0x%lx 0x%lx\n", | 719 | return sprintf(buf, "0x%x 0x%x\n", |
719 | (debug0 >> 32), (debug0 & 0xffffffff)); | 720 | upper_32_bits(debug0), lower_32_bits(debug0)); |
720 | } | 721 | } |
721 | 722 | ||
722 | static ssize_t store_algo(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) | 723 | static ssize_t store_algo(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) |
diff --git a/drivers/char/mem.c b/drivers/char/mem.c index 645237bda682..a074fceb67d3 100644 --- a/drivers/char/mem.c +++ b/drivers/char/mem.c | |||
@@ -301,7 +301,7 @@ static inline int private_mapping_ok(struct vm_area_struct *vma) | |||
301 | } | 301 | } |
302 | #endif | 302 | #endif |
303 | 303 | ||
304 | static struct vm_operations_struct mmap_mem_ops = { | 304 | static const struct vm_operations_struct mmap_mem_ops = { |
305 | #ifdef CONFIG_HAVE_IOREMAP_PROT | 305 | #ifdef CONFIG_HAVE_IOREMAP_PROT |
306 | .access = generic_access_phys | 306 | .access = generic_access_phys |
307 | #endif | 307 | #endif |
@@ -690,7 +690,7 @@ static ssize_t read_zero(struct file * file, char __user * buf, | |||
690 | 690 | ||
691 | if (chunk > PAGE_SIZE) | 691 | if (chunk > PAGE_SIZE) |
692 | chunk = PAGE_SIZE; /* Just for latency reasons */ | 692 | chunk = PAGE_SIZE; /* Just for latency reasons */ |
693 | unwritten = clear_user(buf, chunk); | 693 | unwritten = __clear_user(buf, chunk); |
694 | written += chunk - unwritten; | 694 | written += chunk - unwritten; |
695 | if (unwritten) | 695 | if (unwritten) |
696 | break; | 696 | break; |
@@ -864,71 +864,75 @@ static const struct file_operations kmsg_fops = { | |||
864 | .write = kmsg_write, | 864 | .write = kmsg_write, |
865 | }; | 865 | }; |
866 | 866 | ||
867 | static const struct { | 867 | static const struct memdev { |
868 | unsigned int minor; | 868 | const char *name; |
869 | char *name; | 869 | mode_t mode; |
870 | umode_t mode; | 870 | const struct file_operations *fops; |
871 | const struct file_operations *fops; | 871 | struct backing_dev_info *dev_info; |
872 | struct backing_dev_info *dev_info; | 872 | } devlist[] = { |
873 | } devlist[] = { /* list of minor devices */ | 873 | [1] = { "mem", 0, &mem_fops, &directly_mappable_cdev_bdi }, |
874 | {1, "mem", S_IRUSR | S_IWUSR | S_IRGRP, &mem_fops, | ||
875 | &directly_mappable_cdev_bdi}, | ||
876 | #ifdef CONFIG_DEVKMEM | 874 | #ifdef CONFIG_DEVKMEM |
877 | {2, "kmem", S_IRUSR | S_IWUSR | S_IRGRP, &kmem_fops, | 875 | [2] = { "kmem", 0, &kmem_fops, &directly_mappable_cdev_bdi }, |
878 | &directly_mappable_cdev_bdi}, | ||
879 | #endif | 876 | #endif |
880 | {3, "null", S_IRUGO | S_IWUGO, &null_fops, NULL}, | 877 | [3] = { "null", 0666, &null_fops, NULL }, |
881 | #ifdef CONFIG_DEVPORT | 878 | #ifdef CONFIG_DEVPORT |
882 | {4, "port", S_IRUSR | S_IWUSR | S_IRGRP, &port_fops, NULL}, | 879 | [4] = { "port", 0, &port_fops, NULL }, |
883 | #endif | 880 | #endif |
884 | {5, "zero", S_IRUGO | S_IWUGO, &zero_fops, &zero_bdi}, | 881 | [5] = { "zero", 0666, &zero_fops, &zero_bdi }, |
885 | {7, "full", S_IRUGO | S_IWUGO, &full_fops, NULL}, | 882 | [7] = { "full", 0666, &full_fops, NULL }, |
886 | {8, "random", S_IRUGO | S_IWUSR, &random_fops, NULL}, | 883 | [8] = { "random", 0666, &random_fops, NULL }, |
887 | {9, "urandom", S_IRUGO | S_IWUSR, &urandom_fops, NULL}, | 884 | [9] = { "urandom", 0666, &urandom_fops, NULL }, |
888 | {11,"kmsg", S_IRUGO | S_IWUSR, &kmsg_fops, NULL}, | 885 | [11] = { "kmsg", 0, &kmsg_fops, NULL }, |
889 | #ifdef CONFIG_CRASH_DUMP | 886 | #ifdef CONFIG_CRASH_DUMP |
890 | {12,"oldmem", S_IRUSR | S_IWUSR | S_IRGRP, &oldmem_fops, NULL}, | 887 | [12] = { "oldmem", 0, &oldmem_fops, NULL }, |
891 | #endif | 888 | #endif |
892 | }; | 889 | }; |
893 | 890 | ||
894 | static int memory_open(struct inode *inode, struct file *filp) | 891 | static int memory_open(struct inode *inode, struct file *filp) |
895 | { | 892 | { |
896 | int ret = 0; | 893 | int minor; |
897 | int i; | 894 | const struct memdev *dev; |
895 | int ret = -ENXIO; | ||
898 | 896 | ||
899 | lock_kernel(); | 897 | lock_kernel(); |
900 | 898 | ||
901 | for (i = 0; i < ARRAY_SIZE(devlist); i++) { | 899 | minor = iminor(inode); |
902 | if (devlist[i].minor == iminor(inode)) { | 900 | if (minor >= ARRAY_SIZE(devlist)) |
903 | filp->f_op = devlist[i].fops; | 901 | goto out; |
904 | if (devlist[i].dev_info) { | ||
905 | filp->f_mapping->backing_dev_info = | ||
906 | devlist[i].dev_info; | ||
907 | } | ||
908 | 902 | ||
909 | break; | 903 | dev = &devlist[minor]; |
910 | } | 904 | if (!dev->fops) |
911 | } | 905 | goto out; |
912 | 906 | ||
913 | if (i == ARRAY_SIZE(devlist)) | 907 | filp->f_op = dev->fops; |
914 | ret = -ENXIO; | 908 | if (dev->dev_info) |
915 | else | 909 | filp->f_mapping->backing_dev_info = dev->dev_info; |
916 | if (filp->f_op && filp->f_op->open) | ||
917 | ret = filp->f_op->open(inode, filp); | ||
918 | 910 | ||
911 | if (dev->fops->open) | ||
912 | ret = dev->fops->open(inode, filp); | ||
913 | else | ||
914 | ret = 0; | ||
915 | out: | ||
919 | unlock_kernel(); | 916 | unlock_kernel(); |
920 | return ret; | 917 | return ret; |
921 | } | 918 | } |
922 | 919 | ||
923 | static const struct file_operations memory_fops = { | 920 | static const struct file_operations memory_fops = { |
924 | .open = memory_open, /* just a selector for the real open */ | 921 | .open = memory_open, |
925 | }; | 922 | }; |
926 | 923 | ||
924 | static char *mem_devnode(struct device *dev, mode_t *mode) | ||
925 | { | ||
926 | if (mode && devlist[MINOR(dev->devt)].mode) | ||
927 | *mode = devlist[MINOR(dev->devt)].mode; | ||
928 | return NULL; | ||
929 | } | ||
930 | |||
927 | static struct class *mem_class; | 931 | static struct class *mem_class; |
928 | 932 | ||
929 | static int __init chr_dev_init(void) | 933 | static int __init chr_dev_init(void) |
930 | { | 934 | { |
931 | int i; | 935 | int minor; |
932 | int err; | 936 | int err; |
933 | 937 | ||
934 | err = bdi_init(&zero_bdi); | 938 | err = bdi_init(&zero_bdi); |
@@ -939,10 +943,13 @@ static int __init chr_dev_init(void) | |||
939 | printk("unable to get major %d for memory devs\n", MEM_MAJOR); | 943 | printk("unable to get major %d for memory devs\n", MEM_MAJOR); |
940 | 944 | ||
941 | mem_class = class_create(THIS_MODULE, "mem"); | 945 | mem_class = class_create(THIS_MODULE, "mem"); |
942 | for (i = 0; i < ARRAY_SIZE(devlist); i++) | 946 | mem_class->devnode = mem_devnode; |
943 | device_create(mem_class, NULL, | 947 | for (minor = 1; minor < ARRAY_SIZE(devlist); minor++) { |
944 | MKDEV(MEM_MAJOR, devlist[i].minor), NULL, | 948 | if (!devlist[minor].name) |
945 | devlist[i].name); | 949 | continue; |
950 | device_create(mem_class, NULL, MKDEV(MEM_MAJOR, minor), | ||
951 | NULL, devlist[minor].name); | ||
952 | } | ||
946 | 953 | ||
947 | return 0; | 954 | return 0; |
948 | } | 955 | } |
diff --git a/drivers/char/misc.c b/drivers/char/misc.c index 62c99fa59e2b..07fa612a58d5 100644 --- a/drivers/char/misc.c +++ b/drivers/char/misc.c | |||
@@ -91,7 +91,7 @@ static int misc_seq_show(struct seq_file *seq, void *v) | |||
91 | } | 91 | } |
92 | 92 | ||
93 | 93 | ||
94 | static struct seq_operations misc_seq_ops = { | 94 | static const struct seq_operations misc_seq_ops = { |
95 | .start = misc_seq_start, | 95 | .start = misc_seq_start, |
96 | .next = misc_seq_next, | 96 | .next = misc_seq_next, |
97 | .stop = misc_seq_stop, | 97 | .stop = misc_seq_stop, |
@@ -263,12 +263,14 @@ int misc_deregister(struct miscdevice *misc) | |||
263 | EXPORT_SYMBOL(misc_register); | 263 | EXPORT_SYMBOL(misc_register); |
264 | EXPORT_SYMBOL(misc_deregister); | 264 | EXPORT_SYMBOL(misc_deregister); |
265 | 265 | ||
266 | static char *misc_nodename(struct device *dev) | 266 | static char *misc_devnode(struct device *dev, mode_t *mode) |
267 | { | 267 | { |
268 | struct miscdevice *c = dev_get_drvdata(dev); | 268 | struct miscdevice *c = dev_get_drvdata(dev); |
269 | 269 | ||
270 | if (c->devnode) | 270 | if (mode && c->mode) |
271 | return kstrdup(c->devnode, GFP_KERNEL); | 271 | *mode = c->mode; |
272 | if (c->nodename) | ||
273 | return kstrdup(c->nodename, GFP_KERNEL); | ||
272 | return NULL; | 274 | return NULL; |
273 | } | 275 | } |
274 | 276 | ||
@@ -287,7 +289,7 @@ static int __init misc_init(void) | |||
287 | err = -EIO; | 289 | err = -EIO; |
288 | if (register_chrdev(MISC_MAJOR,"misc",&misc_fops)) | 290 | if (register_chrdev(MISC_MAJOR,"misc",&misc_fops)) |
289 | goto fail_printk; | 291 | goto fail_printk; |
290 | misc_class->nodename = misc_nodename; | 292 | misc_class->devnode = misc_devnode; |
291 | return 0; | 293 | return 0; |
292 | 294 | ||
293 | fail_printk: | 295 | fail_printk: |
diff --git a/drivers/char/mspec.c b/drivers/char/mspec.c index 30f095a8c2d4..1997270bb6f4 100644 --- a/drivers/char/mspec.c +++ b/drivers/char/mspec.c | |||
@@ -239,7 +239,7 @@ mspec_fault(struct vm_area_struct *vma, struct vm_fault *vmf) | |||
239 | return VM_FAULT_NOPAGE; | 239 | return VM_FAULT_NOPAGE; |
240 | } | 240 | } |
241 | 241 | ||
242 | static struct vm_operations_struct mspec_vm_ops = { | 242 | static const struct vm_operations_struct mspec_vm_ops = { |
243 | .open = mspec_open, | 243 | .open = mspec_open, |
244 | .close = mspec_close, | 244 | .close = mspec_close, |
245 | .fault = mspec_fault, | 245 | .fault = mspec_fault, |
diff --git a/drivers/char/mwave/mwavedd.c b/drivers/char/mwave/mwavedd.c index 94ad2c3bfc4a..a4ec50c95072 100644 --- a/drivers/char/mwave/mwavedd.c +++ b/drivers/char/mwave/mwavedd.c | |||
@@ -281,12 +281,6 @@ static long mwave_ioctl(struct file *file, unsigned int iocmd, | |||
281 | case IOCTL_MW_REGISTER_IPC: { | 281 | case IOCTL_MW_REGISTER_IPC: { |
282 | unsigned int ipcnum = (unsigned int) ioarg; | 282 | unsigned int ipcnum = (unsigned int) ioarg; |
283 | 283 | ||
284 | PRINTK_3(TRACE_MWAVE, | ||
285 | "mwavedd::mwave_ioctl IOCTL_MW_REGISTER_IPC" | ||
286 | " ipcnum %x entry usIntCount %x\n", | ||
287 | ipcnum, | ||
288 | pDrvData->IPCs[ipcnum].usIntCount); | ||
289 | |||
290 | if (ipcnum >= ARRAY_SIZE(pDrvData->IPCs)) { | 284 | if (ipcnum >= ARRAY_SIZE(pDrvData->IPCs)) { |
291 | PRINTK_ERROR(KERN_ERR_MWAVE | 285 | PRINTK_ERROR(KERN_ERR_MWAVE |
292 | "mwavedd::mwave_ioctl:" | 286 | "mwavedd::mwave_ioctl:" |
@@ -295,6 +289,12 @@ static long mwave_ioctl(struct file *file, unsigned int iocmd, | |||
295 | ipcnum); | 289 | ipcnum); |
296 | return -EINVAL; | 290 | return -EINVAL; |
297 | } | 291 | } |
292 | PRINTK_3(TRACE_MWAVE, | ||
293 | "mwavedd::mwave_ioctl IOCTL_MW_REGISTER_IPC" | ||
294 | " ipcnum %x entry usIntCount %x\n", | ||
295 | ipcnum, | ||
296 | pDrvData->IPCs[ipcnum].usIntCount); | ||
297 | |||
298 | lock_kernel(); | 298 | lock_kernel(); |
299 | pDrvData->IPCs[ipcnum].bIsHere = FALSE; | 299 | pDrvData->IPCs[ipcnum].bIsHere = FALSE; |
300 | pDrvData->IPCs[ipcnum].bIsEnabled = TRUE; | 300 | pDrvData->IPCs[ipcnum].bIsEnabled = TRUE; |
@@ -310,11 +310,6 @@ static long mwave_ioctl(struct file *file, unsigned int iocmd, | |||
310 | case IOCTL_MW_GET_IPC: { | 310 | case IOCTL_MW_GET_IPC: { |
311 | unsigned int ipcnum = (unsigned int) ioarg; | 311 | unsigned int ipcnum = (unsigned int) ioarg; |
312 | 312 | ||
313 | PRINTK_3(TRACE_MWAVE, | ||
314 | "mwavedd::mwave_ioctl IOCTL_MW_GET_IPC" | ||
315 | " ipcnum %x, usIntCount %x\n", | ||
316 | ipcnum, | ||
317 | pDrvData->IPCs[ipcnum].usIntCount); | ||
318 | if (ipcnum >= ARRAY_SIZE(pDrvData->IPCs)) { | 313 | if (ipcnum >= ARRAY_SIZE(pDrvData->IPCs)) { |
319 | PRINTK_ERROR(KERN_ERR_MWAVE | 314 | PRINTK_ERROR(KERN_ERR_MWAVE |
320 | "mwavedd::mwave_ioctl:" | 315 | "mwavedd::mwave_ioctl:" |
@@ -322,6 +317,11 @@ static long mwave_ioctl(struct file *file, unsigned int iocmd, | |||
322 | " Invalid ipcnum %x\n", ipcnum); | 317 | " Invalid ipcnum %x\n", ipcnum); |
323 | return -EINVAL; | 318 | return -EINVAL; |
324 | } | 319 | } |
320 | PRINTK_3(TRACE_MWAVE, | ||
321 | "mwavedd::mwave_ioctl IOCTL_MW_GET_IPC" | ||
322 | " ipcnum %x, usIntCount %x\n", | ||
323 | ipcnum, | ||
324 | pDrvData->IPCs[ipcnum].usIntCount); | ||
325 | 325 | ||
326 | lock_kernel(); | 326 | lock_kernel(); |
327 | if (pDrvData->IPCs[ipcnum].bIsEnabled == TRUE) { | 327 | if (pDrvData->IPCs[ipcnum].bIsEnabled == TRUE) { |
diff --git a/drivers/char/mxser.c b/drivers/char/mxser.c index dbf8d52f31d0..5e28d39b9e81 100644 --- a/drivers/char/mxser.c +++ b/drivers/char/mxser.c | |||
@@ -48,7 +48,7 @@ | |||
48 | 48 | ||
49 | #include "mxser.h" | 49 | #include "mxser.h" |
50 | 50 | ||
51 | #define MXSER_VERSION "2.0.4" /* 1.12 */ | 51 | #define MXSER_VERSION "2.0.5" /* 1.14 */ |
52 | #define MXSERMAJOR 174 | 52 | #define MXSERMAJOR 174 |
53 | 53 | ||
54 | #define MXSER_BOARDS 4 /* Max. boards */ | 54 | #define MXSER_BOARDS 4 /* Max. boards */ |
@@ -69,6 +69,7 @@ | |||
69 | #define PCI_DEVICE_ID_POS104UL 0x1044 | 69 | #define PCI_DEVICE_ID_POS104UL 0x1044 |
70 | #define PCI_DEVICE_ID_CB108 0x1080 | 70 | #define PCI_DEVICE_ID_CB108 0x1080 |
71 | #define PCI_DEVICE_ID_CP102UF 0x1023 | 71 | #define PCI_DEVICE_ID_CP102UF 0x1023 |
72 | #define PCI_DEVICE_ID_CP112UL 0x1120 | ||
72 | #define PCI_DEVICE_ID_CB114 0x1142 | 73 | #define PCI_DEVICE_ID_CB114 0x1142 |
73 | #define PCI_DEVICE_ID_CP114UL 0x1143 | 74 | #define PCI_DEVICE_ID_CP114UL 0x1143 |
74 | #define PCI_DEVICE_ID_CB134I 0x1341 | 75 | #define PCI_DEVICE_ID_CB134I 0x1341 |
@@ -139,7 +140,8 @@ static const struct mxser_cardinfo mxser_cards[] = { | |||
139 | { "CP-138U series", 8, }, | 140 | { "CP-138U series", 8, }, |
140 | { "POS-104UL series", 4, }, | 141 | { "POS-104UL series", 4, }, |
141 | { "CP-114UL series", 4, }, | 142 | { "CP-114UL series", 4, }, |
142 | /*30*/ { "CP-102UF series", 2, } | 143 | /*30*/ { "CP-102UF series", 2, }, |
144 | { "CP-112UL series", 2, }, | ||
143 | }; | 145 | }; |
144 | 146 | ||
145 | /* driver_data correspond to the lines in the structure above | 147 | /* driver_data correspond to the lines in the structure above |
@@ -170,6 +172,7 @@ static struct pci_device_id mxser_pcibrds[] = { | |||
170 | { PCI_VDEVICE(MOXA, PCI_DEVICE_ID_POS104UL), .driver_data = 28 }, | 172 | { PCI_VDEVICE(MOXA, PCI_DEVICE_ID_POS104UL), .driver_data = 28 }, |
171 | { PCI_VDEVICE(MOXA, PCI_DEVICE_ID_CP114UL), .driver_data = 29 }, | 173 | { PCI_VDEVICE(MOXA, PCI_DEVICE_ID_CP114UL), .driver_data = 29 }, |
172 | { PCI_VDEVICE(MOXA, PCI_DEVICE_ID_CP102UF), .driver_data = 30 }, | 174 | { PCI_VDEVICE(MOXA, PCI_DEVICE_ID_CP102UF), .driver_data = 30 }, |
175 | { PCI_VDEVICE(MOXA, PCI_DEVICE_ID_CP112UL), .driver_data = 31 }, | ||
173 | { } | 176 | { } |
174 | }; | 177 | }; |
175 | MODULE_DEVICE_TABLE(pci, mxser_pcibrds); | 178 | MODULE_DEVICE_TABLE(pci, mxser_pcibrds); |
@@ -258,7 +261,6 @@ struct mxser_port { | |||
258 | struct mxser_mon mon_data; | 261 | struct mxser_mon mon_data; |
259 | 262 | ||
260 | spinlock_t slock; | 263 | spinlock_t slock; |
261 | wait_queue_head_t delta_msr_wait; | ||
262 | }; | 264 | }; |
263 | 265 | ||
264 | struct mxser_board { | 266 | struct mxser_board { |
@@ -818,7 +820,7 @@ static void mxser_check_modem_status(struct tty_struct *tty, | |||
818 | if (status & UART_MSR_DCTS) | 820 | if (status & UART_MSR_DCTS) |
819 | port->icount.cts++; | 821 | port->icount.cts++; |
820 | port->mon_data.modem_status = status; | 822 | port->mon_data.modem_status = status; |
821 | wake_up_interruptible(&port->delta_msr_wait); | 823 | wake_up_interruptible(&port->port.delta_msr_wait); |
822 | 824 | ||
823 | if ((port->port.flags & ASYNC_CHECK_CD) && (status & UART_MSR_DDCD)) { | 825 | if ((port->port.flags & ASYNC_CHECK_CD) && (status & UART_MSR_DDCD)) { |
824 | if (status & UART_MSR_DCD) | 826 | if (status & UART_MSR_DCD) |
@@ -973,7 +975,7 @@ static void mxser_shutdown(struct tty_struct *tty) | |||
973 | * clear delta_msr_wait queue to avoid mem leaks: we may free the irq | 975 | * clear delta_msr_wait queue to avoid mem leaks: we may free the irq |
974 | * here so the queue might never be waken up | 976 | * here so the queue might never be waken up |
975 | */ | 977 | */ |
976 | wake_up_interruptible(&info->delta_msr_wait); | 978 | wake_up_interruptible(&info->port.delta_msr_wait); |
977 | 979 | ||
978 | /* | 980 | /* |
979 | * Free the IRQ, if necessary | 981 | * Free the IRQ, if necessary |
@@ -1073,34 +1075,17 @@ static void mxser_flush_buffer(struct tty_struct *tty) | |||
1073 | } | 1075 | } |
1074 | 1076 | ||
1075 | 1077 | ||
1076 | /* | 1078 | static void mxser_close_port(struct tty_struct *tty, struct tty_port *port) |
1077 | * This routine is called when the serial port gets closed. First, we | ||
1078 | * wait for the last remaining data to be sent. Then, we unlink its | ||
1079 | * async structure from the interrupt chain if necessary, and we free | ||
1080 | * that IRQ if nothing is left in the chain. | ||
1081 | */ | ||
1082 | static void mxser_close(struct tty_struct *tty, struct file *filp) | ||
1083 | { | 1079 | { |
1084 | struct mxser_port *info = tty->driver_data; | 1080 | struct mxser_port *info = container_of(port, struct mxser_port, port); |
1085 | struct tty_port *port = &info->port; | ||
1086 | |||
1087 | unsigned long timeout; | 1081 | unsigned long timeout; |
1088 | |||
1089 | if (tty->index == MXSER_PORTS) | ||
1090 | return; | ||
1091 | if (!info) | ||
1092 | return; | ||
1093 | |||
1094 | if (tty_port_close_start(port, tty, filp) == 0) | ||
1095 | return; | ||
1096 | |||
1097 | /* | 1082 | /* |
1098 | * Save the termios structure, since this port may have | 1083 | * Save the termios structure, since this port may have |
1099 | * separate termios for callout and dialin. | 1084 | * separate termios for callout and dialin. |
1100 | * | 1085 | * |
1101 | * FIXME: Can this go ? | 1086 | * FIXME: Can this go ? |
1102 | */ | 1087 | */ |
1103 | if (info->port.flags & ASYNC_NORMAL_ACTIVE) | 1088 | if (port->flags & ASYNC_NORMAL_ACTIVE) |
1104 | info->normal_termios = *tty->termios; | 1089 | info->normal_termios = *tty->termios; |
1105 | /* | 1090 | /* |
1106 | * At this point we stop accepting input. To do this, we | 1091 | * At this point we stop accepting input. To do this, we |
@@ -1112,7 +1097,7 @@ static void mxser_close(struct tty_struct *tty, struct file *filp) | |||
1112 | if (info->board->chip_flag) | 1097 | if (info->board->chip_flag) |
1113 | info->IER &= ~MOXA_MUST_RECV_ISR; | 1098 | info->IER &= ~MOXA_MUST_RECV_ISR; |
1114 | 1099 | ||
1115 | if (info->port.flags & ASYNC_INITIALIZED) { | 1100 | if (port->flags & ASYNC_INITIALIZED) { |
1116 | outb(info->IER, info->ioaddr + UART_IER); | 1101 | outb(info->IER, info->ioaddr + UART_IER); |
1117 | /* | 1102 | /* |
1118 | * Before we drop DTR, make sure the UART transmitter | 1103 | * Before we drop DTR, make sure the UART transmitter |
@@ -1127,8 +1112,26 @@ static void mxser_close(struct tty_struct *tty, struct file *filp) | |||
1127 | } | 1112 | } |
1128 | } | 1113 | } |
1129 | mxser_shutdown(tty); | 1114 | mxser_shutdown(tty); |
1130 | mxser_flush_buffer(tty); | ||
1131 | 1115 | ||
1116 | } | ||
1117 | |||
1118 | /* | ||
1119 | * This routine is called when the serial port gets closed. First, we | ||
1120 | * wait for the last remaining data to be sent. Then, we unlink its | ||
1121 | * async structure from the interrupt chain if necessary, and we free | ||
1122 | * that IRQ if nothing is left in the chain. | ||
1123 | */ | ||
1124 | static void mxser_close(struct tty_struct *tty, struct file *filp) | ||
1125 | { | ||
1126 | struct mxser_port *info = tty->driver_data; | ||
1127 | struct tty_port *port = &info->port; | ||
1128 | |||
1129 | if (tty->index == MXSER_PORTS) | ||
1130 | return; | ||
1131 | if (tty_port_close_start(port, tty, filp) == 0) | ||
1132 | return; | ||
1133 | mxser_close_port(tty, port); | ||
1134 | mxser_flush_buffer(tty); | ||
1132 | /* Right now the tty_port set is done outside of the close_end helper | 1135 | /* Right now the tty_port set is done outside of the close_end helper |
1133 | as we don't yet have everyone using refcounts */ | 1136 | as we don't yet have everyone using refcounts */ |
1134 | tty_port_close_end(port, tty); | 1137 | tty_port_close_end(port, tty); |
@@ -1761,7 +1764,7 @@ static int mxser_ioctl(struct tty_struct *tty, struct file *file, | |||
1761 | cnow = info->icount; /* note the counters on entry */ | 1764 | cnow = info->icount; /* note the counters on entry */ |
1762 | spin_unlock_irqrestore(&info->slock, flags); | 1765 | spin_unlock_irqrestore(&info->slock, flags); |
1763 | 1766 | ||
1764 | return wait_event_interruptible(info->delta_msr_wait, | 1767 | return wait_event_interruptible(info->port.delta_msr_wait, |
1765 | mxser_cflags_changed(info, arg, &cnow)); | 1768 | mxser_cflags_changed(info, arg, &cnow)); |
1766 | /* | 1769 | /* |
1767 | * Get counter of input serial line interrupts (DCD,RI,DSR,CTS) | 1770 | * Get counter of input serial line interrupts (DCD,RI,DSR,CTS) |
@@ -1803,7 +1806,7 @@ static int mxser_ioctl(struct tty_struct *tty, struct file *file, | |||
1803 | 1806 | ||
1804 | lock_kernel(); | 1807 | lock_kernel(); |
1805 | len = mxser_chars_in_buffer(tty); | 1808 | len = mxser_chars_in_buffer(tty); |
1806 | lsr = inb(info->ioaddr + UART_LSR) & UART_LSR_TEMT; | 1809 | lsr = inb(info->ioaddr + UART_LSR) & UART_LSR_THRE; |
1807 | len += (lsr ? 0 : 1); | 1810 | len += (lsr ? 0 : 1); |
1808 | unlock_kernel(); | 1811 | unlock_kernel(); |
1809 | 1812 | ||
@@ -2413,7 +2416,6 @@ static int __devinit mxser_initbrd(struct mxser_board *brd, | |||
2413 | info->port.close_delay = 5 * HZ / 10; | 2416 | info->port.close_delay = 5 * HZ / 10; |
2414 | info->port.closing_wait = 30 * HZ; | 2417 | info->port.closing_wait = 30 * HZ; |
2415 | info->normal_termios = mxvar_sdriver->init_termios; | 2418 | info->normal_termios = mxvar_sdriver->init_termios; |
2416 | init_waitqueue_head(&info->delta_msr_wait); | ||
2417 | memset(&info->mon_data, 0, sizeof(struct mxser_mon)); | 2419 | memset(&info->mon_data, 0, sizeof(struct mxser_mon)); |
2418 | info->err_shadow = 0; | 2420 | info->err_shadow = 0; |
2419 | spin_lock_init(&info->slock); | 2421 | spin_lock_init(&info->slock); |
diff --git a/drivers/char/n_tty.c b/drivers/char/n_tty.c index 4e28b35024ec..2e50f4dfc79c 100644 --- a/drivers/char/n_tty.c +++ b/drivers/char/n_tty.c | |||
@@ -272,7 +272,8 @@ static inline int is_continuation(unsigned char c, struct tty_struct *tty) | |||
272 | * | 272 | * |
273 | * This is a helper function that handles one output character | 273 | * This is a helper function that handles one output character |
274 | * (including special characters like TAB, CR, LF, etc.), | 274 | * (including special characters like TAB, CR, LF, etc.), |
275 | * putting the results in the tty driver's write buffer. | 275 | * doing OPOST processing and putting the results in the |
276 | * tty driver's write buffer. | ||
276 | * | 277 | * |
277 | * Note that Linux currently ignores TABDLY, CRDLY, VTDLY, FFDLY | 278 | * Note that Linux currently ignores TABDLY, CRDLY, VTDLY, FFDLY |
278 | * and NLDLY. They simply aren't relevant in the world today. | 279 | * and NLDLY. They simply aren't relevant in the world today. |
@@ -350,8 +351,9 @@ static int do_output_char(unsigned char c, struct tty_struct *tty, int space) | |||
350 | * @c: character (or partial unicode symbol) | 351 | * @c: character (or partial unicode symbol) |
351 | * @tty: terminal device | 352 | * @tty: terminal device |
352 | * | 353 | * |
353 | * Perform OPOST processing. Returns -1 when the output device is | 354 | * Output one character with OPOST processing. |
354 | * full and the character must be retried. | 355 | * Returns -1 when the output device is full and the character |
356 | * must be retried. | ||
355 | * | 357 | * |
356 | * Locking: output_lock to protect column state and space left | 358 | * Locking: output_lock to protect column state and space left |
357 | * (also, this is called from n_tty_write under the | 359 | * (also, this is called from n_tty_write under the |
@@ -377,8 +379,11 @@ static int process_output(unsigned char c, struct tty_struct *tty) | |||
377 | /** | 379 | /** |
378 | * process_output_block - block post processor | 380 | * process_output_block - block post processor |
379 | * @tty: terminal device | 381 | * @tty: terminal device |
380 | * @inbuf: user buffer | 382 | * @buf: character buffer |
381 | * @nr: number of bytes | 383 | * @nr: number of bytes to output |
384 | * | ||
385 | * Output a block of characters with OPOST processing. | ||
386 | * Returns the number of characters output. | ||
382 | * | 387 | * |
383 | * This path is used to speed up block console writes, among other | 388 | * This path is used to speed up block console writes, among other |
384 | * things when processing blocks of output data. It handles only | 389 | * things when processing blocks of output data. It handles only |
@@ -571,33 +576,23 @@ static void process_echoes(struct tty_struct *tty) | |||
571 | break; | 576 | break; |
572 | 577 | ||
573 | default: | 578 | default: |
574 | if (iscntrl(op)) { | ||
575 | if (L_ECHOCTL(tty)) { | ||
576 | /* | ||
577 | * Ensure there is enough space | ||
578 | * for the whole ctrl pair. | ||
579 | */ | ||
580 | if (space < 2) { | ||
581 | no_space_left = 1; | ||
582 | break; | ||
583 | } | ||
584 | tty_put_char(tty, '^'); | ||
585 | tty_put_char(tty, op ^ 0100); | ||
586 | tty->column += 2; | ||
587 | space -= 2; | ||
588 | } else { | ||
589 | if (!space) { | ||
590 | no_space_left = 1; | ||
591 | break; | ||
592 | } | ||
593 | tty_put_char(tty, op); | ||
594 | space--; | ||
595 | } | ||
596 | } | ||
597 | /* | 579 | /* |
598 | * If above falls through, this was an | 580 | * If the op is not a special byte code, |
599 | * undefined op. | 581 | * it is a ctrl char tagged to be echoed |
582 | * as "^X" (where X is the letter | ||
583 | * representing the control char). | ||
584 | * Note that we must ensure there is | ||
585 | * enough space for the whole ctrl pair. | ||
586 | * | ||
600 | */ | 587 | */ |
588 | if (space < 2) { | ||
589 | no_space_left = 1; | ||
590 | break; | ||
591 | } | ||
592 | tty_put_char(tty, '^'); | ||
593 | tty_put_char(tty, op ^ 0100); | ||
594 | tty->column += 2; | ||
595 | space -= 2; | ||
601 | cp += 2; | 596 | cp += 2; |
602 | nr -= 2; | 597 | nr -= 2; |
603 | } | 598 | } |
@@ -605,12 +600,18 @@ static void process_echoes(struct tty_struct *tty) | |||
605 | if (no_space_left) | 600 | if (no_space_left) |
606 | break; | 601 | break; |
607 | } else { | 602 | } else { |
608 | int retval; | 603 | if (O_OPOST(tty) && |
609 | 604 | !(test_bit(TTY_HW_COOK_OUT, &tty->flags))) { | |
610 | retval = do_output_char(c, tty, space); | 605 | int retval = do_output_char(c, tty, space); |
611 | if (retval < 0) | 606 | if (retval < 0) |
612 | break; | 607 | break; |
613 | space -= retval; | 608 | space -= retval; |
609 | } else { | ||
610 | if (!space) | ||
611 | break; | ||
612 | tty_put_char(tty, c); | ||
613 | space -= 1; | ||
614 | } | ||
614 | cp += 1; | 615 | cp += 1; |
615 | nr -= 1; | 616 | nr -= 1; |
616 | } | 617 | } |
@@ -798,8 +799,8 @@ static void echo_char_raw(unsigned char c, struct tty_struct *tty) | |||
798 | * Echo user input back onto the screen. This must be called only when | 799 | * Echo user input back onto the screen. This must be called only when |
799 | * L_ECHO(tty) is true. Called from the driver receive_buf path. | 800 | * L_ECHO(tty) is true. Called from the driver receive_buf path. |
800 | * | 801 | * |
801 | * This variant tags control characters to be possibly echoed as | 802 | * This variant tags control characters to be echoed as "^X" |
802 | * as "^X" (where X is the letter representing the control char). | 803 | * (where X is the letter representing the control char). |
803 | * | 804 | * |
804 | * Locking: echo_lock to protect the echo buffer | 805 | * Locking: echo_lock to protect the echo buffer |
805 | */ | 806 | */ |
@@ -812,7 +813,7 @@ static void echo_char(unsigned char c, struct tty_struct *tty) | |||
812 | add_echo_byte(ECHO_OP_START, tty); | 813 | add_echo_byte(ECHO_OP_START, tty); |
813 | add_echo_byte(ECHO_OP_START, tty); | 814 | add_echo_byte(ECHO_OP_START, tty); |
814 | } else { | 815 | } else { |
815 | if (iscntrl(c) && c != '\t') | 816 | if (L_ECHOCTL(tty) && iscntrl(c) && c != '\t') |
816 | add_echo_byte(ECHO_OP_START, tty); | 817 | add_echo_byte(ECHO_OP_START, tty); |
817 | add_echo_byte(c, tty); | 818 | add_echo_byte(c, tty); |
818 | } | 819 | } |
diff --git a/drivers/char/pcmcia/cm4000_cs.c b/drivers/char/pcmcia/cm4000_cs.c index 881934c068c8..c250a31efa53 100644 --- a/drivers/char/pcmcia/cm4000_cs.c +++ b/drivers/char/pcmcia/cm4000_cs.c | |||
@@ -1017,7 +1017,7 @@ static ssize_t cmm_read(struct file *filp, __user char *buf, size_t count, | |||
1017 | } | 1017 | } |
1018 | } | 1018 | } |
1019 | 1019 | ||
1020 | if (dev->proto == 0 && count > dev->rlen - dev->rpos) { | 1020 | if (dev->proto == 0 && count > dev->rlen - dev->rpos && i) { |
1021 | DEBUGP(4, dev, "T=0 and count > buffer\n"); | 1021 | DEBUGP(4, dev, "T=0 and count > buffer\n"); |
1022 | dev->rbuf[i] = dev->rbuf[i - 1]; | 1022 | dev->rbuf[i] = dev->rbuf[i - 1]; |
1023 | dev->rbuf[i - 1] = dev->procbyte; | 1023 | dev->rbuf[i - 1] = dev->procbyte; |
diff --git a/drivers/char/pcmcia/synclink_cs.c b/drivers/char/pcmcia/synclink_cs.c index 77b364889224..caf6e4d19469 100644 --- a/drivers/char/pcmcia/synclink_cs.c +++ b/drivers/char/pcmcia/synclink_cs.c | |||
@@ -4005,10 +4005,9 @@ static int hdlcdev_attach(struct net_device *dev, unsigned short encoding, | |||
4005 | * | 4005 | * |
4006 | * skb socket buffer containing HDLC frame | 4006 | * skb socket buffer containing HDLC frame |
4007 | * dev pointer to network device structure | 4007 | * dev pointer to network device structure |
4008 | * | ||
4009 | * returns 0 if success, otherwise error code | ||
4010 | */ | 4008 | */ |
4011 | static int hdlcdev_xmit(struct sk_buff *skb, struct net_device *dev) | 4009 | static netdev_tx_t hdlcdev_xmit(struct sk_buff *skb, |
4010 | struct net_device *dev) | ||
4012 | { | 4011 | { |
4013 | MGSLPC_INFO *info = dev_to_port(dev); | 4012 | MGSLPC_INFO *info = dev_to_port(dev); |
4014 | unsigned long flags; | 4013 | unsigned long flags; |
@@ -4043,7 +4042,7 @@ static int hdlcdev_xmit(struct sk_buff *skb, struct net_device *dev) | |||
4043 | } | 4042 | } |
4044 | spin_unlock_irqrestore(&info->lock,flags); | 4043 | spin_unlock_irqrestore(&info->lock,flags); |
4045 | 4044 | ||
4046 | return 0; | 4045 | return NETDEV_TX_OK; |
4047 | } | 4046 | } |
4048 | 4047 | ||
4049 | /** | 4048 | /** |
diff --git a/drivers/char/pty.c b/drivers/char/pty.c index b33d6688e910..53761cefa915 100644 --- a/drivers/char/pty.c +++ b/drivers/char/pty.c | |||
@@ -120,8 +120,10 @@ static int pty_write(struct tty_struct *tty, const unsigned char *buf, int c) | |||
120 | /* Stuff the data into the input queue of the other end */ | 120 | /* Stuff the data into the input queue of the other end */ |
121 | c = tty_insert_flip_string(to, buf, c); | 121 | c = tty_insert_flip_string(to, buf, c); |
122 | /* And shovel */ | 122 | /* And shovel */ |
123 | tty_flip_buffer_push(to); | 123 | if (c) { |
124 | tty_wakeup(tty); | 124 | tty_flip_buffer_push(to); |
125 | tty_wakeup(tty); | ||
126 | } | ||
125 | } | 127 | } |
126 | return c; | 128 | return c; |
127 | } | 129 | } |
diff --git a/drivers/char/random.c b/drivers/char/random.c index d8a9255e1a3f..04b505e5a5e2 100644 --- a/drivers/char/random.c +++ b/drivers/char/random.c | |||
@@ -1231,7 +1231,7 @@ static char sysctl_bootid[16]; | |||
1231 | * as an ASCII string in the standard UUID format. If accesses via the | 1231 | * as an ASCII string in the standard UUID format. If accesses via the |
1232 | * sysctl system call, it is returned as 16 bytes of binary data. | 1232 | * sysctl system call, it is returned as 16 bytes of binary data. |
1233 | */ | 1233 | */ |
1234 | static int proc_do_uuid(ctl_table *table, int write, struct file *filp, | 1234 | static int proc_do_uuid(ctl_table *table, int write, |
1235 | void __user *buffer, size_t *lenp, loff_t *ppos) | 1235 | void __user *buffer, size_t *lenp, loff_t *ppos) |
1236 | { | 1236 | { |
1237 | ctl_table fake_table; | 1237 | ctl_table fake_table; |
@@ -1254,7 +1254,7 @@ static int proc_do_uuid(ctl_table *table, int write, struct file *filp, | |||
1254 | fake_table.data = buf; | 1254 | fake_table.data = buf; |
1255 | fake_table.maxlen = sizeof(buf); | 1255 | fake_table.maxlen = sizeof(buf); |
1256 | 1256 | ||
1257 | return proc_dostring(&fake_table, write, filp, buffer, lenp, ppos); | 1257 | return proc_dostring(&fake_table, write, buffer, lenp, ppos); |
1258 | } | 1258 | } |
1259 | 1259 | ||
1260 | static int uuid_strategy(ctl_table *table, | 1260 | static int uuid_strategy(ctl_table *table, |
diff --git a/drivers/char/raw.c b/drivers/char/raw.c index 05f9d18b9361..64acd05f71c8 100644 --- a/drivers/char/raw.c +++ b/drivers/char/raw.c | |||
@@ -246,7 +246,7 @@ static const struct file_operations raw_fops = { | |||
246 | .read = do_sync_read, | 246 | .read = do_sync_read, |
247 | .aio_read = generic_file_aio_read, | 247 | .aio_read = generic_file_aio_read, |
248 | .write = do_sync_write, | 248 | .write = do_sync_write, |
249 | .aio_write = generic_file_aio_write_nolock, | 249 | .aio_write = blkdev_aio_write, |
250 | .open = raw_open, | 250 | .open = raw_open, |
251 | .release= raw_release, | 251 | .release= raw_release, |
252 | .ioctl = raw_ioctl, | 252 | .ioctl = raw_ioctl, |
@@ -261,7 +261,7 @@ static const struct file_operations raw_ctl_fops = { | |||
261 | 261 | ||
262 | static struct cdev raw_cdev; | 262 | static struct cdev raw_cdev; |
263 | 263 | ||
264 | static char *raw_nodename(struct device *dev) | 264 | static char *raw_devnode(struct device *dev, mode_t *mode) |
265 | { | 265 | { |
266 | return kasprintf(GFP_KERNEL, "raw/%s", dev_name(dev)); | 266 | return kasprintf(GFP_KERNEL, "raw/%s", dev_name(dev)); |
267 | } | 267 | } |
@@ -289,7 +289,7 @@ static int __init raw_init(void) | |||
289 | ret = PTR_ERR(raw_class); | 289 | ret = PTR_ERR(raw_class); |
290 | goto error_region; | 290 | goto error_region; |
291 | } | 291 | } |
292 | raw_class->nodename = raw_nodename; | 292 | raw_class->devnode = raw_devnode; |
293 | device_create(raw_class, NULL, MKDEV(RAW_MAJOR, 0), NULL, "rawctl"); | 293 | device_create(raw_class, NULL, MKDEV(RAW_MAJOR, 0), NULL, "rawctl"); |
294 | 294 | ||
295 | return 0; | 295 | return 0; |
diff --git a/drivers/char/rio/rioctrl.c b/drivers/char/rio/rioctrl.c index eecee0f576d2..74339559f0b9 100644 --- a/drivers/char/rio/rioctrl.c +++ b/drivers/char/rio/rioctrl.c | |||
@@ -873,7 +873,7 @@ int riocontrol(struct rio_info *p, dev_t dev, int cmd, unsigned long arg, int su | |||
873 | /* | 873 | /* |
874 | ** It is important that the product code is an unsigned object! | 874 | ** It is important that the product code is an unsigned object! |
875 | */ | 875 | */ |
876 | if (DownLoad.ProductCode > MAX_PRODUCT) { | 876 | if (DownLoad.ProductCode >= MAX_PRODUCT) { |
877 | rio_dprintk(RIO_DEBUG_CTRL, "RIO_DOWNLOAD: Bad product code %d passed\n", DownLoad.ProductCode); | 877 | rio_dprintk(RIO_DEBUG_CTRL, "RIO_DOWNLOAD: Bad product code %d passed\n", DownLoad.ProductCode); |
878 | p->RIOError.Error = NO_SUCH_PRODUCT; | 878 | p->RIOError.Error = NO_SUCH_PRODUCT; |
879 | return -ENXIO; | 879 | return -ENXIO; |
diff --git a/drivers/char/riscom8.c b/drivers/char/riscom8.c index 171711acf5cd..3cfa22d469e0 100644 --- a/drivers/char/riscom8.c +++ b/drivers/char/riscom8.c | |||
@@ -343,7 +343,7 @@ static void rc_receive_exc(struct riscom_board const *bp) | |||
343 | if (port == NULL) | 343 | if (port == NULL) |
344 | return; | 344 | return; |
345 | 345 | ||
346 | tty = port->port.tty; | 346 | tty = tty_port_tty_get(&port->port); |
347 | 347 | ||
348 | #ifdef RC_REPORT_OVERRUN | 348 | #ifdef RC_REPORT_OVERRUN |
349 | status = rc_in(bp, CD180_RCSR); | 349 | status = rc_in(bp, CD180_RCSR); |
@@ -355,18 +355,18 @@ static void rc_receive_exc(struct riscom_board const *bp) | |||
355 | #endif | 355 | #endif |
356 | ch = rc_in(bp, CD180_RDR); | 356 | ch = rc_in(bp, CD180_RDR); |
357 | if (!status) | 357 | if (!status) |
358 | return; | 358 | goto out; |
359 | if (status & RCSR_TOUT) { | 359 | if (status & RCSR_TOUT) { |
360 | printk(KERN_WARNING "rc%d: port %d: Receiver timeout. " | 360 | printk(KERN_WARNING "rc%d: port %d: Receiver timeout. " |
361 | "Hardware problems ?\n", | 361 | "Hardware problems ?\n", |
362 | board_No(bp), port_No(port)); | 362 | board_No(bp), port_No(port)); |
363 | return; | 363 | goto out; |
364 | 364 | ||
365 | } else if (status & RCSR_BREAK) { | 365 | } else if (status & RCSR_BREAK) { |
366 | printk(KERN_INFO "rc%d: port %d: Handling break...\n", | 366 | printk(KERN_INFO "rc%d: port %d: Handling break...\n", |
367 | board_No(bp), port_No(port)); | 367 | board_No(bp), port_No(port)); |
368 | flag = TTY_BREAK; | 368 | flag = TTY_BREAK; |
369 | if (port->port.flags & ASYNC_SAK) | 369 | if (tty && (port->port.flags & ASYNC_SAK)) |
370 | do_SAK(tty); | 370 | do_SAK(tty); |
371 | 371 | ||
372 | } else if (status & RCSR_PE) | 372 | } else if (status & RCSR_PE) |
@@ -380,8 +380,12 @@ static void rc_receive_exc(struct riscom_board const *bp) | |||
380 | else | 380 | else |
381 | flag = TTY_NORMAL; | 381 | flag = TTY_NORMAL; |
382 | 382 | ||
383 | tty_insert_flip_char(tty, ch, flag); | 383 | if (tty) { |
384 | tty_flip_buffer_push(tty); | 384 | tty_insert_flip_char(tty, ch, flag); |
385 | tty_flip_buffer_push(tty); | ||
386 | } | ||
387 | out: | ||
388 | tty_kref_put(tty); | ||
385 | } | 389 | } |
386 | 390 | ||
387 | static void rc_receive(struct riscom_board const *bp) | 391 | static void rc_receive(struct riscom_board const *bp) |
@@ -394,7 +398,7 @@ static void rc_receive(struct riscom_board const *bp) | |||
394 | if (port == NULL) | 398 | if (port == NULL) |
395 | return; | 399 | return; |
396 | 400 | ||
397 | tty = port->port.tty; | 401 | tty = tty_port_tty_get(&port->port); |
398 | 402 | ||
399 | count = rc_in(bp, CD180_RDCR); | 403 | count = rc_in(bp, CD180_RDCR); |
400 | 404 | ||
@@ -403,15 +407,14 @@ static void rc_receive(struct riscom_board const *bp) | |||
403 | #endif | 407 | #endif |
404 | 408 | ||
405 | while (count--) { | 409 | while (count--) { |
406 | if (tty_buffer_request_room(tty, 1) == 0) { | 410 | u8 ch = rc_in(bp, CD180_RDR); |
407 | printk(KERN_WARNING "rc%d: port %d: Working around " | 411 | if (tty) |
408 | "flip buffer overflow.\n", | 412 | tty_insert_flip_char(tty, ch, TTY_NORMAL); |
409 | board_No(bp), port_No(port)); | 413 | } |
410 | break; | 414 | if (tty) { |
411 | } | 415 | tty_flip_buffer_push(tty); |
412 | tty_insert_flip_char(tty, rc_in(bp, CD180_RDR), TTY_NORMAL); | 416 | tty_kref_put(tty); |
413 | } | 417 | } |
414 | tty_flip_buffer_push(tty); | ||
415 | } | 418 | } |
416 | 419 | ||
417 | static void rc_transmit(struct riscom_board const *bp) | 420 | static void rc_transmit(struct riscom_board const *bp) |
@@ -424,22 +427,22 @@ static void rc_transmit(struct riscom_board const *bp) | |||
424 | if (port == NULL) | 427 | if (port == NULL) |
425 | return; | 428 | return; |
426 | 429 | ||
427 | tty = port->port.tty; | 430 | tty = tty_port_tty_get(&port->port); |
428 | 431 | ||
429 | if (port->IER & IER_TXEMPTY) { | 432 | if (port->IER & IER_TXEMPTY) { |
430 | /* FIFO drained */ | 433 | /* FIFO drained */ |
431 | rc_out(bp, CD180_CAR, port_No(port)); | 434 | rc_out(bp, CD180_CAR, port_No(port)); |
432 | port->IER &= ~IER_TXEMPTY; | 435 | port->IER &= ~IER_TXEMPTY; |
433 | rc_out(bp, CD180_IER, port->IER); | 436 | rc_out(bp, CD180_IER, port->IER); |
434 | return; | 437 | goto out; |
435 | } | 438 | } |
436 | 439 | ||
437 | if ((port->xmit_cnt <= 0 && !port->break_length) | 440 | if ((port->xmit_cnt <= 0 && !port->break_length) |
438 | || tty->stopped || tty->hw_stopped) { | 441 | || (tty && (tty->stopped || tty->hw_stopped))) { |
439 | rc_out(bp, CD180_CAR, port_No(port)); | 442 | rc_out(bp, CD180_CAR, port_No(port)); |
440 | port->IER &= ~IER_TXRDY; | 443 | port->IER &= ~IER_TXRDY; |
441 | rc_out(bp, CD180_IER, port->IER); | 444 | rc_out(bp, CD180_IER, port->IER); |
442 | return; | 445 | goto out; |
443 | } | 446 | } |
444 | 447 | ||
445 | if (port->break_length) { | 448 | if (port->break_length) { |
@@ -464,7 +467,7 @@ static void rc_transmit(struct riscom_board const *bp) | |||
464 | rc_out(bp, CD180_CCR, CCR_CORCHG2); | 467 | rc_out(bp, CD180_CCR, CCR_CORCHG2); |
465 | port->break_length = 0; | 468 | port->break_length = 0; |
466 | } | 469 | } |
467 | return; | 470 | goto out; |
468 | } | 471 | } |
469 | 472 | ||
470 | count = CD180_NFIFO; | 473 | count = CD180_NFIFO; |
@@ -480,8 +483,10 @@ static void rc_transmit(struct riscom_board const *bp) | |||
480 | port->IER &= ~IER_TXRDY; | 483 | port->IER &= ~IER_TXRDY; |
481 | rc_out(bp, CD180_IER, port->IER); | 484 | rc_out(bp, CD180_IER, port->IER); |
482 | } | 485 | } |
483 | if (port->xmit_cnt <= port->wakeup_chars) | 486 | if (tty && port->xmit_cnt <= port->wakeup_chars) |
484 | tty_wakeup(tty); | 487 | tty_wakeup(tty); |
488 | out: | ||
489 | tty_kref_put(tty); | ||
485 | } | 490 | } |
486 | 491 | ||
487 | static void rc_check_modem(struct riscom_board const *bp) | 492 | static void rc_check_modem(struct riscom_board const *bp) |
@@ -494,37 +499,43 @@ static void rc_check_modem(struct riscom_board const *bp) | |||
494 | if (port == NULL) | 499 | if (port == NULL) |
495 | return; | 500 | return; |
496 | 501 | ||
497 | tty = port->port.tty; | 502 | tty = tty_port_tty_get(&port->port); |
498 | 503 | ||
499 | mcr = rc_in(bp, CD180_MCR); | 504 | mcr = rc_in(bp, CD180_MCR); |
500 | if (mcr & MCR_CDCHG) { | 505 | if (mcr & MCR_CDCHG) { |
501 | if (rc_in(bp, CD180_MSVR) & MSVR_CD) | 506 | if (rc_in(bp, CD180_MSVR) & MSVR_CD) |
502 | wake_up_interruptible(&port->port.open_wait); | 507 | wake_up_interruptible(&port->port.open_wait); |
503 | else | 508 | else if (tty) |
504 | tty_hangup(tty); | 509 | tty_hangup(tty); |
505 | } | 510 | } |
506 | 511 | ||
507 | #ifdef RISCOM_BRAIN_DAMAGED_CTS | 512 | #ifdef RISCOM_BRAIN_DAMAGED_CTS |
508 | if (mcr & MCR_CTSCHG) { | 513 | if (mcr & MCR_CTSCHG) { |
509 | if (rc_in(bp, CD180_MSVR) & MSVR_CTS) { | 514 | if (rc_in(bp, CD180_MSVR) & MSVR_CTS) { |
510 | tty->hw_stopped = 0; | ||
511 | port->IER |= IER_TXRDY; | 515 | port->IER |= IER_TXRDY; |
512 | if (port->xmit_cnt <= port->wakeup_chars) | 516 | if (tty) { |
513 | tty_wakeup(tty); | 517 | tty->hw_stopped = 0; |
518 | if (port->xmit_cnt <= port->wakeup_chars) | ||
519 | tty_wakeup(tty); | ||
520 | } | ||
514 | } else { | 521 | } else { |
515 | tty->hw_stopped = 1; | 522 | if (tty) |
523 | tty->hw_stopped = 1; | ||
516 | port->IER &= ~IER_TXRDY; | 524 | port->IER &= ~IER_TXRDY; |
517 | } | 525 | } |
518 | rc_out(bp, CD180_IER, port->IER); | 526 | rc_out(bp, CD180_IER, port->IER); |
519 | } | 527 | } |
520 | if (mcr & MCR_DSRCHG) { | 528 | if (mcr & MCR_DSRCHG) { |
521 | if (rc_in(bp, CD180_MSVR) & MSVR_DSR) { | 529 | if (rc_in(bp, CD180_MSVR) & MSVR_DSR) { |
522 | tty->hw_stopped = 0; | ||
523 | port->IER |= IER_TXRDY; | 530 | port->IER |= IER_TXRDY; |
524 | if (port->xmit_cnt <= port->wakeup_chars) | 531 | if (tty) { |
525 | tty_wakeup(tty); | 532 | tty->hw_stopped = 0; |
533 | if (port->xmit_cnt <= port->wakeup_chars) | ||
534 | tty_wakeup(tty); | ||
535 | } | ||
526 | } else { | 536 | } else { |
527 | tty->hw_stopped = 1; | 537 | if (tty) |
538 | tty->hw_stopped = 1; | ||
528 | port->IER &= ~IER_TXRDY; | 539 | port->IER &= ~IER_TXRDY; |
529 | } | 540 | } |
530 | rc_out(bp, CD180_IER, port->IER); | 541 | rc_out(bp, CD180_IER, port->IER); |
@@ -533,6 +544,7 @@ static void rc_check_modem(struct riscom_board const *bp) | |||
533 | 544 | ||
534 | /* Clear change bits */ | 545 | /* Clear change bits */ |
535 | rc_out(bp, CD180_MCR, 0); | 546 | rc_out(bp, CD180_MCR, 0); |
547 | tty_kref_put(tty); | ||
536 | } | 548 | } |
537 | 549 | ||
538 | /* The main interrupt processing routine */ | 550 | /* The main interrupt processing routine */ |
@@ -632,9 +644,9 @@ static void rc_shutdown_board(struct riscom_board *bp) | |||
632 | * Setting up port characteristics. | 644 | * Setting up port characteristics. |
633 | * Must be called with disabled interrupts | 645 | * Must be called with disabled interrupts |
634 | */ | 646 | */ |
635 | static void rc_change_speed(struct riscom_board *bp, struct riscom_port *port) | 647 | static void rc_change_speed(struct tty_struct *tty, struct riscom_board *bp, |
648 | struct riscom_port *port) | ||
636 | { | 649 | { |
637 | struct tty_struct *tty = port->port.tty; | ||
638 | unsigned long baud; | 650 | unsigned long baud; |
639 | long tmp; | 651 | long tmp; |
640 | unsigned char cor1 = 0, cor3 = 0; | 652 | unsigned char cor1 = 0, cor3 = 0; |
@@ -781,7 +793,8 @@ static void rc_change_speed(struct riscom_board *bp, struct riscom_port *port) | |||
781 | } | 793 | } |
782 | 794 | ||
783 | /* Must be called with interrupts enabled */ | 795 | /* Must be called with interrupts enabled */ |
784 | static int rc_setup_port(struct riscom_board *bp, struct riscom_port *port) | 796 | static int rc_setup_port(struct tty_struct *tty, struct riscom_board *bp, |
797 | struct riscom_port *port) | ||
785 | { | 798 | { |
786 | unsigned long flags; | 799 | unsigned long flags; |
787 | 800 | ||
@@ -793,11 +806,11 @@ static int rc_setup_port(struct riscom_board *bp, struct riscom_port *port) | |||
793 | 806 | ||
794 | spin_lock_irqsave(&riscom_lock, flags); | 807 | spin_lock_irqsave(&riscom_lock, flags); |
795 | 808 | ||
796 | clear_bit(TTY_IO_ERROR, &port->port.tty->flags); | 809 | clear_bit(TTY_IO_ERROR, &tty->flags); |
797 | if (port->port.count == 1) | 810 | if (port->port.count == 1) |
798 | bp->count++; | 811 | bp->count++; |
799 | port->xmit_cnt = port->xmit_head = port->xmit_tail = 0; | 812 | port->xmit_cnt = port->xmit_head = port->xmit_tail = 0; |
800 | rc_change_speed(bp, port); | 813 | rc_change_speed(tty, bp, port); |
801 | port->port.flags |= ASYNC_INITIALIZED; | 814 | port->port.flags |= ASYNC_INITIALIZED; |
802 | 815 | ||
803 | spin_unlock_irqrestore(&riscom_lock, flags); | 816 | spin_unlock_irqrestore(&riscom_lock, flags); |
@@ -898,9 +911,9 @@ static int rc_open(struct tty_struct *tty, struct file *filp) | |||
898 | 911 | ||
899 | port->port.count++; | 912 | port->port.count++; |
900 | tty->driver_data = port; | 913 | tty->driver_data = port; |
901 | port->port.tty = tty; | 914 | tty_port_tty_set(&port->port, tty); |
902 | 915 | ||
903 | error = rc_setup_port(bp, port); | 916 | error = rc_setup_port(tty, bp, port); |
904 | if (error == 0) | 917 | if (error == 0) |
905 | error = tty_port_block_til_ready(&port->port, tty, filp); | 918 | error = tty_port_block_til_ready(&port->port, tty, filp); |
906 | return error; | 919 | return error; |
@@ -921,20 +934,12 @@ static void rc_flush_buffer(struct tty_struct *tty) | |||
921 | tty_wakeup(tty); | 934 | tty_wakeup(tty); |
922 | } | 935 | } |
923 | 936 | ||
924 | static void rc_close(struct tty_struct *tty, struct file *filp) | 937 | static void rc_close_port(struct tty_port *port) |
925 | { | 938 | { |
926 | struct riscom_port *port = tty->driver_data; | ||
927 | struct riscom_board *bp; | ||
928 | unsigned long flags; | 939 | unsigned long flags; |
940 | struct riscom_port *rp = container_of(port, struct riscom_port, port); | ||
941 | struct riscom_board *bp = port_Board(rp); | ||
929 | unsigned long timeout; | 942 | unsigned long timeout; |
930 | |||
931 | if (!port || rc_paranoia_check(port, tty->name, "close")) | ||
932 | return; | ||
933 | |||
934 | bp = port_Board(port); | ||
935 | |||
936 | if (tty_port_close_start(&port->port, tty, filp) == 0) | ||
937 | return; | ||
938 | 943 | ||
939 | /* | 944 | /* |
940 | * At this point we stop accepting input. To do this, we | 945 | * At this point we stop accepting input. To do this, we |
@@ -944,31 +949,37 @@ static void rc_close(struct tty_struct *tty, struct file *filp) | |||
944 | */ | 949 | */ |
945 | 950 | ||
946 | spin_lock_irqsave(&riscom_lock, flags); | 951 | spin_lock_irqsave(&riscom_lock, flags); |
947 | port->IER &= ~IER_RXD; | 952 | rp->IER &= ~IER_RXD; |
948 | if (port->port.flags & ASYNC_INITIALIZED) { | 953 | if (port->flags & ASYNC_INITIALIZED) { |
949 | port->IER &= ~IER_TXRDY; | 954 | rp->IER &= ~IER_TXRDY; |
950 | port->IER |= IER_TXEMPTY; | 955 | rp->IER |= IER_TXEMPTY; |
951 | rc_out(bp, CD180_CAR, port_No(port)); | 956 | rc_out(bp, CD180_CAR, port_No(rp)); |
952 | rc_out(bp, CD180_IER, port->IER); | 957 | rc_out(bp, CD180_IER, rp->IER); |
953 | /* | 958 | /* |
954 | * Before we drop DTR, make sure the UART transmitter | 959 | * Before we drop DTR, make sure the UART transmitter |
955 | * has completely drained; this is especially | 960 | * has completely drained; this is especially |
956 | * important if there is a transmit FIFO! | 961 | * important if there is a transmit FIFO! |
957 | */ | 962 | */ |
958 | timeout = jiffies + HZ; | 963 | timeout = jiffies + HZ; |
959 | while (port->IER & IER_TXEMPTY) { | 964 | while (rp->IER & IER_TXEMPTY) { |
960 | spin_unlock_irqrestore(&riscom_lock, flags); | 965 | spin_unlock_irqrestore(&riscom_lock, flags); |
961 | msleep_interruptible(jiffies_to_msecs(port->timeout)); | 966 | msleep_interruptible(jiffies_to_msecs(rp->timeout)); |
962 | spin_lock_irqsave(&riscom_lock, flags); | 967 | spin_lock_irqsave(&riscom_lock, flags); |
963 | if (time_after(jiffies, timeout)) | 968 | if (time_after(jiffies, timeout)) |
964 | break; | 969 | break; |
965 | } | 970 | } |
966 | } | 971 | } |
967 | rc_shutdown_port(tty, bp, port); | 972 | rc_shutdown_port(port->tty, bp, rp); |
968 | rc_flush_buffer(tty); | ||
969 | spin_unlock_irqrestore(&riscom_lock, flags); | 973 | spin_unlock_irqrestore(&riscom_lock, flags); |
974 | } | ||
975 | |||
976 | static void rc_close(struct tty_struct *tty, struct file *filp) | ||
977 | { | ||
978 | struct riscom_port *port = tty->driver_data; | ||
970 | 979 | ||
971 | tty_port_close_end(&port->port, tty); | 980 | if (!port || rc_paranoia_check(port, tty->name, "close")) |
981 | return; | ||
982 | tty_port_close(&port->port, tty, filp); | ||
972 | } | 983 | } |
973 | 984 | ||
974 | static int rc_write(struct tty_struct *tty, | 985 | static int rc_write(struct tty_struct *tty, |
@@ -1170,7 +1181,7 @@ static int rc_send_break(struct tty_struct *tty, int length) | |||
1170 | return 0; | 1181 | return 0; |
1171 | } | 1182 | } |
1172 | 1183 | ||
1173 | static int rc_set_serial_info(struct riscom_port *port, | 1184 | static int rc_set_serial_info(struct tty_struct *tty, struct riscom_port *port, |
1174 | struct serial_struct __user *newinfo) | 1185 | struct serial_struct __user *newinfo) |
1175 | { | 1186 | { |
1176 | struct serial_struct tmp; | 1187 | struct serial_struct tmp; |
@@ -1180,17 +1191,6 @@ static int rc_set_serial_info(struct riscom_port *port, | |||
1180 | if (copy_from_user(&tmp, newinfo, sizeof(tmp))) | 1191 | if (copy_from_user(&tmp, newinfo, sizeof(tmp))) |
1181 | return -EFAULT; | 1192 | return -EFAULT; |
1182 | 1193 | ||
1183 | #if 0 | ||
1184 | if ((tmp.irq != bp->irq) || | ||
1185 | (tmp.port != bp->base) || | ||
1186 | (tmp.type != PORT_CIRRUS) || | ||
1187 | (tmp.baud_base != (RC_OSCFREQ + CD180_TPC/2) / CD180_TPC) || | ||
1188 | (tmp.custom_divisor != 0) || | ||
1189 | (tmp.xmit_fifo_size != CD180_NFIFO) || | ||
1190 | (tmp.flags & ~RISCOM_LEGAL_FLAGS)) | ||
1191 | return -EINVAL; | ||
1192 | #endif | ||
1193 | |||
1194 | change_speed = ((port->port.flags & ASYNC_SPD_MASK) != | 1194 | change_speed = ((port->port.flags & ASYNC_SPD_MASK) != |
1195 | (tmp.flags & ASYNC_SPD_MASK)); | 1195 | (tmp.flags & ASYNC_SPD_MASK)); |
1196 | 1196 | ||
@@ -1212,7 +1212,7 @@ static int rc_set_serial_info(struct riscom_port *port, | |||
1212 | unsigned long flags; | 1212 | unsigned long flags; |
1213 | 1213 | ||
1214 | spin_lock_irqsave(&riscom_lock, flags); | 1214 | spin_lock_irqsave(&riscom_lock, flags); |
1215 | rc_change_speed(bp, port); | 1215 | rc_change_speed(tty, bp, port); |
1216 | spin_unlock_irqrestore(&riscom_lock, flags); | 1216 | spin_unlock_irqrestore(&riscom_lock, flags); |
1217 | } | 1217 | } |
1218 | return 0; | 1218 | return 0; |
@@ -1255,7 +1255,7 @@ static int rc_ioctl(struct tty_struct *tty, struct file *filp, | |||
1255 | break; | 1255 | break; |
1256 | case TIOCSSERIAL: | 1256 | case TIOCSSERIAL: |
1257 | lock_kernel(); | 1257 | lock_kernel(); |
1258 | retval = rc_set_serial_info(port, argp); | 1258 | retval = rc_set_serial_info(tty, port, argp); |
1259 | unlock_kernel(); | 1259 | unlock_kernel(); |
1260 | break; | 1260 | break; |
1261 | default: | 1261 | default: |
@@ -1350,21 +1350,12 @@ static void rc_start(struct tty_struct *tty) | |||
1350 | static void rc_hangup(struct tty_struct *tty) | 1350 | static void rc_hangup(struct tty_struct *tty) |
1351 | { | 1351 | { |
1352 | struct riscom_port *port = tty->driver_data; | 1352 | struct riscom_port *port = tty->driver_data; |
1353 | struct riscom_board *bp; | ||
1354 | unsigned long flags; | ||
1355 | 1353 | ||
1356 | if (rc_paranoia_check(port, tty->name, "rc_hangup")) | 1354 | if (rc_paranoia_check(port, tty->name, "rc_hangup")) |
1357 | return; | 1355 | return; |
1358 | 1356 | ||
1359 | bp = port_Board(port); | 1357 | rc_shutdown_port(tty, port_Board(port), port); |
1360 | 1358 | tty_port_hangup(&port->port); | |
1361 | rc_shutdown_port(tty, bp, port); | ||
1362 | spin_lock_irqsave(&port->port.lock, flags); | ||
1363 | port->port.count = 0; | ||
1364 | port->port.flags &= ~ASYNC_NORMAL_ACTIVE; | ||
1365 | port->port.tty = NULL; | ||
1366 | wake_up_interruptible(&port->port.open_wait); | ||
1367 | spin_unlock_irqrestore(&port->port.lock, flags); | ||
1368 | } | 1359 | } |
1369 | 1360 | ||
1370 | static void rc_set_termios(struct tty_struct *tty, | 1361 | static void rc_set_termios(struct tty_struct *tty, |
@@ -1377,7 +1368,7 @@ static void rc_set_termios(struct tty_struct *tty, | |||
1377 | return; | 1368 | return; |
1378 | 1369 | ||
1379 | spin_lock_irqsave(&riscom_lock, flags); | 1370 | spin_lock_irqsave(&riscom_lock, flags); |
1380 | rc_change_speed(port_Board(port), port); | 1371 | rc_change_speed(tty, port_Board(port), port); |
1381 | spin_unlock_irqrestore(&riscom_lock, flags); | 1372 | spin_unlock_irqrestore(&riscom_lock, flags); |
1382 | 1373 | ||
1383 | if ((old_termios->c_cflag & CRTSCTS) && | 1374 | if ((old_termios->c_cflag & CRTSCTS) && |
@@ -1410,6 +1401,7 @@ static const struct tty_operations riscom_ops = { | |||
1410 | 1401 | ||
1411 | static const struct tty_port_operations riscom_port_ops = { | 1402 | static const struct tty_port_operations riscom_port_ops = { |
1412 | .carrier_raised = carrier_raised, | 1403 | .carrier_raised = carrier_raised, |
1404 | .shutdown = rc_close_port, | ||
1413 | }; | 1405 | }; |
1414 | 1406 | ||
1415 | 1407 | ||
diff --git a/drivers/char/serial167.c b/drivers/char/serial167.c index 51e7a46787be..5942a9d674c0 100644 --- a/drivers/char/serial167.c +++ b/drivers/char/serial167.c | |||
@@ -171,7 +171,6 @@ static int startup(struct cyclades_port *); | |||
171 | static void cy_throttle(struct tty_struct *); | 171 | static void cy_throttle(struct tty_struct *); |
172 | static void cy_unthrottle(struct tty_struct *); | 172 | static void cy_unthrottle(struct tty_struct *); |
173 | static void config_setup(struct cyclades_port *); | 173 | static void config_setup(struct cyclades_port *); |
174 | extern void console_print(const char *); | ||
175 | #ifdef CYCLOM_SHOW_STATUS | 174 | #ifdef CYCLOM_SHOW_STATUS |
176 | static void show_status(int); | 175 | static void show_status(int); |
177 | #endif | 176 | #endif |
@@ -245,7 +244,7 @@ void SP(char *data) | |||
245 | { | 244 | { |
246 | unsigned long flags; | 245 | unsigned long flags; |
247 | local_irq_save(flags); | 246 | local_irq_save(flags); |
248 | console_print(data); | 247 | printk(KERN_EMERG "%s", data); |
249 | local_irq_restore(flags); | 248 | local_irq_restore(flags); |
250 | } | 249 | } |
251 | 250 | ||
@@ -255,7 +254,7 @@ void CP(char data) | |||
255 | unsigned long flags; | 254 | unsigned long flags; |
256 | local_irq_save(flags); | 255 | local_irq_save(flags); |
257 | scrn[0] = data; | 256 | scrn[0] = data; |
258 | console_print(scrn); | 257 | printk(KERN_EMERG "%c", scrn); |
259 | local_irq_restore(flags); | 258 | local_irq_restore(flags); |
260 | } /* CP */ | 259 | } /* CP */ |
261 | 260 | ||
diff --git a/drivers/char/synclink.c b/drivers/char/synclink.c index 813552f14884..4846b73ef28d 100644 --- a/drivers/char/synclink.c +++ b/drivers/char/synclink.c | |||
@@ -7697,10 +7697,9 @@ static int hdlcdev_attach(struct net_device *dev, unsigned short encoding, | |||
7697 | * | 7697 | * |
7698 | * skb socket buffer containing HDLC frame | 7698 | * skb socket buffer containing HDLC frame |
7699 | * dev pointer to network device structure | 7699 | * dev pointer to network device structure |
7700 | * | ||
7701 | * returns 0 if success, otherwise error code | ||
7702 | */ | 7700 | */ |
7703 | static int hdlcdev_xmit(struct sk_buff *skb, struct net_device *dev) | 7701 | static netdev_tx_t hdlcdev_xmit(struct sk_buff *skb, |
7702 | struct net_device *dev) | ||
7704 | { | 7703 | { |
7705 | struct mgsl_struct *info = dev_to_port(dev); | 7704 | struct mgsl_struct *info = dev_to_port(dev); |
7706 | unsigned long flags; | 7705 | unsigned long flags; |
@@ -7731,7 +7730,7 @@ static int hdlcdev_xmit(struct sk_buff *skb, struct net_device *dev) | |||
7731 | usc_start_transmitter(info); | 7730 | usc_start_transmitter(info); |
7732 | spin_unlock_irqrestore(&info->irq_spinlock,flags); | 7731 | spin_unlock_irqrestore(&info->irq_spinlock,flags); |
7733 | 7732 | ||
7734 | return 0; | 7733 | return NETDEV_TX_OK; |
7735 | } | 7734 | } |
7736 | 7735 | ||
7737 | /** | 7736 | /** |
diff --git a/drivers/char/synclink_gt.c b/drivers/char/synclink_gt.c index 91f20a92fddf..8678f0c8699d 100644 --- a/drivers/char/synclink_gt.c +++ b/drivers/char/synclink_gt.c | |||
@@ -1497,10 +1497,9 @@ static int hdlcdev_attach(struct net_device *dev, unsigned short encoding, | |||
1497 | * | 1497 | * |
1498 | * skb socket buffer containing HDLC frame | 1498 | * skb socket buffer containing HDLC frame |
1499 | * dev pointer to network device structure | 1499 | * dev pointer to network device structure |
1500 | * | ||
1501 | * returns 0 if success, otherwise error code | ||
1502 | */ | 1500 | */ |
1503 | static int hdlcdev_xmit(struct sk_buff *skb, struct net_device *dev) | 1501 | static netdev_tx_t hdlcdev_xmit(struct sk_buff *skb, |
1502 | struct net_device *dev) | ||
1504 | { | 1503 | { |
1505 | struct slgt_info *info = dev_to_port(dev); | 1504 | struct slgt_info *info = dev_to_port(dev); |
1506 | unsigned long flags; | 1505 | unsigned long flags; |
@@ -1529,7 +1528,7 @@ static int hdlcdev_xmit(struct sk_buff *skb, struct net_device *dev) | |||
1529 | update_tx_timer(info); | 1528 | update_tx_timer(info); |
1530 | spin_unlock_irqrestore(&info->lock,flags); | 1529 | spin_unlock_irqrestore(&info->lock,flags); |
1531 | 1530 | ||
1532 | return 0; | 1531 | return NETDEV_TX_OK; |
1533 | } | 1532 | } |
1534 | 1533 | ||
1535 | /** | 1534 | /** |
diff --git a/drivers/char/synclinkmp.c b/drivers/char/synclinkmp.c index 8d4a2a8a0a70..2b18adc4ee19 100644 --- a/drivers/char/synclinkmp.c +++ b/drivers/char/synclinkmp.c | |||
@@ -1608,10 +1608,9 @@ static int hdlcdev_attach(struct net_device *dev, unsigned short encoding, | |||
1608 | * | 1608 | * |
1609 | * skb socket buffer containing HDLC frame | 1609 | * skb socket buffer containing HDLC frame |
1610 | * dev pointer to network device structure | 1610 | * dev pointer to network device structure |
1611 | * | ||
1612 | * returns 0 if success, otherwise error code | ||
1613 | */ | 1611 | */ |
1614 | static int hdlcdev_xmit(struct sk_buff *skb, struct net_device *dev) | 1612 | static netdev_tx_t hdlcdev_xmit(struct sk_buff *skb, |
1613 | struct net_device *dev) | ||
1615 | { | 1614 | { |
1616 | SLMP_INFO *info = dev_to_port(dev); | 1615 | SLMP_INFO *info = dev_to_port(dev); |
1617 | unsigned long flags; | 1616 | unsigned long flags; |
@@ -1642,7 +1641,7 @@ static int hdlcdev_xmit(struct sk_buff *skb, struct net_device *dev) | |||
1642 | tx_start(info); | 1641 | tx_start(info); |
1643 | spin_unlock_irqrestore(&info->lock,flags); | 1642 | spin_unlock_irqrestore(&info->lock,flags); |
1644 | 1643 | ||
1645 | return 0; | 1644 | return NETDEV_TX_OK; |
1646 | } | 1645 | } |
1647 | 1646 | ||
1648 | /** | 1647 | /** |
diff --git a/drivers/char/sysrq.c b/drivers/char/sysrq.c index 50eecfe1d724..44203ff599da 100644 --- a/drivers/char/sysrq.c +++ b/drivers/char/sysrq.c | |||
@@ -26,7 +26,7 @@ | |||
26 | #include <linux/proc_fs.h> | 26 | #include <linux/proc_fs.h> |
27 | #include <linux/nmi.h> | 27 | #include <linux/nmi.h> |
28 | #include <linux/quotaops.h> | 28 | #include <linux/quotaops.h> |
29 | #include <linux/perf_counter.h> | 29 | #include <linux/perf_event.h> |
30 | #include <linux/kernel.h> | 30 | #include <linux/kernel.h> |
31 | #include <linux/module.h> | 31 | #include <linux/module.h> |
32 | #include <linux/suspend.h> | 32 | #include <linux/suspend.h> |
@@ -252,7 +252,7 @@ static void sysrq_handle_showregs(int key, struct tty_struct *tty) | |||
252 | struct pt_regs *regs = get_irq_regs(); | 252 | struct pt_regs *regs = get_irq_regs(); |
253 | if (regs) | 253 | if (regs) |
254 | show_regs(regs); | 254 | show_regs(regs); |
255 | perf_counter_print_debug(); | 255 | perf_event_print_debug(); |
256 | } | 256 | } |
257 | static struct sysrq_key_op sysrq_showregs_op = { | 257 | static struct sysrq_key_op sysrq_showregs_op = { |
258 | .handler = sysrq_handle_showregs, | 258 | .handler = sysrq_handle_showregs, |
diff --git a/drivers/char/tpm/tpm.c b/drivers/char/tpm/tpm.c index f4c68abf2a15..aeafac5bde8c 100644 --- a/drivers/char/tpm/tpm.c +++ b/drivers/char/tpm/tpm.c | |||
@@ -696,7 +696,7 @@ int __tpm_pcr_read(struct tpm_chip *chip, int pcr_idx, u8 *res_buf) | |||
696 | 696 | ||
697 | cmd.header.in = pcrread_header; | 697 | cmd.header.in = pcrread_header; |
698 | cmd.params.pcrread_in.pcr_idx = cpu_to_be32(pcr_idx); | 698 | cmd.params.pcrread_in.pcr_idx = cpu_to_be32(pcr_idx); |
699 | BUILD_BUG_ON(cmd.header.in.length > READ_PCR_RESULT_SIZE); | 699 | BUG_ON(cmd.header.in.length > READ_PCR_RESULT_SIZE); |
700 | rc = transmit_cmd(chip, &cmd, cmd.header.in.length, | 700 | rc = transmit_cmd(chip, &cmd, cmd.header.in.length, |
701 | "attempting to read a pcr value"); | 701 | "attempting to read a pcr value"); |
702 | 702 | ||
@@ -742,7 +742,7 @@ EXPORT_SYMBOL_GPL(tpm_pcr_read); | |||
742 | * the module usage count. | 742 | * the module usage count. |
743 | */ | 743 | */ |
744 | #define TPM_ORD_PCR_EXTEND cpu_to_be32(20) | 744 | #define TPM_ORD_PCR_EXTEND cpu_to_be32(20) |
745 | #define EXTEND_PCR_SIZE 34 | 745 | #define EXTEND_PCR_RESULT_SIZE 34 |
746 | static struct tpm_input_header pcrextend_header = { | 746 | static struct tpm_input_header pcrextend_header = { |
747 | .tag = TPM_TAG_RQU_COMMAND, | 747 | .tag = TPM_TAG_RQU_COMMAND, |
748 | .length = cpu_to_be32(34), | 748 | .length = cpu_to_be32(34), |
@@ -760,10 +760,9 @@ int tpm_pcr_extend(u32 chip_num, int pcr_idx, const u8 *hash) | |||
760 | return -ENODEV; | 760 | return -ENODEV; |
761 | 761 | ||
762 | cmd.header.in = pcrextend_header; | 762 | cmd.header.in = pcrextend_header; |
763 | BUILD_BUG_ON(be32_to_cpu(cmd.header.in.length) > EXTEND_PCR_SIZE); | ||
764 | cmd.params.pcrextend_in.pcr_idx = cpu_to_be32(pcr_idx); | 763 | cmd.params.pcrextend_in.pcr_idx = cpu_to_be32(pcr_idx); |
765 | memcpy(cmd.params.pcrextend_in.hash, hash, TPM_DIGEST_SIZE); | 764 | memcpy(cmd.params.pcrextend_in.hash, hash, TPM_DIGEST_SIZE); |
766 | rc = transmit_cmd(chip, &cmd, cmd.header.in.length, | 765 | rc = transmit_cmd(chip, &cmd, EXTEND_PCR_RESULT_SIZE, |
767 | "attempting extend a PCR value"); | 766 | "attempting extend a PCR value"); |
768 | 767 | ||
769 | module_put(chip->dev->driver->owner); | 768 | module_put(chip->dev->driver->owner); |
diff --git a/drivers/char/tpm/tpm_bios.c b/drivers/char/tpm/tpm_bios.c index 0c2f55a38b95..bf2170fb1cdd 100644 --- a/drivers/char/tpm/tpm_bios.c +++ b/drivers/char/tpm/tpm_bios.c | |||
@@ -343,14 +343,14 @@ static int tpm_ascii_bios_measurements_show(struct seq_file *m, void *v) | |||
343 | return 0; | 343 | return 0; |
344 | } | 344 | } |
345 | 345 | ||
346 | static struct seq_operations tpm_ascii_b_measurments_seqops = { | 346 | static const struct seq_operations tpm_ascii_b_measurments_seqops = { |
347 | .start = tpm_bios_measurements_start, | 347 | .start = tpm_bios_measurements_start, |
348 | .next = tpm_bios_measurements_next, | 348 | .next = tpm_bios_measurements_next, |
349 | .stop = tpm_bios_measurements_stop, | 349 | .stop = tpm_bios_measurements_stop, |
350 | .show = tpm_ascii_bios_measurements_show, | 350 | .show = tpm_ascii_bios_measurements_show, |
351 | }; | 351 | }; |
352 | 352 | ||
353 | static struct seq_operations tpm_binary_b_measurments_seqops = { | 353 | static const struct seq_operations tpm_binary_b_measurments_seqops = { |
354 | .start = tpm_bios_measurements_start, | 354 | .start = tpm_bios_measurements_start, |
355 | .next = tpm_bios_measurements_next, | 355 | .next = tpm_bios_measurements_next, |
356 | .stop = tpm_bios_measurements_stop, | 356 | .stop = tpm_bios_measurements_stop, |
diff --git a/drivers/char/tty_io.c b/drivers/char/tty_io.c index a3afa0c387cd..59499ee0fe6a 100644 --- a/drivers/char/tty_io.c +++ b/drivers/char/tty_io.c | |||
@@ -1184,6 +1184,7 @@ int tty_init_termios(struct tty_struct *tty) | |||
1184 | tty->termios->c_ospeed = tty_termios_baud_rate(tty->termios); | 1184 | tty->termios->c_ospeed = tty_termios_baud_rate(tty->termios); |
1185 | return 0; | 1185 | return 0; |
1186 | } | 1186 | } |
1187 | EXPORT_SYMBOL_GPL(tty_init_termios); | ||
1187 | 1188 | ||
1188 | /** | 1189 | /** |
1189 | * tty_driver_install_tty() - install a tty entry in the driver | 1190 | * tty_driver_install_tty() - install a tty entry in the driver |
@@ -1386,16 +1387,19 @@ EXPORT_SYMBOL(tty_shutdown); | |||
1386 | * tty_mutex - sometimes only | 1387 | * tty_mutex - sometimes only |
1387 | * takes the file list lock internally when working on the list | 1388 | * takes the file list lock internally when working on the list |
1388 | * of ttys that the driver keeps. | 1389 | * of ttys that the driver keeps. |
1390 | * | ||
1391 | * This method gets called from a work queue so that the driver private | ||
1392 | * cleanup ops can sleep (needed for USB at least) | ||
1389 | */ | 1393 | */ |
1390 | static void release_one_tty(struct kref *kref) | 1394 | static void release_one_tty(struct work_struct *work) |
1391 | { | 1395 | { |
1392 | struct tty_struct *tty = container_of(kref, struct tty_struct, kref); | 1396 | struct tty_struct *tty = |
1397 | container_of(work, struct tty_struct, hangup_work); | ||
1393 | struct tty_driver *driver = tty->driver; | 1398 | struct tty_driver *driver = tty->driver; |
1394 | 1399 | ||
1395 | if (tty->ops->shutdown) | 1400 | if (tty->ops->cleanup) |
1396 | tty->ops->shutdown(tty); | 1401 | tty->ops->cleanup(tty); |
1397 | else | 1402 | |
1398 | tty_shutdown(tty); | ||
1399 | tty->magic = 0; | 1403 | tty->magic = 0; |
1400 | tty_driver_kref_put(driver); | 1404 | tty_driver_kref_put(driver); |
1401 | module_put(driver->owner); | 1405 | module_put(driver->owner); |
@@ -1407,6 +1411,21 @@ static void release_one_tty(struct kref *kref) | |||
1407 | free_tty_struct(tty); | 1411 | free_tty_struct(tty); |
1408 | } | 1412 | } |
1409 | 1413 | ||
1414 | static void queue_release_one_tty(struct kref *kref) | ||
1415 | { | ||
1416 | struct tty_struct *tty = container_of(kref, struct tty_struct, kref); | ||
1417 | |||
1418 | if (tty->ops->shutdown) | ||
1419 | tty->ops->shutdown(tty); | ||
1420 | else | ||
1421 | tty_shutdown(tty); | ||
1422 | |||
1423 | /* The hangup queue is now free so we can reuse it rather than | ||
1424 | waste a chunk of memory for each port */ | ||
1425 | INIT_WORK(&tty->hangup_work, release_one_tty); | ||
1426 | schedule_work(&tty->hangup_work); | ||
1427 | } | ||
1428 | |||
1410 | /** | 1429 | /** |
1411 | * tty_kref_put - release a tty kref | 1430 | * tty_kref_put - release a tty kref |
1412 | * @tty: tty device | 1431 | * @tty: tty device |
@@ -1418,7 +1437,7 @@ static void release_one_tty(struct kref *kref) | |||
1418 | void tty_kref_put(struct tty_struct *tty) | 1437 | void tty_kref_put(struct tty_struct *tty) |
1419 | { | 1438 | { |
1420 | if (tty) | 1439 | if (tty) |
1421 | kref_put(&tty->kref, release_one_tty); | 1440 | kref_put(&tty->kref, queue_release_one_tty); |
1422 | } | 1441 | } |
1423 | EXPORT_SYMBOL(tty_kref_put); | 1442 | EXPORT_SYMBOL(tty_kref_put); |
1424 | 1443 | ||
@@ -2085,7 +2104,7 @@ static int tioccons(struct file *file) | |||
2085 | * the generic functionality existed. This piece of history is preserved | 2104 | * the generic functionality existed. This piece of history is preserved |
2086 | * in the expected tty API of posix OS's. | 2105 | * in the expected tty API of posix OS's. |
2087 | * | 2106 | * |
2088 | * Locking: none, the open fle handle ensures it won't go away. | 2107 | * Locking: none, the open file handle ensures it won't go away. |
2089 | */ | 2108 | */ |
2090 | 2109 | ||
2091 | static int fionbio(struct file *file, int __user *p) | 2110 | static int fionbio(struct file *file, int __user *p) |
@@ -3056,11 +3075,22 @@ void __init console_init(void) | |||
3056 | } | 3075 | } |
3057 | } | 3076 | } |
3058 | 3077 | ||
3078 | static char *tty_devnode(struct device *dev, mode_t *mode) | ||
3079 | { | ||
3080 | if (!mode) | ||
3081 | return NULL; | ||
3082 | if (dev->devt == MKDEV(TTYAUX_MAJOR, 0) || | ||
3083 | dev->devt == MKDEV(TTYAUX_MAJOR, 2)) | ||
3084 | *mode = 0666; | ||
3085 | return NULL; | ||
3086 | } | ||
3087 | |||
3059 | static int __init tty_class_init(void) | 3088 | static int __init tty_class_init(void) |
3060 | { | 3089 | { |
3061 | tty_class = class_create(THIS_MODULE, "tty"); | 3090 | tty_class = class_create(THIS_MODULE, "tty"); |
3062 | if (IS_ERR(tty_class)) | 3091 | if (IS_ERR(tty_class)) |
3063 | return PTR_ERR(tty_class); | 3092 | return PTR_ERR(tty_class); |
3093 | tty_class->devnode = tty_devnode; | ||
3064 | return 0; | 3094 | return 0; |
3065 | } | 3095 | } |
3066 | 3096 | ||
diff --git a/drivers/char/tty_ioctl.c b/drivers/char/tty_ioctl.c index ad6ba4ed2808..8e67d5c642a4 100644 --- a/drivers/char/tty_ioctl.c +++ b/drivers/char/tty_ioctl.c | |||
@@ -393,9 +393,7 @@ void tty_termios_encode_baud_rate(struct ktermios *termios, | |||
393 | termios->c_cflag |= (BOTHER << IBSHIFT); | 393 | termios->c_cflag |= (BOTHER << IBSHIFT); |
394 | #else | 394 | #else |
395 | if (ifound == -1 || ofound == -1) { | 395 | if (ifound == -1 || ofound == -1) { |
396 | static int warned; | 396 | printk_once(KERN_WARNING "tty: Unable to return correct " |
397 | if (!warned++) | ||
398 | printk(KERN_WARNING "tty: Unable to return correct " | ||
399 | "speed data as your architecture needs updating.\n"); | 397 | "speed data as your architecture needs updating.\n"); |
400 | } | 398 | } |
401 | #endif | 399 | #endif |
diff --git a/drivers/char/tty_ldisc.c b/drivers/char/tty_ldisc.c index e48af9f79219..aafdbaebc16a 100644 --- a/drivers/char/tty_ldisc.c +++ b/drivers/char/tty_ldisc.c | |||
@@ -145,48 +145,33 @@ int tty_unregister_ldisc(int disc) | |||
145 | } | 145 | } |
146 | EXPORT_SYMBOL(tty_unregister_ldisc); | 146 | EXPORT_SYMBOL(tty_unregister_ldisc); |
147 | 147 | ||
148 | 148 | static struct tty_ldisc_ops *get_ldops(int disc) | |
149 | /** | ||
150 | * tty_ldisc_try_get - try and reference an ldisc | ||
151 | * @disc: ldisc number | ||
152 | * | ||
153 | * Attempt to open and lock a line discipline into place. Return | ||
154 | * the line discipline refcounted or an error. | ||
155 | */ | ||
156 | |||
157 | static struct tty_ldisc *tty_ldisc_try_get(int disc) | ||
158 | { | 149 | { |
159 | unsigned long flags; | 150 | unsigned long flags; |
160 | struct tty_ldisc *ld; | 151 | struct tty_ldisc_ops *ldops, *ret; |
161 | struct tty_ldisc_ops *ldops; | ||
162 | int err = -EINVAL; | ||
163 | |||
164 | ld = kmalloc(sizeof(struct tty_ldisc), GFP_KERNEL); | ||
165 | if (ld == NULL) | ||
166 | return ERR_PTR(-ENOMEM); | ||
167 | 152 | ||
168 | spin_lock_irqsave(&tty_ldisc_lock, flags); | 153 | spin_lock_irqsave(&tty_ldisc_lock, flags); |
169 | ld->ops = NULL; | 154 | ret = ERR_PTR(-EINVAL); |
170 | ldops = tty_ldiscs[disc]; | 155 | ldops = tty_ldiscs[disc]; |
171 | /* Check the entry is defined */ | ||
172 | if (ldops) { | 156 | if (ldops) { |
173 | /* If the module is being unloaded we can't use it */ | 157 | ret = ERR_PTR(-EAGAIN); |
174 | if (!try_module_get(ldops->owner)) | 158 | if (try_module_get(ldops->owner)) { |
175 | err = -EAGAIN; | ||
176 | else { | ||
177 | /* lock it */ | ||
178 | ldops->refcount++; | 159 | ldops->refcount++; |
179 | ld->ops = ldops; | 160 | ret = ldops; |
180 | atomic_set(&ld->users, 1); | ||
181 | err = 0; | ||
182 | } | 161 | } |
183 | } | 162 | } |
184 | spin_unlock_irqrestore(&tty_ldisc_lock, flags); | 163 | spin_unlock_irqrestore(&tty_ldisc_lock, flags); |
185 | if (err) { | 164 | return ret; |
186 | kfree(ld); | 165 | } |
187 | return ERR_PTR(err); | 166 | |
188 | } | 167 | static void put_ldops(struct tty_ldisc_ops *ldops) |
189 | return ld; | 168 | { |
169 | unsigned long flags; | ||
170 | |||
171 | spin_lock_irqsave(&tty_ldisc_lock, flags); | ||
172 | ldops->refcount--; | ||
173 | module_put(ldops->owner); | ||
174 | spin_unlock_irqrestore(&tty_ldisc_lock, flags); | ||
190 | } | 175 | } |
191 | 176 | ||
192 | /** | 177 | /** |
@@ -205,14 +190,31 @@ static struct tty_ldisc *tty_ldisc_try_get(int disc) | |||
205 | static struct tty_ldisc *tty_ldisc_get(int disc) | 190 | static struct tty_ldisc *tty_ldisc_get(int disc) |
206 | { | 191 | { |
207 | struct tty_ldisc *ld; | 192 | struct tty_ldisc *ld; |
193 | struct tty_ldisc_ops *ldops; | ||
208 | 194 | ||
209 | if (disc < N_TTY || disc >= NR_LDISCS) | 195 | if (disc < N_TTY || disc >= NR_LDISCS) |
210 | return ERR_PTR(-EINVAL); | 196 | return ERR_PTR(-EINVAL); |
211 | ld = tty_ldisc_try_get(disc); | 197 | |
212 | if (IS_ERR(ld)) { | 198 | /* |
199 | * Get the ldisc ops - we may need to request them to be loaded | ||
200 | * dynamically and try again. | ||
201 | */ | ||
202 | ldops = get_ldops(disc); | ||
203 | if (IS_ERR(ldops)) { | ||
213 | request_module("tty-ldisc-%d", disc); | 204 | request_module("tty-ldisc-%d", disc); |
214 | ld = tty_ldisc_try_get(disc); | 205 | ldops = get_ldops(disc); |
206 | if (IS_ERR(ldops)) | ||
207 | return ERR_CAST(ldops); | ||
215 | } | 208 | } |
209 | |||
210 | ld = kmalloc(sizeof(struct tty_ldisc), GFP_KERNEL); | ||
211 | if (ld == NULL) { | ||
212 | put_ldops(ldops); | ||
213 | return ERR_PTR(-ENOMEM); | ||
214 | } | ||
215 | |||
216 | ld->ops = ldops; | ||
217 | atomic_set(&ld->users, 1); | ||
216 | return ld; | 218 | return ld; |
217 | } | 219 | } |
218 | 220 | ||
@@ -234,13 +236,13 @@ static void tty_ldiscs_seq_stop(struct seq_file *m, void *v) | |||
234 | static int tty_ldiscs_seq_show(struct seq_file *m, void *v) | 236 | static int tty_ldiscs_seq_show(struct seq_file *m, void *v) |
235 | { | 237 | { |
236 | int i = *(loff_t *)v; | 238 | int i = *(loff_t *)v; |
237 | struct tty_ldisc *ld; | 239 | struct tty_ldisc_ops *ldops; |
238 | 240 | ||
239 | ld = tty_ldisc_try_get(i); | 241 | ldops = get_ldops(i); |
240 | if (IS_ERR(ld)) | 242 | if (IS_ERR(ldops)) |
241 | return 0; | 243 | return 0; |
242 | seq_printf(m, "%-10s %2d\n", ld->ops->name ? ld->ops->name : "???", i); | 244 | seq_printf(m, "%-10s %2d\n", ldops->name ? ldops->name : "???", i); |
243 | put_ldisc(ld); | 245 | put_ldops(ldops); |
244 | return 0; | 246 | return 0; |
245 | } | 247 | } |
246 | 248 | ||
diff --git a/drivers/char/tty_port.c b/drivers/char/tty_port.c index 9769b1149f76..a4bbb28f10be 100644 --- a/drivers/char/tty_port.c +++ b/drivers/char/tty_port.c | |||
@@ -23,6 +23,7 @@ void tty_port_init(struct tty_port *port) | |||
23 | memset(port, 0, sizeof(*port)); | 23 | memset(port, 0, sizeof(*port)); |
24 | init_waitqueue_head(&port->open_wait); | 24 | init_waitqueue_head(&port->open_wait); |
25 | init_waitqueue_head(&port->close_wait); | 25 | init_waitqueue_head(&port->close_wait); |
26 | init_waitqueue_head(&port->delta_msr_wait); | ||
26 | mutex_init(&port->mutex); | 27 | mutex_init(&port->mutex); |
27 | spin_lock_init(&port->lock); | 28 | spin_lock_init(&port->lock); |
28 | port->close_delay = (50 * HZ) / 100; | 29 | port->close_delay = (50 * HZ) / 100; |
@@ -96,6 +97,14 @@ void tty_port_tty_set(struct tty_port *port, struct tty_struct *tty) | |||
96 | } | 97 | } |
97 | EXPORT_SYMBOL(tty_port_tty_set); | 98 | EXPORT_SYMBOL(tty_port_tty_set); |
98 | 99 | ||
100 | static void tty_port_shutdown(struct tty_port *port) | ||
101 | { | ||
102 | if (port->ops->shutdown && | ||
103 | test_and_clear_bit(ASYNCB_INITIALIZED, &port->flags)) | ||
104 | port->ops->shutdown(port); | ||
105 | |||
106 | } | ||
107 | |||
99 | /** | 108 | /** |
100 | * tty_port_hangup - hangup helper | 109 | * tty_port_hangup - hangup helper |
101 | * @port: tty port | 110 | * @port: tty port |
@@ -116,6 +125,8 @@ void tty_port_hangup(struct tty_port *port) | |||
116 | port->tty = NULL; | 125 | port->tty = NULL; |
117 | spin_unlock_irqrestore(&port->lock, flags); | 126 | spin_unlock_irqrestore(&port->lock, flags); |
118 | wake_up_interruptible(&port->open_wait); | 127 | wake_up_interruptible(&port->open_wait); |
128 | wake_up_interruptible(&port->delta_msr_wait); | ||
129 | tty_port_shutdown(port); | ||
119 | } | 130 | } |
120 | EXPORT_SYMBOL(tty_port_hangup); | 131 | EXPORT_SYMBOL(tty_port_hangup); |
121 | 132 | ||
@@ -296,15 +307,17 @@ int tty_port_close_start(struct tty_port *port, struct tty_struct *tty, struct f | |||
296 | 307 | ||
297 | if (port->count) { | 308 | if (port->count) { |
298 | spin_unlock_irqrestore(&port->lock, flags); | 309 | spin_unlock_irqrestore(&port->lock, flags); |
310 | if (port->ops->drop) | ||
311 | port->ops->drop(port); | ||
299 | return 0; | 312 | return 0; |
300 | } | 313 | } |
301 | port->flags |= ASYNC_CLOSING; | 314 | set_bit(ASYNCB_CLOSING, &port->flags); |
302 | tty->closing = 1; | 315 | tty->closing = 1; |
303 | spin_unlock_irqrestore(&port->lock, flags); | 316 | spin_unlock_irqrestore(&port->lock, flags); |
304 | /* Don't block on a stalled port, just pull the chain */ | 317 | /* Don't block on a stalled port, just pull the chain */ |
305 | if (tty->flow_stopped) | 318 | if (tty->flow_stopped) |
306 | tty_driver_flush_buffer(tty); | 319 | tty_driver_flush_buffer(tty); |
307 | if (port->flags & ASYNC_INITIALIZED && | 320 | if (test_bit(ASYNCB_INITIALIZED, &port->flags) && |
308 | port->closing_wait != ASYNC_CLOSING_WAIT_NONE) | 321 | port->closing_wait != ASYNC_CLOSING_WAIT_NONE) |
309 | tty_wait_until_sent(tty, port->closing_wait); | 322 | tty_wait_until_sent(tty, port->closing_wait); |
310 | if (port->drain_delay) { | 323 | if (port->drain_delay) { |
@@ -318,6 +331,9 @@ int tty_port_close_start(struct tty_port *port, struct tty_struct *tty, struct f | |||
318 | timeout = 2 * HZ; | 331 | timeout = 2 * HZ; |
319 | schedule_timeout_interruptible(timeout); | 332 | schedule_timeout_interruptible(timeout); |
320 | } | 333 | } |
334 | /* Don't call port->drop for the last reference. Callers will want | ||
335 | to drop the last active reference in ->shutdown() or the tty | ||
336 | shutdown path */ | ||
321 | return 1; | 337 | return 1; |
322 | } | 338 | } |
323 | EXPORT_SYMBOL(tty_port_close_start); | 339 | EXPORT_SYMBOL(tty_port_close_start); |
@@ -348,3 +364,14 @@ void tty_port_close_end(struct tty_port *port, struct tty_struct *tty) | |||
348 | spin_unlock_irqrestore(&port->lock, flags); | 364 | spin_unlock_irqrestore(&port->lock, flags); |
349 | } | 365 | } |
350 | EXPORT_SYMBOL(tty_port_close_end); | 366 | EXPORT_SYMBOL(tty_port_close_end); |
367 | |||
368 | void tty_port_close(struct tty_port *port, struct tty_struct *tty, | ||
369 | struct file *filp) | ||
370 | { | ||
371 | if (tty_port_close_start(port, tty, filp) == 0) | ||
372 | return; | ||
373 | tty_port_shutdown(port); | ||
374 | tty_port_close_end(port, tty); | ||
375 | tty_port_tty_set(port, NULL); | ||
376 | } | ||
377 | EXPORT_SYMBOL(tty_port_close); | ||
diff --git a/drivers/char/uv_mmtimer.c b/drivers/char/uv_mmtimer.c new file mode 100644 index 000000000000..867b67be9f0a --- /dev/null +++ b/drivers/char/uv_mmtimer.c | |||
@@ -0,0 +1,216 @@ | |||
1 | /* | ||
2 | * Timer device implementation for SGI UV platform. | ||
3 | * | ||
4 | * This file is subject to the terms and conditions of the GNU General Public | ||
5 | * License. See the file "COPYING" in the main directory of this archive | ||
6 | * for more details. | ||
7 | * | ||
8 | * Copyright (c) 2009 Silicon Graphics, Inc. All rights reserved. | ||
9 | * | ||
10 | */ | ||
11 | |||
12 | #include <linux/types.h> | ||
13 | #include <linux/kernel.h> | ||
14 | #include <linux/ioctl.h> | ||
15 | #include <linux/module.h> | ||
16 | #include <linux/init.h> | ||
17 | #include <linux/errno.h> | ||
18 | #include <linux/mm.h> | ||
19 | #include <linux/fs.h> | ||
20 | #include <linux/mmtimer.h> | ||
21 | #include <linux/miscdevice.h> | ||
22 | #include <linux/posix-timers.h> | ||
23 | #include <linux/interrupt.h> | ||
24 | #include <linux/time.h> | ||
25 | #include <linux/math64.h> | ||
26 | #include <linux/smp_lock.h> | ||
27 | |||
28 | #include <asm/genapic.h> | ||
29 | #include <asm/uv/uv_hub.h> | ||
30 | #include <asm/uv/bios.h> | ||
31 | #include <asm/uv/uv.h> | ||
32 | |||
33 | MODULE_AUTHOR("Dimitri Sivanich <sivanich@sgi.com>"); | ||
34 | MODULE_DESCRIPTION("SGI UV Memory Mapped RTC Timer"); | ||
35 | MODULE_LICENSE("GPL"); | ||
36 | |||
37 | /* name of the device, usually in /dev */ | ||
38 | #define UV_MMTIMER_NAME "mmtimer" | ||
39 | #define UV_MMTIMER_DESC "SGI UV Memory Mapped RTC Timer" | ||
40 | #define UV_MMTIMER_VERSION "1.0" | ||
41 | |||
42 | static long uv_mmtimer_ioctl(struct file *file, unsigned int cmd, | ||
43 | unsigned long arg); | ||
44 | static int uv_mmtimer_mmap(struct file *file, struct vm_area_struct *vma); | ||
45 | |||
46 | /* | ||
47 | * Period in femtoseconds (10^-15 s) | ||
48 | */ | ||
49 | static unsigned long uv_mmtimer_femtoperiod; | ||
50 | |||
51 | static const struct file_operations uv_mmtimer_fops = { | ||
52 | .owner = THIS_MODULE, | ||
53 | .mmap = uv_mmtimer_mmap, | ||
54 | .unlocked_ioctl = uv_mmtimer_ioctl, | ||
55 | }; | ||
56 | |||
57 | /** | ||
58 | * uv_mmtimer_ioctl - ioctl interface for /dev/uv_mmtimer | ||
59 | * @file: file structure for the device | ||
60 | * @cmd: command to execute | ||
61 | * @arg: optional argument to command | ||
62 | * | ||
63 | * Executes the command specified by @cmd. Returns 0 for success, < 0 for | ||
64 | * failure. | ||
65 | * | ||
66 | * Valid commands: | ||
67 | * | ||
68 | * %MMTIMER_GETOFFSET - Should return the offset (relative to the start | ||
69 | * of the page where the registers are mapped) for the counter in question. | ||
70 | * | ||
71 | * %MMTIMER_GETRES - Returns the resolution of the clock in femto (10^-15) | ||
72 | * seconds | ||
73 | * | ||
74 | * %MMTIMER_GETFREQ - Copies the frequency of the clock in Hz to the address | ||
75 | * specified by @arg | ||
76 | * | ||
77 | * %MMTIMER_GETBITS - Returns the number of bits in the clock's counter | ||
78 | * | ||
79 | * %MMTIMER_MMAPAVAIL - Returns 1 if registers can be mmap'd into userspace | ||
80 | * | ||
81 | * %MMTIMER_GETCOUNTER - Gets the current value in the counter and places it | ||
82 | * in the address specified by @arg. | ||
83 | */ | ||
84 | static long uv_mmtimer_ioctl(struct file *file, unsigned int cmd, | ||
85 | unsigned long arg) | ||
86 | { | ||
87 | int ret = 0; | ||
88 | |||
89 | switch (cmd) { | ||
90 | case MMTIMER_GETOFFSET: /* offset of the counter */ | ||
91 | /* | ||
92 | * UV RTC register is on its own page | ||
93 | */ | ||
94 | if (PAGE_SIZE <= (1 << 16)) | ||
95 | ret = ((UV_LOCAL_MMR_BASE | UVH_RTC) & (PAGE_SIZE-1)) | ||
96 | / 8; | ||
97 | else | ||
98 | ret = -ENOSYS; | ||
99 | break; | ||
100 | |||
101 | case MMTIMER_GETRES: /* resolution of the clock in 10^-15 s */ | ||
102 | if (copy_to_user((unsigned long __user *)arg, | ||
103 | &uv_mmtimer_femtoperiod, sizeof(unsigned long))) | ||
104 | ret = -EFAULT; | ||
105 | break; | ||
106 | |||
107 | case MMTIMER_GETFREQ: /* frequency in Hz */ | ||
108 | if (copy_to_user((unsigned long __user *)arg, | ||
109 | &sn_rtc_cycles_per_second, | ||
110 | sizeof(unsigned long))) | ||
111 | ret = -EFAULT; | ||
112 | break; | ||
113 | |||
114 | case MMTIMER_GETBITS: /* number of bits in the clock */ | ||
115 | ret = hweight64(UVH_RTC_REAL_TIME_CLOCK_MASK); | ||
116 | break; | ||
117 | |||
118 | case MMTIMER_MMAPAVAIL: /* can we mmap the clock into userspace? */ | ||
119 | ret = (PAGE_SIZE <= (1 << 16)) ? 1 : 0; | ||
120 | break; | ||
121 | |||
122 | case MMTIMER_GETCOUNTER: | ||
123 | if (copy_to_user((unsigned long __user *)arg, | ||
124 | (unsigned long *)uv_local_mmr_address(UVH_RTC), | ||
125 | sizeof(unsigned long))) | ||
126 | ret = -EFAULT; | ||
127 | break; | ||
128 | default: | ||
129 | ret = -ENOTTY; | ||
130 | break; | ||
131 | } | ||
132 | return ret; | ||
133 | } | ||
134 | |||
135 | /** | ||
136 | * uv_mmtimer_mmap - maps the clock's registers into userspace | ||
137 | * @file: file structure for the device | ||
138 | * @vma: VMA to map the registers into | ||
139 | * | ||
140 | * Calls remap_pfn_range() to map the clock's registers into | ||
141 | * the calling process' address space. | ||
142 | */ | ||
143 | static int uv_mmtimer_mmap(struct file *file, struct vm_area_struct *vma) | ||
144 | { | ||
145 | unsigned long uv_mmtimer_addr; | ||
146 | |||
147 | if (vma->vm_end - vma->vm_start != PAGE_SIZE) | ||
148 | return -EINVAL; | ||
149 | |||
150 | if (vma->vm_flags & VM_WRITE) | ||
151 | return -EPERM; | ||
152 | |||
153 | if (PAGE_SIZE > (1 << 16)) | ||
154 | return -ENOSYS; | ||
155 | |||
156 | vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot); | ||
157 | |||
158 | uv_mmtimer_addr = UV_LOCAL_MMR_BASE | UVH_RTC; | ||
159 | uv_mmtimer_addr &= ~(PAGE_SIZE - 1); | ||
160 | uv_mmtimer_addr &= 0xfffffffffffffffUL; | ||
161 | |||
162 | if (remap_pfn_range(vma, vma->vm_start, uv_mmtimer_addr >> PAGE_SHIFT, | ||
163 | PAGE_SIZE, vma->vm_page_prot)) { | ||
164 | printk(KERN_ERR "remap_pfn_range failed in uv_mmtimer_mmap\n"); | ||
165 | return -EAGAIN; | ||
166 | } | ||
167 | |||
168 | return 0; | ||
169 | } | ||
170 | |||
171 | static struct miscdevice uv_mmtimer_miscdev = { | ||
172 | MISC_DYNAMIC_MINOR, | ||
173 | UV_MMTIMER_NAME, | ||
174 | &uv_mmtimer_fops | ||
175 | }; | ||
176 | |||
177 | |||
178 | /** | ||
179 | * uv_mmtimer_init - device initialization routine | ||
180 | * | ||
181 | * Does initial setup for the uv_mmtimer device. | ||
182 | */ | ||
183 | static int __init uv_mmtimer_init(void) | ||
184 | { | ||
185 | if (!is_uv_system()) { | ||
186 | printk(KERN_ERR "%s: Hardware unsupported\n", UV_MMTIMER_NAME); | ||
187 | return -1; | ||
188 | } | ||
189 | |||
190 | /* | ||
191 | * Sanity check the cycles/sec variable | ||
192 | */ | ||
193 | if (sn_rtc_cycles_per_second < 100000) { | ||
194 | printk(KERN_ERR "%s: unable to determine clock frequency\n", | ||
195 | UV_MMTIMER_NAME); | ||
196 | return -1; | ||
197 | } | ||
198 | |||
199 | uv_mmtimer_femtoperiod = ((unsigned long)1E15 + | ||
200 | sn_rtc_cycles_per_second / 2) / | ||
201 | sn_rtc_cycles_per_second; | ||
202 | |||
203 | if (misc_register(&uv_mmtimer_miscdev)) { | ||
204 | printk(KERN_ERR "%s: failed to register device\n", | ||
205 | UV_MMTIMER_NAME); | ||
206 | return -1; | ||
207 | } | ||
208 | |||
209 | printk(KERN_INFO "%s: v%s, %ld MHz\n", UV_MMTIMER_DESC, | ||
210 | UV_MMTIMER_VERSION, | ||
211 | sn_rtc_cycles_per_second/(unsigned long)1E6); | ||
212 | |||
213 | return 0; | ||
214 | } | ||
215 | |||
216 | module_init(uv_mmtimer_init); | ||
diff --git a/drivers/char/virtio_console.c b/drivers/char/virtio_console.c index c74dacfa6795..0d328b59568d 100644 --- a/drivers/char/virtio_console.c +++ b/drivers/char/virtio_console.c | |||
@@ -31,6 +31,7 @@ | |||
31 | #include <linux/err.h> | 31 | #include <linux/err.h> |
32 | #include <linux/init.h> | 32 | #include <linux/init.h> |
33 | #include <linux/virtio.h> | 33 | #include <linux/virtio.h> |
34 | #include <linux/virtio_ids.h> | ||
34 | #include <linux/virtio_console.h> | 35 | #include <linux/virtio_console.h> |
35 | #include "hvc_console.h" | 36 | #include "hvc_console.h" |
36 | 37 | ||
@@ -65,7 +66,7 @@ static int put_chars(u32 vtermno, const char *buf, int count) | |||
65 | 66 | ||
66 | /* add_buf wants a token to identify this buffer: we hand it any | 67 | /* add_buf wants a token to identify this buffer: we hand it any |
67 | * non-NULL pointer, since there's only ever one buffer. */ | 68 | * non-NULL pointer, since there's only ever one buffer. */ |
68 | if (out_vq->vq_ops->add_buf(out_vq, sg, 1, 0, (void *)1) == 0) { | 69 | if (out_vq->vq_ops->add_buf(out_vq, sg, 1, 0, (void *)1) >= 0) { |
69 | /* Tell Host to go! */ | 70 | /* Tell Host to go! */ |
70 | out_vq->vq_ops->kick(out_vq); | 71 | out_vq->vq_ops->kick(out_vq); |
71 | /* Chill out until it's done with the buffer. */ | 72 | /* Chill out until it's done with the buffer. */ |
@@ -85,7 +86,7 @@ static void add_inbuf(void) | |||
85 | sg_init_one(sg, inbuf, PAGE_SIZE); | 86 | sg_init_one(sg, inbuf, PAGE_SIZE); |
86 | 87 | ||
87 | /* We should always be able to add one buffer to an empty queue. */ | 88 | /* We should always be able to add one buffer to an empty queue. */ |
88 | if (in_vq->vq_ops->add_buf(in_vq, sg, 0, 1, inbuf) != 0) | 89 | if (in_vq->vq_ops->add_buf(in_vq, sg, 0, 1, inbuf) < 0) |
89 | BUG(); | 90 | BUG(); |
90 | in_vq->vq_ops->kick(in_vq); | 91 | in_vq->vq_ops->kick(in_vq); |
91 | } | 92 | } |
diff --git a/drivers/char/vt.c b/drivers/char/vt.c index 404f4c1ee431..0c80c68cd047 100644 --- a/drivers/char/vt.c +++ b/drivers/char/vt.c | |||
@@ -252,7 +252,6 @@ static void notify_update(struct vc_data *vc) | |||
252 | struct vt_notifier_param param = { .vc = vc }; | 252 | struct vt_notifier_param param = { .vc = vc }; |
253 | atomic_notifier_call_chain(&vt_notifier_list, VT_UPDATE, ¶m); | 253 | atomic_notifier_call_chain(&vt_notifier_list, VT_UPDATE, ¶m); |
254 | } | 254 | } |
255 | |||
256 | /* | 255 | /* |
257 | * Low-Level Functions | 256 | * Low-Level Functions |
258 | */ | 257 | */ |
@@ -935,6 +934,7 @@ static int vc_do_resize(struct tty_struct *tty, struct vc_data *vc, | |||
935 | 934 | ||
936 | if (CON_IS_VISIBLE(vc)) | 935 | if (CON_IS_VISIBLE(vc)) |
937 | update_screen(vc); | 936 | update_screen(vc); |
937 | vt_event_post(VT_EVENT_RESIZE, vc->vc_num, vc->vc_num); | ||
938 | return err; | 938 | return err; |
939 | } | 939 | } |
940 | 940 | ||
@@ -2129,11 +2129,7 @@ static int do_con_write(struct tty_struct *tty, const unsigned char *buf, int co | |||
2129 | currcons = vc->vc_num; | 2129 | currcons = vc->vc_num; |
2130 | if (!vc_cons_allocated(currcons)) { | 2130 | if (!vc_cons_allocated(currcons)) { |
2131 | /* could this happen? */ | 2131 | /* could this happen? */ |
2132 | static int error = 0; | 2132 | printk_once("con_write: tty %d not allocated\n", currcons+1); |
2133 | if (!error) { | ||
2134 | error = 1; | ||
2135 | printk("con_write: tty %d not allocated\n", currcons+1); | ||
2136 | } | ||
2137 | release_console_sem(); | 2133 | release_console_sem(); |
2138 | return 0; | 2134 | return 0; |
2139 | } | 2135 | } |
@@ -2910,6 +2906,9 @@ static const struct tty_operations con_ops = { | |||
2910 | .flush_chars = con_flush_chars, | 2906 | .flush_chars = con_flush_chars, |
2911 | .chars_in_buffer = con_chars_in_buffer, | 2907 | .chars_in_buffer = con_chars_in_buffer, |
2912 | .ioctl = vt_ioctl, | 2908 | .ioctl = vt_ioctl, |
2909 | #ifdef CONFIG_COMPAT | ||
2910 | .compat_ioctl = vt_compat_ioctl, | ||
2911 | #endif | ||
2913 | .stop = con_stop, | 2912 | .stop = con_stop, |
2914 | .start = con_start, | 2913 | .start = con_start, |
2915 | .throttle = con_throttle, | 2914 | .throttle = con_throttle, |
@@ -2948,9 +2947,6 @@ int __init vty_init(const struct file_operations *console_fops) | |||
2948 | panic("Couldn't register console driver\n"); | 2947 | panic("Couldn't register console driver\n"); |
2949 | kbd_init(); | 2948 | kbd_init(); |
2950 | console_map_init(); | 2949 | console_map_init(); |
2951 | #ifdef CONFIG_PROM_CONSOLE | ||
2952 | prom_con_init(); | ||
2953 | #endif | ||
2954 | #ifdef CONFIG_MDA_CONSOLE | 2950 | #ifdef CONFIG_MDA_CONSOLE |
2955 | mda_console_init(); | 2951 | mda_console_init(); |
2956 | #endif | 2952 | #endif |
@@ -2958,7 +2954,6 @@ int __init vty_init(const struct file_operations *console_fops) | |||
2958 | } | 2954 | } |
2959 | 2955 | ||
2960 | #ifndef VT_SINGLE_DRIVER | 2956 | #ifndef VT_SINGLE_DRIVER |
2961 | #include <linux/device.h> | ||
2962 | 2957 | ||
2963 | static struct class *vtconsole_class; | 2958 | static struct class *vtconsole_class; |
2964 | 2959 | ||
@@ -3641,6 +3636,7 @@ void do_blank_screen(int entering_gfx) | |||
3641 | blank_state = blank_vesa_wait; | 3636 | blank_state = blank_vesa_wait; |
3642 | mod_timer(&console_timer, jiffies + vesa_off_interval); | 3637 | mod_timer(&console_timer, jiffies + vesa_off_interval); |
3643 | } | 3638 | } |
3639 | vt_event_post(VT_EVENT_BLANK, vc->vc_num, vc->vc_num); | ||
3644 | } | 3640 | } |
3645 | EXPORT_SYMBOL(do_blank_screen); | 3641 | EXPORT_SYMBOL(do_blank_screen); |
3646 | 3642 | ||
@@ -3685,6 +3681,7 @@ void do_unblank_screen(int leaving_gfx) | |||
3685 | console_blank_hook(0); | 3681 | console_blank_hook(0); |
3686 | set_palette(vc); | 3682 | set_palette(vc); |
3687 | set_cursor(vc); | 3683 | set_cursor(vc); |
3684 | vt_event_post(VT_EVENT_UNBLANK, vc->vc_num, vc->vc_num); | ||
3688 | } | 3685 | } |
3689 | EXPORT_SYMBOL(do_unblank_screen); | 3686 | EXPORT_SYMBOL(do_unblank_screen); |
3690 | 3687 | ||
diff --git a/drivers/char/vt_ioctl.c b/drivers/char/vt_ioctl.c index 95189f288f8c..29c651ab0d78 100644 --- a/drivers/char/vt_ioctl.c +++ b/drivers/char/vt_ioctl.c | |||
@@ -16,6 +16,8 @@ | |||
16 | #include <linux/tty.h> | 16 | #include <linux/tty.h> |
17 | #include <linux/timer.h> | 17 | #include <linux/timer.h> |
18 | #include <linux/kernel.h> | 18 | #include <linux/kernel.h> |
19 | #include <linux/compat.h> | ||
20 | #include <linux/module.h> | ||
19 | #include <linux/kd.h> | 21 | #include <linux/kd.h> |
20 | #include <linux/vt.h> | 22 | #include <linux/vt.h> |
21 | #include <linux/string.h> | 23 | #include <linux/string.h> |
@@ -62,6 +64,133 @@ extern struct tty_driver *console_driver; | |||
62 | static void complete_change_console(struct vc_data *vc); | 64 | static void complete_change_console(struct vc_data *vc); |
63 | 65 | ||
64 | /* | 66 | /* |
67 | * User space VT_EVENT handlers | ||
68 | */ | ||
69 | |||
70 | struct vt_event_wait { | ||
71 | struct list_head list; | ||
72 | struct vt_event event; | ||
73 | int done; | ||
74 | }; | ||
75 | |||
76 | static LIST_HEAD(vt_events); | ||
77 | static DEFINE_SPINLOCK(vt_event_lock); | ||
78 | static DECLARE_WAIT_QUEUE_HEAD(vt_event_waitqueue); | ||
79 | |||
80 | /** | ||
81 | * vt_event_post | ||
82 | * @event: the event that occurred | ||
83 | * @old: old console | ||
84 | * @new: new console | ||
85 | * | ||
86 | * Post an VT event to interested VT handlers | ||
87 | */ | ||
88 | |||
89 | void vt_event_post(unsigned int event, unsigned int old, unsigned int new) | ||
90 | { | ||
91 | struct list_head *pos, *head; | ||
92 | unsigned long flags; | ||
93 | int wake = 0; | ||
94 | |||
95 | spin_lock_irqsave(&vt_event_lock, flags); | ||
96 | head = &vt_events; | ||
97 | |||
98 | list_for_each(pos, head) { | ||
99 | struct vt_event_wait *ve = list_entry(pos, | ||
100 | struct vt_event_wait, list); | ||
101 | if (!(ve->event.event & event)) | ||
102 | continue; | ||
103 | ve->event.event = event; | ||
104 | /* kernel view is consoles 0..n-1, user space view is | ||
105 | console 1..n with 0 meaning current, so we must bias */ | ||
106 | ve->event.old = old + 1; | ||
107 | ve->event.new = new + 1; | ||
108 | wake = 1; | ||
109 | ve->done = 1; | ||
110 | } | ||
111 | spin_unlock_irqrestore(&vt_event_lock, flags); | ||
112 | if (wake) | ||
113 | wake_up_interruptible(&vt_event_waitqueue); | ||
114 | } | ||
115 | |||
116 | /** | ||
117 | * vt_event_wait - wait for an event | ||
118 | * @vw: our event | ||
119 | * | ||
120 | * Waits for an event to occur which completes our vt_event_wait | ||
121 | * structure. On return the structure has wv->done set to 1 for success | ||
122 | * or 0 if some event such as a signal ended the wait. | ||
123 | */ | ||
124 | |||
125 | static void vt_event_wait(struct vt_event_wait *vw) | ||
126 | { | ||
127 | unsigned long flags; | ||
128 | /* Prepare the event */ | ||
129 | INIT_LIST_HEAD(&vw->list); | ||
130 | vw->done = 0; | ||
131 | /* Queue our event */ | ||
132 | spin_lock_irqsave(&vt_event_lock, flags); | ||
133 | list_add(&vw->list, &vt_events); | ||
134 | spin_unlock_irqrestore(&vt_event_lock, flags); | ||
135 | /* Wait for it to pass */ | ||
136 | wait_event_interruptible(vt_event_waitqueue, vw->done); | ||
137 | /* Dequeue it */ | ||
138 | spin_lock_irqsave(&vt_event_lock, flags); | ||
139 | list_del(&vw->list); | ||
140 | spin_unlock_irqrestore(&vt_event_lock, flags); | ||
141 | } | ||
142 | |||
143 | /** | ||
144 | * vt_event_wait_ioctl - event ioctl handler | ||
145 | * @arg: argument to ioctl | ||
146 | * | ||
147 | * Implement the VT_WAITEVENT ioctl using the VT event interface | ||
148 | */ | ||
149 | |||
150 | static int vt_event_wait_ioctl(struct vt_event __user *event) | ||
151 | { | ||
152 | struct vt_event_wait vw; | ||
153 | |||
154 | if (copy_from_user(&vw.event, event, sizeof(struct vt_event))) | ||
155 | return -EFAULT; | ||
156 | /* Highest supported event for now */ | ||
157 | if (vw.event.event & ~VT_MAX_EVENT) | ||
158 | return -EINVAL; | ||
159 | |||
160 | vt_event_wait(&vw); | ||
161 | /* If it occurred report it */ | ||
162 | if (vw.done) { | ||
163 | if (copy_to_user(event, &vw.event, sizeof(struct vt_event))) | ||
164 | return -EFAULT; | ||
165 | return 0; | ||
166 | } | ||
167 | return -EINTR; | ||
168 | } | ||
169 | |||
170 | /** | ||
171 | * vt_waitactive - active console wait | ||
172 | * @event: event code | ||
173 | * @n: new console | ||
174 | * | ||
175 | * Helper for event waits. Used to implement the legacy | ||
176 | * event waiting ioctls in terms of events | ||
177 | */ | ||
178 | |||
179 | int vt_waitactive(int n) | ||
180 | { | ||
181 | struct vt_event_wait vw; | ||
182 | do { | ||
183 | if (n == fg_console + 1) | ||
184 | break; | ||
185 | vw.event.event = VT_EVENT_SWITCH; | ||
186 | vt_event_wait(&vw); | ||
187 | if (vw.done == 0) | ||
188 | return -EINTR; | ||
189 | } while (vw.event.new != n); | ||
190 | return 0; | ||
191 | } | ||
192 | |||
193 | /* | ||
65 | * these are the valid i/o ports we're allowed to change. they map all the | 194 | * these are the valid i/o ports we're allowed to change. they map all the |
66 | * video ports | 195 | * video ports |
67 | */ | 196 | */ |
@@ -360,6 +489,8 @@ do_unimap_ioctl(int cmd, struct unimapdesc __user *user_ud, int perm, struct vc_ | |||
360 | return 0; | 489 | return 0; |
361 | } | 490 | } |
362 | 491 | ||
492 | |||
493 | |||
363 | /* | 494 | /* |
364 | * We handle the console-specific ioctl's here. We allow the | 495 | * We handle the console-specific ioctl's here. We allow the |
365 | * capability to modify any console, not just the fg_console. | 496 | * capability to modify any console, not just the fg_console. |
@@ -842,6 +973,41 @@ int vt_ioctl(struct tty_struct *tty, struct file * file, | |||
842 | } | 973 | } |
843 | break; | 974 | break; |
844 | 975 | ||
976 | case VT_SETACTIVATE: | ||
977 | { | ||
978 | struct vt_setactivate vsa; | ||
979 | |||
980 | if (!perm) | ||
981 | goto eperm; | ||
982 | |||
983 | if (copy_from_user(&vsa, (struct vt_setactivate __user *)arg, | ||
984 | sizeof(struct vt_setactivate))) | ||
985 | return -EFAULT; | ||
986 | if (vsa.console == 0 || vsa.console > MAX_NR_CONSOLES) | ||
987 | ret = -ENXIO; | ||
988 | else { | ||
989 | vsa.console--; | ||
990 | acquire_console_sem(); | ||
991 | ret = vc_allocate(vsa.console); | ||
992 | if (ret == 0) { | ||
993 | struct vc_data *nvc; | ||
994 | /* This is safe providing we don't drop the | ||
995 | console sem between vc_allocate and | ||
996 | finishing referencing nvc */ | ||
997 | nvc = vc_cons[vsa.console].d; | ||
998 | nvc->vt_mode = vsa.mode; | ||
999 | nvc->vt_mode.frsig = 0; | ||
1000 | put_pid(nvc->vt_pid); | ||
1001 | nvc->vt_pid = get_pid(task_pid(current)); | ||
1002 | } | ||
1003 | release_console_sem(); | ||
1004 | if (ret) | ||
1005 | break; | ||
1006 | /* Commence switch and lock */ | ||
1007 | set_console(arg); | ||
1008 | } | ||
1009 | } | ||
1010 | |||
845 | /* | 1011 | /* |
846 | * wait until the specified VT has been activated | 1012 | * wait until the specified VT has been activated |
847 | */ | 1013 | */ |
@@ -851,7 +1017,7 @@ int vt_ioctl(struct tty_struct *tty, struct file * file, | |||
851 | if (arg == 0 || arg > MAX_NR_CONSOLES) | 1017 | if (arg == 0 || arg > MAX_NR_CONSOLES) |
852 | ret = -ENXIO; | 1018 | ret = -ENXIO; |
853 | else | 1019 | else |
854 | ret = vt_waitactive(arg - 1); | 1020 | ret = vt_waitactive(arg); |
855 | break; | 1021 | break; |
856 | 1022 | ||
857 | /* | 1023 | /* |
@@ -1159,6 +1325,9 @@ int vt_ioctl(struct tty_struct *tty, struct file * file, | |||
1159 | ret = put_user(vc->vc_hi_font_mask, | 1325 | ret = put_user(vc->vc_hi_font_mask, |
1160 | (unsigned short __user *)arg); | 1326 | (unsigned short __user *)arg); |
1161 | break; | 1327 | break; |
1328 | case VT_WAITEVENT: | ||
1329 | ret = vt_event_wait_ioctl((struct vt_event __user *)arg); | ||
1330 | break; | ||
1162 | default: | 1331 | default: |
1163 | ret = -ENOIOCTLCMD; | 1332 | ret = -ENOIOCTLCMD; |
1164 | } | 1333 | } |
@@ -1170,54 +1339,6 @@ eperm: | |||
1170 | goto out; | 1339 | goto out; |
1171 | } | 1340 | } |
1172 | 1341 | ||
1173 | /* | ||
1174 | * Sometimes we want to wait until a particular VT has been activated. We | ||
1175 | * do it in a very simple manner. Everybody waits on a single queue and | ||
1176 | * get woken up at once. Those that are satisfied go on with their business, | ||
1177 | * while those not ready go back to sleep. Seems overkill to add a wait | ||
1178 | * to each vt just for this - usually this does nothing! | ||
1179 | */ | ||
1180 | static DECLARE_WAIT_QUEUE_HEAD(vt_activate_queue); | ||
1181 | |||
1182 | /* | ||
1183 | * Sleeps until a vt is activated, or the task is interrupted. Returns | ||
1184 | * 0 if activation, -EINTR if interrupted by a signal handler. | ||
1185 | */ | ||
1186 | int vt_waitactive(int vt) | ||
1187 | { | ||
1188 | int retval; | ||
1189 | DECLARE_WAITQUEUE(wait, current); | ||
1190 | |||
1191 | add_wait_queue(&vt_activate_queue, &wait); | ||
1192 | for (;;) { | ||
1193 | retval = 0; | ||
1194 | |||
1195 | /* | ||
1196 | * Synchronize with redraw_screen(). By acquiring the console | ||
1197 | * semaphore we make sure that the console switch is completed | ||
1198 | * before we return. If we didn't wait for the semaphore, we | ||
1199 | * could return at a point where fg_console has already been | ||
1200 | * updated, but the console switch hasn't been completed. | ||
1201 | */ | ||
1202 | acquire_console_sem(); | ||
1203 | set_current_state(TASK_INTERRUPTIBLE); | ||
1204 | if (vt == fg_console) { | ||
1205 | release_console_sem(); | ||
1206 | break; | ||
1207 | } | ||
1208 | release_console_sem(); | ||
1209 | retval = -ERESTARTNOHAND; | ||
1210 | if (signal_pending(current)) | ||
1211 | break; | ||
1212 | schedule(); | ||
1213 | } | ||
1214 | remove_wait_queue(&vt_activate_queue, &wait); | ||
1215 | __set_current_state(TASK_RUNNING); | ||
1216 | return retval; | ||
1217 | } | ||
1218 | |||
1219 | #define vt_wake_waitactive() wake_up(&vt_activate_queue) | ||
1220 | |||
1221 | void reset_vc(struct vc_data *vc) | 1342 | void reset_vc(struct vc_data *vc) |
1222 | { | 1343 | { |
1223 | vc->vc_mode = KD_TEXT; | 1344 | vc->vc_mode = KD_TEXT; |
@@ -1256,12 +1377,216 @@ void vc_SAK(struct work_struct *work) | |||
1256 | release_console_sem(); | 1377 | release_console_sem(); |
1257 | } | 1378 | } |
1258 | 1379 | ||
1380 | #ifdef CONFIG_COMPAT | ||
1381 | |||
1382 | struct compat_consolefontdesc { | ||
1383 | unsigned short charcount; /* characters in font (256 or 512) */ | ||
1384 | unsigned short charheight; /* scan lines per character (1-32) */ | ||
1385 | compat_caddr_t chardata; /* font data in expanded form */ | ||
1386 | }; | ||
1387 | |||
1388 | static inline int | ||
1389 | compat_fontx_ioctl(int cmd, struct compat_consolefontdesc __user *user_cfd, | ||
1390 | int perm, struct console_font_op *op) | ||
1391 | { | ||
1392 | struct compat_consolefontdesc cfdarg; | ||
1393 | int i; | ||
1394 | |||
1395 | if (copy_from_user(&cfdarg, user_cfd, sizeof(struct compat_consolefontdesc))) | ||
1396 | return -EFAULT; | ||
1397 | |||
1398 | switch (cmd) { | ||
1399 | case PIO_FONTX: | ||
1400 | if (!perm) | ||
1401 | return -EPERM; | ||
1402 | op->op = KD_FONT_OP_SET; | ||
1403 | op->flags = KD_FONT_FLAG_OLD; | ||
1404 | op->width = 8; | ||
1405 | op->height = cfdarg.charheight; | ||
1406 | op->charcount = cfdarg.charcount; | ||
1407 | op->data = compat_ptr(cfdarg.chardata); | ||
1408 | return con_font_op(vc_cons[fg_console].d, op); | ||
1409 | case GIO_FONTX: | ||
1410 | op->op = KD_FONT_OP_GET; | ||
1411 | op->flags = KD_FONT_FLAG_OLD; | ||
1412 | op->width = 8; | ||
1413 | op->height = cfdarg.charheight; | ||
1414 | op->charcount = cfdarg.charcount; | ||
1415 | op->data = compat_ptr(cfdarg.chardata); | ||
1416 | i = con_font_op(vc_cons[fg_console].d, op); | ||
1417 | if (i) | ||
1418 | return i; | ||
1419 | cfdarg.charheight = op->height; | ||
1420 | cfdarg.charcount = op->charcount; | ||
1421 | if (copy_to_user(user_cfd, &cfdarg, sizeof(struct compat_consolefontdesc))) | ||
1422 | return -EFAULT; | ||
1423 | return 0; | ||
1424 | } | ||
1425 | return -EINVAL; | ||
1426 | } | ||
1427 | |||
1428 | struct compat_console_font_op { | ||
1429 | compat_uint_t op; /* operation code KD_FONT_OP_* */ | ||
1430 | compat_uint_t flags; /* KD_FONT_FLAG_* */ | ||
1431 | compat_uint_t width, height; /* font size */ | ||
1432 | compat_uint_t charcount; | ||
1433 | compat_caddr_t data; /* font data with height fixed to 32 */ | ||
1434 | }; | ||
1435 | |||
1436 | static inline int | ||
1437 | compat_kdfontop_ioctl(struct compat_console_font_op __user *fontop, | ||
1438 | int perm, struct console_font_op *op, struct vc_data *vc) | ||
1439 | { | ||
1440 | int i; | ||
1441 | |||
1442 | if (copy_from_user(op, fontop, sizeof(struct compat_console_font_op))) | ||
1443 | return -EFAULT; | ||
1444 | if (!perm && op->op != KD_FONT_OP_GET) | ||
1445 | return -EPERM; | ||
1446 | op->data = compat_ptr(((struct compat_console_font_op *)op)->data); | ||
1447 | op->flags |= KD_FONT_FLAG_OLD; | ||
1448 | i = con_font_op(vc, op); | ||
1449 | if (i) | ||
1450 | return i; | ||
1451 | ((struct compat_console_font_op *)op)->data = (unsigned long)op->data; | ||
1452 | if (copy_to_user(fontop, op, sizeof(struct compat_console_font_op))) | ||
1453 | return -EFAULT; | ||
1454 | return 0; | ||
1455 | } | ||
1456 | |||
1457 | struct compat_unimapdesc { | ||
1458 | unsigned short entry_ct; | ||
1459 | compat_caddr_t entries; | ||
1460 | }; | ||
1461 | |||
1462 | static inline int | ||
1463 | compat_unimap_ioctl(unsigned int cmd, struct compat_unimapdesc __user *user_ud, | ||
1464 | int perm, struct vc_data *vc) | ||
1465 | { | ||
1466 | struct compat_unimapdesc tmp; | ||
1467 | struct unipair __user *tmp_entries; | ||
1468 | |||
1469 | if (copy_from_user(&tmp, user_ud, sizeof tmp)) | ||
1470 | return -EFAULT; | ||
1471 | tmp_entries = compat_ptr(tmp.entries); | ||
1472 | if (tmp_entries) | ||
1473 | if (!access_ok(VERIFY_WRITE, tmp_entries, | ||
1474 | tmp.entry_ct*sizeof(struct unipair))) | ||
1475 | return -EFAULT; | ||
1476 | switch (cmd) { | ||
1477 | case PIO_UNIMAP: | ||
1478 | if (!perm) | ||
1479 | return -EPERM; | ||
1480 | return con_set_unimap(vc, tmp.entry_ct, tmp_entries); | ||
1481 | case GIO_UNIMAP: | ||
1482 | if (!perm && fg_console != vc->vc_num) | ||
1483 | return -EPERM; | ||
1484 | return con_get_unimap(vc, tmp.entry_ct, &(user_ud->entry_ct), tmp_entries); | ||
1485 | } | ||
1486 | return 0; | ||
1487 | } | ||
1488 | |||
1489 | long vt_compat_ioctl(struct tty_struct *tty, struct file * file, | ||
1490 | unsigned int cmd, unsigned long arg) | ||
1491 | { | ||
1492 | struct vc_data *vc = tty->driver_data; | ||
1493 | struct console_font_op op; /* used in multiple places here */ | ||
1494 | struct kbd_struct *kbd; | ||
1495 | unsigned int console; | ||
1496 | void __user *up = (void __user *)arg; | ||
1497 | int perm; | ||
1498 | int ret = 0; | ||
1499 | |||
1500 | console = vc->vc_num; | ||
1501 | |||
1502 | lock_kernel(); | ||
1503 | |||
1504 | if (!vc_cons_allocated(console)) { /* impossible? */ | ||
1505 | ret = -ENOIOCTLCMD; | ||
1506 | goto out; | ||
1507 | } | ||
1508 | |||
1509 | /* | ||
1510 | * To have permissions to do most of the vt ioctls, we either have | ||
1511 | * to be the owner of the tty, or have CAP_SYS_TTY_CONFIG. | ||
1512 | */ | ||
1513 | perm = 0; | ||
1514 | if (current->signal->tty == tty || capable(CAP_SYS_TTY_CONFIG)) | ||
1515 | perm = 1; | ||
1516 | |||
1517 | kbd = kbd_table + console; | ||
1518 | switch (cmd) { | ||
1519 | /* | ||
1520 | * these need special handlers for incompatible data structures | ||
1521 | */ | ||
1522 | case PIO_FONTX: | ||
1523 | case GIO_FONTX: | ||
1524 | ret = compat_fontx_ioctl(cmd, up, perm, &op); | ||
1525 | break; | ||
1526 | |||
1527 | case KDFONTOP: | ||
1528 | ret = compat_kdfontop_ioctl(up, perm, &op, vc); | ||
1529 | break; | ||
1530 | |||
1531 | case PIO_UNIMAP: | ||
1532 | case GIO_UNIMAP: | ||
1533 | ret = do_unimap_ioctl(cmd, up, perm, vc); | ||
1534 | break; | ||
1535 | |||
1536 | /* | ||
1537 | * all these treat 'arg' as an integer | ||
1538 | */ | ||
1539 | case KIOCSOUND: | ||
1540 | case KDMKTONE: | ||
1541 | #ifdef CONFIG_X86 | ||
1542 | case KDADDIO: | ||
1543 | case KDDELIO: | ||
1544 | #endif | ||
1545 | case KDSETMODE: | ||
1546 | case KDMAPDISP: | ||
1547 | case KDUNMAPDISP: | ||
1548 | case KDSKBMODE: | ||
1549 | case KDSKBMETA: | ||
1550 | case KDSKBLED: | ||
1551 | case KDSETLED: | ||
1552 | case KDSIGACCEPT: | ||
1553 | case VT_ACTIVATE: | ||
1554 | case VT_WAITACTIVE: | ||
1555 | case VT_RELDISP: | ||
1556 | case VT_DISALLOCATE: | ||
1557 | case VT_RESIZE: | ||
1558 | case VT_RESIZEX: | ||
1559 | goto fallback; | ||
1560 | |||
1561 | /* | ||
1562 | * the rest has a compatible data structure behind arg, | ||
1563 | * but we have to convert it to a proper 64 bit pointer. | ||
1564 | */ | ||
1565 | default: | ||
1566 | arg = (unsigned long)compat_ptr(arg); | ||
1567 | goto fallback; | ||
1568 | } | ||
1569 | out: | ||
1570 | unlock_kernel(); | ||
1571 | return ret; | ||
1572 | |||
1573 | fallback: | ||
1574 | unlock_kernel(); | ||
1575 | return vt_ioctl(tty, file, cmd, arg); | ||
1576 | } | ||
1577 | |||
1578 | |||
1579 | #endif /* CONFIG_COMPAT */ | ||
1580 | |||
1581 | |||
1259 | /* | 1582 | /* |
1260 | * Performs the back end of a vt switch | 1583 | * Performs the back end of a vt switch. Called under the console |
1584 | * semaphore. | ||
1261 | */ | 1585 | */ |
1262 | static void complete_change_console(struct vc_data *vc) | 1586 | static void complete_change_console(struct vc_data *vc) |
1263 | { | 1587 | { |
1264 | unsigned char old_vc_mode; | 1588 | unsigned char old_vc_mode; |
1589 | int old = fg_console; | ||
1265 | 1590 | ||
1266 | last_console = fg_console; | 1591 | last_console = fg_console; |
1267 | 1592 | ||
@@ -1325,7 +1650,7 @@ static void complete_change_console(struct vc_data *vc) | |||
1325 | /* | 1650 | /* |
1326 | * Wake anyone waiting for their VT to activate | 1651 | * Wake anyone waiting for their VT to activate |
1327 | */ | 1652 | */ |
1328 | vt_wake_waitactive(); | 1653 | vt_event_post(VT_EVENT_SWITCH, old, vc->vc_num); |
1329 | return; | 1654 | return; |
1330 | } | 1655 | } |
1331 | 1656 | ||
@@ -1398,3 +1723,58 @@ void change_console(struct vc_data *new_vc) | |||
1398 | 1723 | ||
1399 | complete_change_console(new_vc); | 1724 | complete_change_console(new_vc); |
1400 | } | 1725 | } |
1726 | |||
1727 | /* Perform a kernel triggered VT switch for suspend/resume */ | ||
1728 | |||
1729 | static int disable_vt_switch; | ||
1730 | |||
1731 | int vt_move_to_console(unsigned int vt, int alloc) | ||
1732 | { | ||
1733 | int prev; | ||
1734 | |||
1735 | acquire_console_sem(); | ||
1736 | /* Graphics mode - up to X */ | ||
1737 | if (disable_vt_switch) { | ||
1738 | release_console_sem(); | ||
1739 | return 0; | ||
1740 | } | ||
1741 | prev = fg_console; | ||
1742 | |||
1743 | if (alloc && vc_allocate(vt)) { | ||
1744 | /* we can't have a free VC for now. Too bad, | ||
1745 | * we don't want to mess the screen for now. */ | ||
1746 | release_console_sem(); | ||
1747 | return -ENOSPC; | ||
1748 | } | ||
1749 | |||
1750 | if (set_console(vt)) { | ||
1751 | /* | ||
1752 | * We're unable to switch to the SUSPEND_CONSOLE. | ||
1753 | * Let the calling function know so it can decide | ||
1754 | * what to do. | ||
1755 | */ | ||
1756 | release_console_sem(); | ||
1757 | return -EIO; | ||
1758 | } | ||
1759 | release_console_sem(); | ||
1760 | if (vt_waitactive(vt + 1)) { | ||
1761 | pr_debug("Suspend: Can't switch VCs."); | ||
1762 | return -EINTR; | ||
1763 | } | ||
1764 | return prev; | ||
1765 | } | ||
1766 | |||
1767 | /* | ||
1768 | * Normally during a suspend, we allocate a new console and switch to it. | ||
1769 | * When we resume, we switch back to the original console. This switch | ||
1770 | * can be slow, so on systems where the framebuffer can handle restoration | ||
1771 | * of video registers anyways, there's little point in doing the console | ||
1772 | * switch. This function allows you to disable it by passing it '0'. | ||
1773 | */ | ||
1774 | void pm_set_vt_switch(int do_switch) | ||
1775 | { | ||
1776 | acquire_console_sem(); | ||
1777 | disable_vt_switch = !do_switch; | ||
1778 | release_console_sem(); | ||
1779 | } | ||
1780 | EXPORT_SYMBOL(pm_set_vt_switch); | ||