69 static int yenta_probe_cb_irq(struct yenta_socket *socket);
70 static unsigned int yenta_probe_irq(struct yenta_socket *socket,
84 static inline u32 cb_readl(struct yenta_socket *socket, unsigned reg)  in cb_readl()  argument
86 	u32 val = readl(socket->base + reg);  in cb_readl()
87 	debug("%04x %08x\n", socket, reg, val);  in cb_readl()
91 static inline void cb_writel(struct yenta_socket *socket, unsigned reg, u32 val)  in cb_writel()  argument
93 	debug("%04x %08x\n", socket, reg, val);  in cb_writel()
94 	writel(val, socket->base + reg);  in cb_writel()
95 	readl(socket->base + reg); /* avoid problems with PCI write posting */  in cb_writel()
98 static inline u8 config_readb(struct yenta_socket *socket, unsigned offset)  in config_readb()  argument
101 	pci_read_config_byte(socket->dev, offset, &val);  in config_readb()
102 	debug("%04x %02x\n", socket, offset, val);  in config_readb()
106 static inline u16 config_readw(struct yenta_socket *socket, unsigned offset)  in config_readw()  argument
109 	pci_read_config_word(socket->dev, offset, &val);  in config_readw()
110 	debug("%04x %04x\n", socket, offset, val);  in config_readw()
114 static inline u32 config_readl(struct yenta_socket *socket, unsigned offset)  in config_readl()  argument
117 	pci_read_config_dword(socket->dev, offset, &val);  in config_readl()
118 	debug("%04x %08x\n", socket, offset, val);  in config_readl()
122 static inline void config_writeb(struct yenta_socket *socket, unsigned offset, u8 val)  in config_writeb()  argument
124 	debug("%04x %02x\n", socket, offset, val);  in config_writeb()
125 	pci_write_config_byte(socket->dev, offset, val);  in config_writeb()
128 static inline void config_writew(struct yenta_socket *socket, unsigned offset, u16 val)  in config_writew()  argument
130 	debug("%04x %04x\n", socket, offset, val);  in config_writew()
131 	pci_write_config_word(socket->dev, offset, val);  in config_writew()
134 static inline void config_writel(struct yenta_socket *socket, unsigned offset, u32 val)  in config_writel()  argument
136 	debug("%04x %08x\n", socket, offset, val);  in config_writel()
137 	pci_write_config_dword(socket->dev, offset, val);  in config_writel()
140 static inline u8 exca_readb(struct yenta_socket *socket, unsigned reg)  in exca_readb()  argument
142 	u8 val = readb(socket->base + 0x800 + reg);  in exca_readb()
143 	debug("%04x %02x\n", socket, reg, val);  in exca_readb()
147 static inline u8 exca_readw(struct yenta_socket *socket, unsigned reg)  in exca_readw()  argument
150 	val = readb(socket->base + 0x800 + reg);  in exca_readw()
151 	val |= readb(socket->base + 0x800 + reg + 1) << 8;  in exca_readw()
152 	debug("%04x %04x\n", socket, reg, val);  in exca_readw()
156 static inline void exca_writeb(struct yenta_socket *socket, unsigned reg, u8 val)  in exca_writeb()  argument
158 	debug("%04x %02x\n", socket, reg, val);  in exca_writeb()
159 	writeb(val, socket->base + 0x800 + reg);  in exca_writeb()
160 	readb(socket->base + 0x800 + reg); /* PCI write posting... */  in exca_writeb()
163 static void exca_writew(struct yenta_socket *socket, unsigned reg, u16 val)  in exca_writew()  argument
165 	debug("%04x %04x\n", socket, reg, val);  in exca_writew()
166 	writeb(val, socket->base + 0x800 + reg);  in exca_writew()
167 	writeb(val >> 8, socket->base + 0x800 + reg + 1);  in exca_writew()
170 	readb(socket->base + 0x800 + reg);  in exca_writew()
171 	readb(socket->base + 0x800 + reg + 1);  in exca_writew()
177 	struct yenta_socket *socket = pci_get_drvdata(dev);  in show_yenta_registers()  local
185 		val = cb_readl(socket, i);  in show_yenta_registers()
199 		val = exca_readb(socket, i);  in show_yenta_registers()
214 	struct yenta_socket *socket = container_of(sock, struct yenta_socket, socket);  in yenta_get_status()  local
216 	u32 state = cb_readl(socket, CB_SOCKET_STATE);  in yenta_get_status()
230 		u8 status = exca_readb(socket, I365_STATUS);  in yenta_get_status()
232 		if (exca_readb(socket, I365_INTCTL) & I365_PC_IOCARD) {  in yenta_get_status()
247 static void yenta_set_power(struct yenta_socket *socket, socket_state_t *state)  in yenta_set_power()  argument
250 	if (!(cb_readl(socket, CB_SOCKET_STATE) & CB_CBCARD) &&  in yenta_set_power()
251 	    (socket->flags & YENTA_16BIT_POWER_EXCA)) {  in yenta_set_power()
253 		reg = old = exca_readb(socket, I365_POWER);  in yenta_set_power()
257 		if (socket->flags & YENTA_16BIT_POWER_DF) {  in yenta_set_power()
299 			exca_writeb(socket, I365_POWER, reg);  in yenta_set_power()
324 		if (reg != cb_readl(socket, CB_SOCKET_CONTROL))  in yenta_set_power()
325 			cb_writel(socket, CB_SOCKET_CONTROL, reg);  in yenta_set_power()
331 	struct yenta_socket *socket = container_of(sock, struct yenta_socket, socket);  in yenta_set_socket()  local
336 		yenta_set_power(socket, state);  in yenta_set_socket()
338 	socket->io_irq = state->io_irq;  in yenta_set_socket()
339 	bridge = config_readw(socket, CB_BRIDGE_CONTROL) & ~(CB_BRIDGE_CRST | CB_BRIDGE_INTR);  in yenta_set_socket()
340 	if (cb_readl(socket, CB_SOCKET_STATE) & CB_CBCARD) {  in yenta_set_socket()
345 		intr = exca_readb(socket, I365_INTCTL);  in yenta_set_socket()
347 		if (!socket->dev->irq) {  in yenta_set_socket()
348 			intr |= socket->cb_irq ? socket->cb_irq : state->io_irq;  in yenta_set_socket()
351 		exca_writeb(socket, I365_INTCTL, intr);  in yenta_set_socket()
355 		reg = exca_readb(socket, I365_INTCTL) & (I365_RING_ENA | I365_INTR_ENA);  in yenta_set_socket()
358 		if (state->io_irq != socket->dev->irq) {  in yenta_set_socket()
362 		exca_writeb(socket, I365_INTCTL, reg);  in yenta_set_socket()
364 		reg = exca_readb(socket, I365_POWER) & (I365_VCC_MASK|I365_VPP1_MASK);  in yenta_set_socket()
370 		if (exca_readb(socket, I365_POWER) != reg)  in yenta_set_socket()
371 			exca_writeb(socket, I365_POWER, reg);  in yenta_set_socket()
374 		reg = exca_readb(socket, I365_CSCINT);  in yenta_set_socket()
388 		exca_writeb(socket, I365_CSCINT, reg);  in yenta_set_socket()
389 		exca_readb(socket, I365_CSC);  in yenta_set_socket()
393 	config_writew(socket, CB_BRIDGE_CONTROL, bridge);  in yenta_set_socket()
395 	cb_writel(socket, CB_SOCKET_EVENT, -1);  in yenta_set_socket()
396 	cb_writel(socket, CB_SOCKET_MASK, CB_CDMASK);  in yenta_set_socket()
400 		yenta_set_power(socket, state);  in yenta_set_socket()
406 	struct yenta_socket *socket = container_of(sock, struct yenta_socket, socket);  in yenta_set_io_map()  local
416 	addr = exca_readb(socket, I365_ADDRWIN);  in yenta_set_io_map()
421 		exca_writeb(socket, I365_ADDRWIN, addr);  in yenta_set_io_map()
424 	exca_writew(socket, I365_IO(map)+I365_W_START, io->start);  in yenta_set_io_map()
425 	exca_writew(socket, I365_IO(map)+I365_W_STOP, io->stop);  in yenta_set_io_map()
427 	ioctl = exca_readb(socket, I365_IOCTL) & ~I365_IOCTL_MASK(map);  in yenta_set_io_map()
434 	exca_writeb(socket, I365_IOCTL, ioctl);  in yenta_set_io_map()
437 		exca_writeb(socket, I365_ADDRWIN, addr | enable);  in yenta_set_io_map()
443 	struct yenta_socket *socket = container_of(sock, struct yenta_socket, socket);  in yenta_set_mem_map()  local
450 	pcibios_resource_to_bus(socket->dev->bus, &region, mem->res);  in yenta_set_mem_map()
462 	addr = exca_readb(socket, I365_ADDRWIN);  in yenta_set_mem_map()
465 		exca_writeb(socket, I365_ADDRWIN, addr);  in yenta_set_mem_map()
468 	exca_writeb(socket, CB_MEM_PAGE(map), start >> 24);  in yenta_set_mem_map()
475 	exca_writew(socket, I365_MEM(map) + I365_W_START, word);  in yenta_set_mem_map()
491 	exca_writew(socket, I365_MEM(map) + I365_W_STOP, word);  in yenta_set_mem_map()
498 	exca_writew(socket, I365_MEM(map) + I365_W_OFF, word);  in yenta_set_mem_map()
501 		exca_writeb(socket, I365_ADDRWIN, addr | enable);  in yenta_set_mem_map()
510 	struct yenta_socket *socket = (struct yenta_socket *) dev_id;  in yenta_interrupt()  local
515 	cb_event = cb_readl(socket, CB_SOCKET_EVENT);  in yenta_interrupt()
516 	cb_writel(socket, CB_SOCKET_EVENT, cb_event);  in yenta_interrupt()
518 	csc = exca_readb(socket, I365_CSC);  in yenta_interrupt()
525 	if (exca_readb(socket, I365_INTCTL) & I365_PC_IOCARD) {  in yenta_interrupt()
534 		pcmcia_parse_events(&socket->socket, events);  in yenta_interrupt()
541 	struct yenta_socket *socket = from_timer(socket, t, poll_timer);  in yenta_interrupt_wrapper()  local
543 	yenta_interrupt(0, (void *)socket);  in yenta_interrupt_wrapper()
544 	socket->poll_timer.expires = jiffies + HZ;  in yenta_interrupt_wrapper()
545 	add_timer(&socket->poll_timer);  in yenta_interrupt_wrapper()
548 static void yenta_clear_maps(struct yenta_socket *socket)  in yenta_clear_maps()  argument
555 	yenta_set_socket(&socket->socket, &dead_socket);  in yenta_clear_maps()
558 		yenta_set_io_map(&socket->socket, &io);  in yenta_clear_maps()
562 		yenta_set_mem_map(&socket->socket, &mem);  in yenta_clear_maps()
567 static void yenta_interrogate(struct yenta_socket *socket)  in yenta_interrogate()  argument
571 	state = cb_readl(socket, CB_SOCKET_STATE);  in yenta_interrogate()
575 		cb_writel(socket, CB_SOCKET_FORCE, CB_CVSTEST);  in yenta_interrogate()
581 	struct yenta_socket *socket = container_of(sock, struct yenta_socket, socket);  in yenta_sock_init()  local
583 	exca_writeb(socket, I365_GBLCTL, 0x00);  in yenta_sock_init()
584 	exca_writeb(socket, I365_GENCTL, 0x00);  in yenta_sock_init()
587 	yenta_interrogate(socket);  in yenta_sock_init()
589 	yenta_clear_maps(socket);  in yenta_sock_init()
591 	if (socket->type && socket->type->sock_init)  in yenta_sock_init()
592 		socket->type->sock_init(socket);  in yenta_sock_init()
595 	cb_writel(socket, CB_SOCKET_MASK, CB_CDMASK);  in yenta_sock_init()
602 	struct yenta_socket *socket = container_of(sock, struct yenta_socket, socket);  in yenta_sock_suspend()  local
605 	cb_writel(socket, CB_SOCKET_MASK, 0x0);  in yenta_sock_suspend()
671 static int yenta_search_res(struct yenta_socket *socket, struct resource *res,  in yenta_search_res()  argument
677 	pci_bus_for_each_resource(socket->dev->bus, root, i) {  in yenta_search_res()
691 static int yenta_allocate_res(struct yenta_socket *socket, int nr, unsigned type, int addr_start, i…  in yenta_allocate_res()  argument
693 	struct pci_dev *dev = socket->dev;  in yenta_allocate_res()
711 	region.start = config_readl(socket, addr_start) & mask;  in yenta_allocate_res()
712 	region.end = config_readl(socket, addr_end) | ~mask;  in yenta_allocate_res()
723 		if ((yenta_search_res(socket, res, BRIDGE_IO_MAX)) ||  in yenta_allocate_res()
724 		    (yenta_search_res(socket, res, BRIDGE_IO_ACC)) ||  in yenta_allocate_res()
725 		    (yenta_search_res(socket, res, BRIDGE_IO_MIN)))  in yenta_allocate_res()
729 			if ((yenta_search_res(socket, res, BRIDGE_MEM_MAX)) ||  in yenta_allocate_res()
730 			    (yenta_search_res(socket, res, BRIDGE_MEM_ACC)) ||  in yenta_allocate_res()
731 			    (yenta_search_res(socket, res, BRIDGE_MEM_MIN)))  in yenta_allocate_res()
736 		if ((yenta_search_res(socket, res, BRIDGE_MEM_MAX)) ||  in yenta_allocate_res()
737 		    (yenta_search_res(socket, res, BRIDGE_MEM_ACC)) ||  in yenta_allocate_res()
738 		    (yenta_search_res(socket, res, BRIDGE_MEM_MIN)))  in yenta_allocate_res()
752 static void yenta_allocate_resources(struct yenta_socket *socket)  in yenta_allocate_resources()  argument
755 	program += yenta_allocate_res(socket, 0, IORESOURCE_IO,  in yenta_allocate_resources()
757 	program += yenta_allocate_res(socket, 1, IORESOURCE_IO,  in yenta_allocate_resources()
759 	program += yenta_allocate_res(socket, 2, IORESOURCE_MEM|IORESOURCE_PREFETCH,  in yenta_allocate_resources()
761 	program += yenta_allocate_res(socket, 3, IORESOURCE_MEM,  in yenta_allocate_resources()
764 		pci_setup_cardbus(socket->dev->subordinate);  in yenta_allocate_resources()
771 static void yenta_free_resources(struct yenta_socket *socket)  in yenta_free_resources()  argument
776 		res = socket->dev->resource + PCI_BRIDGE_RESOURCES + i;  in yenta_free_resources()
795 	pcmcia_unregister_socket(&sock->socket);  in yenta_close()
913 static unsigned int yenta_probe_irq(struct yenta_socket *socket, u32 isa_irq_mask)  in yenta_probe_irq()  argument
924 	cb_writel(socket, CB_SOCKET_EVENT, -1);  in yenta_probe_irq()
925 	cb_writel(socket, CB_SOCKET_MASK, CB_CSTSMASK);  in yenta_probe_irq()
926 	reg = exca_readb(socket, I365_CSCINT);  in yenta_probe_irq()
927 	exca_writeb(socket, I365_CSCINT, 0);  in yenta_probe_irq()
932 		exca_writeb(socket, I365_CSCINT, I365_CSC_STSCHG | (i << 4));  in yenta_probe_irq()
933 		cb_writel(socket, CB_SOCKET_FORCE, CB_FCARDSTS);  in yenta_probe_irq()
935 		cb_writel(socket, CB_SOCKET_EVENT, -1);  in yenta_probe_irq()
937 	cb_writel(socket, CB_SOCKET_MASK, 0);  in yenta_probe_irq()
938 	exca_writeb(socket, I365_CSCINT, reg);  in yenta_probe_irq()
955 	struct yenta_socket *socket = (struct yenta_socket *) dev_id;  in yenta_probe_handler()  local
960 	cb_event = cb_readl(socket, CB_SOCKET_EVENT);  in yenta_probe_handler()
961 	cb_writel(socket, CB_SOCKET_EVENT, -1);  in yenta_probe_handler()
962 	csc = exca_readb(socket, I365_CSC);  in yenta_probe_handler()
965 		socket->probe_status = 1;  in yenta_probe_handler()
973 static int yenta_probe_cb_irq(struct yenta_socket *socket)  in yenta_probe_cb_irq()  argument
977 	if (!socket->cb_irq)  in yenta_probe_cb_irq()
980 	socket->probe_status = 0;  in yenta_probe_cb_irq()
982 	if (request_irq(socket->cb_irq, yenta_probe_handler, IRQF_SHARED, "yenta", socket)) {  in yenta_probe_cb_irq()
983 		dev_warn(&socket->dev->dev,  in yenta_probe_cb_irq()
989 	if (!socket->dev->irq)  in yenta_probe_cb_irq()
990 		reg = exca_readb(socket, I365_CSCINT);  in yenta_probe_cb_irq()
991 	exca_writeb(socket, I365_CSCINT, reg | I365_CSC_STSCHG);  in yenta_probe_cb_irq()
992 	cb_writel(socket, CB_SOCKET_EVENT, -1);  in yenta_probe_cb_irq()
993 	cb_writel(socket, CB_SOCKET_MASK, CB_CSTSMASK);  in yenta_probe_cb_irq()
994 	cb_writel(socket, CB_SOCKET_FORCE, CB_FCARDSTS);  in yenta_probe_cb_irq()
999 	cb_writel(socket, CB_SOCKET_MASK, 0);  in yenta_probe_cb_irq()
1000 	exca_writeb(socket, I365_CSCINT, reg);  in yenta_probe_cb_irq()
1001 	cb_writel(socket, CB_SOCKET_EVENT, -1);  in yenta_probe_cb_irq()
1002 	exca_readb(socket, I365_CSC);  in yenta_probe_cb_irq()
1004 	free_irq(socket->cb_irq, socket);  in yenta_probe_cb_irq()
1006 	return (int) socket->probe_status;  in yenta_probe_cb_irq()
1015 static void yenta_get_socket_capabilities(struct yenta_socket *socket, u32 isa_irq_mask)  in yenta_get_socket_capabilities()  argument
1017 	socket->socket.pci_irq = socket->cb_irq;  in yenta_get_socket_capabilities()
1019 		socket->socket.irq_mask = yenta_probe_irq(socket, isa_irq_mask);  in yenta_get_socket_capabilities()
1021 		socket->socket.irq_mask = 0;  in yenta_get_socket_capabilities()
1023 	dev_info(&socket->dev->dev, "ISA IRQ mask 0x%04x, PCI irq %d\n",  in yenta_get_socket_capabilities()
1024 		 socket->socket.irq_mask, socket->cb_irq);  in yenta_get_socket_capabilities()
1030 static void yenta_config_init(struct yenta_socket *socket)  in yenta_config_init()  argument
1033 	struct pci_dev *dev = socket->dev;  in yenta_config_init()
1036 	pcibios_resource_to_bus(socket->dev->bus, &region, &dev->resource[0]);  in yenta_config_init()
1038 	config_writel(socket, CB_LEGACY_MODE_BASE, 0);  in yenta_config_init()
1039 	config_writel(socket, PCI_BASE_ADDRESS_0, region.start);  in yenta_config_init()
1040 	config_writew(socket, PCI_COMMAND,  in yenta_config_init()
1047 	config_writeb(socket, PCI_CACHE_LINE_SIZE, L1_CACHE_BYTES / 4);  in yenta_config_init()
1048 	config_writeb(socket, PCI_LATENCY_TIMER, 168);  in yenta_config_init()
1049 	config_writel(socket, PCI_PRIMARY_BUS,  in yenta_config_init()
1061 	bridge = config_readw(socket, CB_BRIDGE_CONTROL);  in yenta_config_init()
1064 	config_writew(socket, CB_BRIDGE_CONTROL, bridge);  in yenta_config_init()
1147 	struct yenta_socket *socket;  in yenta_probe()  local
1160 	socket = kzalloc(sizeof(struct yenta_socket), GFP_KERNEL);  in yenta_probe()
1161 	if (!socket)  in yenta_probe()
1165 	socket->socket.ops = &yenta_socket_operations;  in yenta_probe()
1166 	socket->socket.resource_ops = &pccard_nonstatic_ops;  in yenta_probe()
1167 	socket->socket.dev.parent = &dev->dev;  in yenta_probe()
1168 	socket->socket.driver_data = socket;  in yenta_probe()
1169 	socket->socket.owner = THIS_MODULE;  in yenta_probe()
1170 	socket->socket.features = SS_CAP_PAGE_REGS | SS_CAP_PCCARD;  in yenta_probe()
1171 	socket->socket.map_size = 0x1000;  in yenta_probe()
1172 	socket->socket.cb_dev = dev;  in yenta_probe()
1175 	socket->dev = dev;  in yenta_probe()
1176 	pci_set_drvdata(dev, socket);  in yenta_probe()
1200 	socket->base = ioremap(pci_resource_start(dev, 0), 0x1000);  in yenta_probe()
1201 	if (!socket->base) {  in yenta_probe()
1213 	yenta_config_init(socket);  in yenta_probe()
1216 	cb_writel(socket, CB_SOCKET_MASK, 0x0);  in yenta_probe()
1219 	yenta_allocate_resources(socket);  in yenta_probe()
1221 	socket->cb_irq = dev->irq;  in yenta_probe()
1226 		socket->type = &cardbus_type[id->driver_data];  in yenta_probe()
1228 		ret = socket->type->override(socket);  in yenta_probe()
1235 …if (!socket->cb_irq || request_irq(socket->cb_irq, yenta_interrupt, IRQF_SHARED, "yenta", socket))…  in yenta_probe()
1237 		socket->cb_irq = 0; /* But zero is a valid IRQ number. */  in yenta_probe()
1238 		timer_setup(&socket->poll_timer, yenta_interrupt_wrapper, 0);  in yenta_probe()
1239 		mod_timer(&socket->poll_timer, jiffies + HZ);  in yenta_probe()
1245 		socket->socket.features |= SS_CAP_CARDBUS;  in yenta_probe()
1249 	yenta_interrogate(socket);  in yenta_probe()
1250 	yenta_get_socket_capabilities(socket, isa_interrupts);  in yenta_probe()
1252 		 cb_readl(socket, CB_SOCKET_STATE));  in yenta_probe()
1257 	ret = pcmcia_register_socket(&socket->socket);  in yenta_probe()
1270 	pcmcia_unregister_socket(&socket->socket);  in yenta_probe()
1272 	if (socket->cb_irq)  in yenta_probe()
1273 		free_irq(socket->cb_irq, socket);  in yenta_probe()
1275 		del_timer_sync(&socket->poll_timer);  in yenta_probe()
1277 	iounmap(socket->base);  in yenta_probe()
1278 	yenta_free_resources(socket);  in yenta_probe()
1285 	kfree(socket);  in yenta_probe()
1293 	struct yenta_socket *socket = pci_get_drvdata(pdev);  in yenta_dev_suspend_noirq()  local
1295 	if (!socket)  in yenta_dev_suspend_noirq()
1298 	if (socket->type && socket->type->save_state)  in yenta_dev_suspend_noirq()
1299 		socket->type->save_state(socket);  in yenta_dev_suspend_noirq()
1302 	pci_read_config_dword(pdev, 16*4, &socket->saved_state[0]);  in yenta_dev_suspend_noirq()
1303 	pci_read_config_dword(pdev, 17*4, &socket->saved_state[1]);  in yenta_dev_suspend_noirq()
1312 	struct yenta_socket *socket = pci_get_drvdata(pdev);  in yenta_dev_resume_noirq()  local
1315 	if (!socket)  in yenta_dev_resume_noirq()
1318 	pci_write_config_dword(pdev, 16*4, socket->saved_state[0]);  in yenta_dev_resume_noirq()
1319 	pci_write_config_dword(pdev, 17*4, socket->saved_state[1]);  in yenta_dev_resume_noirq()
1327 	if (socket->type && socket->type->restore_state)  in yenta_dev_resume_noirq()
1328 		socket->type->restore_state(socket);  in yenta_dev_resume_noirq()