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()
158 static inline void exca_writeb(struct yenta_socket *socket, unsigned reg, u8 val)  in exca_writeb()  argument
160 	debug("%04x %02x\n", socket, reg, val);  in exca_writeb()
161 	writeb(val, socket->base + 0x800 + reg);  in exca_writeb()
162 	readb(socket->base + 0x800 + reg); /* PCI write posting... */  in exca_writeb()
165 static void exca_writew(struct yenta_socket *socket, unsigned reg, u16 val)  in exca_writew()  argument
167 	debug("%04x %04x\n", socket, reg, val);  in exca_writew()
168 	writeb(val, socket->base + 0x800 + reg);  in exca_writew()
169 	writeb(val >> 8, socket->base + 0x800 + reg + 1);  in exca_writew()
172 	readb(socket->base + 0x800 + reg);  in exca_writew()
173 	readb(socket->base + 0x800 + reg + 1);  in exca_writew()
178 	struct yenta_socket *socket = dev_get_drvdata(yentadev);  in show_yenta_registers()  local
186 		val = cb_readl(socket, i);  in show_yenta_registers()
200 		val = exca_readb(socket, i);  in show_yenta_registers()
215 	struct yenta_socket *socket = container_of(sock, struct yenta_socket, socket);  in yenta_get_status()  local
217 	u32 state = cb_readl(socket, CB_SOCKET_STATE);  in yenta_get_status()
231 		u8 status = exca_readb(socket, I365_STATUS);  in yenta_get_status()
233 		if (exca_readb(socket, I365_INTCTL) & I365_PC_IOCARD) {  in yenta_get_status()
248 static void yenta_set_power(struct yenta_socket *socket, socket_state_t *state)  in yenta_set_power()  argument
251 	if (!(cb_readl(socket, CB_SOCKET_STATE) & CB_CBCARD) &&  in yenta_set_power()
252 	    (socket->flags & YENTA_16BIT_POWER_EXCA)) {  in yenta_set_power()
254 		reg = old = exca_readb(socket, I365_POWER);  in yenta_set_power()
258 		if (socket->flags & YENTA_16BIT_POWER_DF) {  in yenta_set_power()
300 			exca_writeb(socket, I365_POWER, reg);  in yenta_set_power()
325 		if (reg != cb_readl(socket, CB_SOCKET_CONTROL))  in yenta_set_power()
326 			cb_writel(socket, CB_SOCKET_CONTROL, reg);  in yenta_set_power()
332 	struct yenta_socket *socket = container_of(sock, struct yenta_socket, socket);  in yenta_set_socket()  local
337 		yenta_set_power(socket, state);  in yenta_set_socket()
339 	socket->io_irq = state->io_irq;  in yenta_set_socket()
340 	bridge = config_readw(socket, CB_BRIDGE_CONTROL) & ~(CB_BRIDGE_CRST | CB_BRIDGE_INTR);  in yenta_set_socket()
341 	if (cb_readl(socket, CB_SOCKET_STATE) & CB_CBCARD) {  in yenta_set_socket()
346 		intr = exca_readb(socket, I365_INTCTL);  in yenta_set_socket()
348 		if (!socket->dev->irq) {  in yenta_set_socket()
349 			intr |= socket->cb_irq ? socket->cb_irq : state->io_irq;  in yenta_set_socket()
352 		exca_writeb(socket, I365_INTCTL, intr);  in yenta_set_socket()
356 		reg = exca_readb(socket, I365_INTCTL) & (I365_RING_ENA | I365_INTR_ENA);  in yenta_set_socket()
359 		if (state->io_irq != socket->dev->irq) {  in yenta_set_socket()
363 		exca_writeb(socket, I365_INTCTL, reg);  in yenta_set_socket()
365 		reg = exca_readb(socket, I365_POWER) & (I365_VCC_MASK|I365_VPP1_MASK);  in yenta_set_socket()
371 		if (exca_readb(socket, I365_POWER) != reg)  in yenta_set_socket()
372 			exca_writeb(socket, I365_POWER, reg);  in yenta_set_socket()
375 		reg = exca_readb(socket, I365_CSCINT);  in yenta_set_socket()
389 		exca_writeb(socket, I365_CSCINT, reg);  in yenta_set_socket()
390 		exca_readb(socket, I365_CSC);  in yenta_set_socket()
394 	config_writew(socket, CB_BRIDGE_CONTROL, bridge);  in yenta_set_socket()
396 	cb_writel(socket, CB_SOCKET_EVENT, -1);  in yenta_set_socket()
397 	cb_writel(socket, CB_SOCKET_MASK, CB_CDMASK);  in yenta_set_socket()
401 		yenta_set_power(socket, state);  in yenta_set_socket()
407 	struct yenta_socket *socket = container_of(sock, struct yenta_socket, socket);  in yenta_set_io_map()  local
417 	addr = exca_readb(socket, I365_ADDRWIN);  in yenta_set_io_map()
422 		exca_writeb(socket, I365_ADDRWIN, addr);  in yenta_set_io_map()
425 	exca_writew(socket, I365_IO(map)+I365_W_START, io->start);  in yenta_set_io_map()
426 	exca_writew(socket, I365_IO(map)+I365_W_STOP, io->stop);  in yenta_set_io_map()
428 	ioctl = exca_readb(socket, I365_IOCTL) & ~I365_IOCTL_MASK(map);  in yenta_set_io_map()
435 	exca_writeb(socket, I365_IOCTL, ioctl);  in yenta_set_io_map()
438 		exca_writeb(socket, I365_ADDRWIN, addr | enable);  in yenta_set_io_map()
444 	struct yenta_socket *socket = container_of(sock, struct yenta_socket, socket);  in yenta_set_mem_map()  local
451 	pcibios_resource_to_bus(socket->dev->bus, &region, mem->res);  in yenta_set_mem_map()
463 	addr = exca_readb(socket, I365_ADDRWIN);  in yenta_set_mem_map()
466 		exca_writeb(socket, I365_ADDRWIN, addr);  in yenta_set_mem_map()
469 	exca_writeb(socket, CB_MEM_PAGE(map), start >> 24);  in yenta_set_mem_map()
476 	exca_writew(socket, I365_MEM(map) + I365_W_START, word);  in yenta_set_mem_map()
492 	exca_writew(socket, I365_MEM(map) + I365_W_STOP, word);  in yenta_set_mem_map()
499 	exca_writew(socket, I365_MEM(map) + I365_W_OFF, word);  in yenta_set_mem_map()
502 		exca_writeb(socket, I365_ADDRWIN, addr | enable);  in yenta_set_mem_map()
511 	struct yenta_socket *socket = (struct yenta_socket *) dev_id;  in yenta_interrupt()  local
516 	cb_event = cb_readl(socket, CB_SOCKET_EVENT);  in yenta_interrupt()
517 	cb_writel(socket, CB_SOCKET_EVENT, cb_event);  in yenta_interrupt()
519 	csc = exca_readb(socket, I365_CSC);  in yenta_interrupt()
526 	if (exca_readb(socket, I365_INTCTL) & I365_PC_IOCARD) {  in yenta_interrupt()
535 		pcmcia_parse_events(&socket->socket, events);  in yenta_interrupt()
542 	struct yenta_socket *socket = timer_container_of(socket, t,  in yenta_interrupt_wrapper()  local
545 	yenta_interrupt(0, (void *)socket);  in yenta_interrupt_wrapper()
546 	socket->poll_timer.expires = jiffies + HZ;  in yenta_interrupt_wrapper()
547 	add_timer(&socket->poll_timer);  in yenta_interrupt_wrapper()
550 static void yenta_clear_maps(struct yenta_socket *socket)  in yenta_clear_maps()  argument
557 	yenta_set_socket(&socket->socket, &dead_socket);  in yenta_clear_maps()
560 		yenta_set_io_map(&socket->socket, &io);  in yenta_clear_maps()
564 		yenta_set_mem_map(&socket->socket, &mem);  in yenta_clear_maps()
569 static void yenta_interrogate(struct yenta_socket *socket)  in yenta_interrogate()  argument
573 	state = cb_readl(socket, CB_SOCKET_STATE);  in yenta_interrogate()
577 		cb_writel(socket, CB_SOCKET_FORCE, CB_CVSTEST);  in yenta_interrogate()
583 	struct yenta_socket *socket = container_of(sock, struct yenta_socket, socket);  in yenta_sock_init()  local
585 	exca_writeb(socket, I365_GBLCTL, 0x00);  in yenta_sock_init()
586 	exca_writeb(socket, I365_GENCTL, 0x00);  in yenta_sock_init()
589 	yenta_interrogate(socket);  in yenta_sock_init()
591 	yenta_clear_maps(socket);  in yenta_sock_init()
593 	if (socket->type && socket->type->sock_init)  in yenta_sock_init()
594 		socket->type->sock_init(socket);  in yenta_sock_init()
597 	cb_writel(socket, CB_SOCKET_MASK, CB_CDMASK);  in yenta_sock_init()
604 	struct yenta_socket *socket = container_of(sock, struct yenta_socket, socket);  in yenta_sock_suspend()  local
607 	cb_writel(socket, CB_SOCKET_MASK, 0x0);  in yenta_sock_suspend()
673 static int yenta_search_res(struct yenta_socket *socket, struct resource *res,  in yenta_search_res()  argument
679 	pci_bus_for_each_resource(socket->dev->bus, root, i) {  in yenta_search_res()
693 static int yenta_allocate_res(struct yenta_socket *socket, int nr, unsigned type, int addr_start, i…  in yenta_allocate_res()  argument
695 	struct pci_dev *dev = socket->dev;  in yenta_allocate_res()
713 	region.start = config_readl(socket, addr_start) & mask;  in yenta_allocate_res()
714 	region.end = config_readl(socket, addr_end) | ~mask;  in yenta_allocate_res()
725 		if ((yenta_search_res(socket, res, BRIDGE_IO_MAX)) ||  in yenta_allocate_res()
726 		    (yenta_search_res(socket, res, BRIDGE_IO_ACC)) ||  in yenta_allocate_res()
727 		    (yenta_search_res(socket, res, BRIDGE_IO_MIN)))  in yenta_allocate_res()
731 			if ((yenta_search_res(socket, res, BRIDGE_MEM_MAX)) ||  in yenta_allocate_res()
732 			    (yenta_search_res(socket, res, BRIDGE_MEM_ACC)) ||  in yenta_allocate_res()
733 			    (yenta_search_res(socket, res, BRIDGE_MEM_MIN)))  in yenta_allocate_res()
738 		if ((yenta_search_res(socket, res, BRIDGE_MEM_MAX)) ||  in yenta_allocate_res()
739 		    (yenta_search_res(socket, res, BRIDGE_MEM_ACC)) ||  in yenta_allocate_res()
740 		    (yenta_search_res(socket, res, BRIDGE_MEM_MIN)))  in yenta_allocate_res()
751 static void yenta_free_res(struct yenta_socket *socket, int nr)  in yenta_free_res()  argument
753 	struct pci_dev *dev = socket->dev;  in yenta_free_res()
766 static void yenta_allocate_resources(struct yenta_socket *socket)  in yenta_allocate_resources()  argument
769 	program += yenta_allocate_res(socket, PCI_CB_BRIDGE_IO_0_WINDOW,  in yenta_allocate_resources()
772 	program += yenta_allocate_res(socket, PCI_CB_BRIDGE_IO_1_WINDOW,  in yenta_allocate_resources()
775 	program += yenta_allocate_res(socket, PCI_CB_BRIDGE_MEM_0_WINDOW,  in yenta_allocate_resources()
778 	program += yenta_allocate_res(socket, PCI_CB_BRIDGE_MEM_1_WINDOW,  in yenta_allocate_resources()
782 		pci_setup_cardbus(socket->dev->subordinate);  in yenta_allocate_resources()
789 static void yenta_free_resources(struct yenta_socket *socket)  in yenta_free_resources()  argument
791 	yenta_free_res(socket, PCI_CB_BRIDGE_IO_0_WINDOW);  in yenta_free_resources()
792 	yenta_free_res(socket, PCI_CB_BRIDGE_IO_1_WINDOW);  in yenta_free_resources()
793 	yenta_free_res(socket, PCI_CB_BRIDGE_MEM_0_WINDOW);  in yenta_free_resources()
794 	yenta_free_res(socket, PCI_CB_BRIDGE_MEM_1_WINDOW);  in yenta_free_resources()
809 	pcmcia_unregister_socket(&sock->socket);  in yenta_close()
927 static unsigned int yenta_probe_irq(struct yenta_socket *socket, u32 isa_irq_mask)  in yenta_probe_irq()  argument
938 	cb_writel(socket, CB_SOCKET_EVENT, -1);  in yenta_probe_irq()
939 	cb_writel(socket, CB_SOCKET_MASK, CB_CSTSMASK);  in yenta_probe_irq()
940 	reg = exca_readb(socket, I365_CSCINT);  in yenta_probe_irq()
941 	exca_writeb(socket, I365_CSCINT, 0);  in yenta_probe_irq()
946 		exca_writeb(socket, I365_CSCINT, I365_CSC_STSCHG | (i << 4));  in yenta_probe_irq()
947 		cb_writel(socket, CB_SOCKET_FORCE, CB_FCARDSTS);  in yenta_probe_irq()
949 		cb_writel(socket, CB_SOCKET_EVENT, -1);  in yenta_probe_irq()
951 	cb_writel(socket, CB_SOCKET_MASK, 0);  in yenta_probe_irq()
952 	exca_writeb(socket, I365_CSCINT, reg);  in yenta_probe_irq()
969 	struct yenta_socket *socket = (struct yenta_socket *) dev_id;  in yenta_probe_handler()  local
974 	cb_event = cb_readl(socket, CB_SOCKET_EVENT);  in yenta_probe_handler()
975 	cb_writel(socket, CB_SOCKET_EVENT, -1);  in yenta_probe_handler()
976 	csc = exca_readb(socket, I365_CSC);  in yenta_probe_handler()
979 		socket->probe_status = 1;  in yenta_probe_handler()
987 static int yenta_probe_cb_irq(struct yenta_socket *socket)  in yenta_probe_cb_irq()  argument
991 	if (!socket->cb_irq)  in yenta_probe_cb_irq()
994 	socket->probe_status = 0;  in yenta_probe_cb_irq()
996 	if (request_irq(socket->cb_irq, yenta_probe_handler, IRQF_SHARED, "yenta", socket)) {  in yenta_probe_cb_irq()
997 		dev_warn(&socket->dev->dev,  in yenta_probe_cb_irq()
1003 	if (!socket->dev->irq)  in yenta_probe_cb_irq()
1004 		reg = exca_readb(socket, I365_CSCINT);  in yenta_probe_cb_irq()
1005 	exca_writeb(socket, I365_CSCINT, reg | I365_CSC_STSCHG);  in yenta_probe_cb_irq()
1006 	cb_writel(socket, CB_SOCKET_EVENT, -1);  in yenta_probe_cb_irq()
1007 	cb_writel(socket, CB_SOCKET_MASK, CB_CSTSMASK);  in yenta_probe_cb_irq()
1008 	cb_writel(socket, CB_SOCKET_FORCE, CB_FCARDSTS);  in yenta_probe_cb_irq()
1013 	cb_writel(socket, CB_SOCKET_MASK, 0);  in yenta_probe_cb_irq()
1014 	exca_writeb(socket, I365_CSCINT, reg);  in yenta_probe_cb_irq()
1015 	cb_writel(socket, CB_SOCKET_EVENT, -1);  in yenta_probe_cb_irq()
1016 	exca_readb(socket, I365_CSC);  in yenta_probe_cb_irq()
1018 	free_irq(socket->cb_irq, socket);  in yenta_probe_cb_irq()
1020 	return (int) socket->probe_status;  in yenta_probe_cb_irq()
1029 static void yenta_get_socket_capabilities(struct yenta_socket *socket, u32 isa_irq_mask)  in yenta_get_socket_capabilities()  argument
1031 	socket->socket.pci_irq = socket->cb_irq;  in yenta_get_socket_capabilities()
1033 		socket->socket.irq_mask = yenta_probe_irq(socket, isa_irq_mask);  in yenta_get_socket_capabilities()
1035 		socket->socket.irq_mask = 0;  in yenta_get_socket_capabilities()
1037 	dev_info(&socket->dev->dev, "ISA IRQ mask 0x%04x, PCI irq %d\n",  in yenta_get_socket_capabilities()
1038 		 socket->socket.irq_mask, socket->cb_irq);  in yenta_get_socket_capabilities()
1044 static void yenta_config_init(struct yenta_socket *socket)  in yenta_config_init()  argument
1047 	struct pci_dev *dev = socket->dev;  in yenta_config_init()
1050 	pcibios_resource_to_bus(socket->dev->bus, &region, &dev->resource[0]);  in yenta_config_init()
1052 	config_writel(socket, CB_LEGACY_MODE_BASE, 0);  in yenta_config_init()
1053 	config_writel(socket, PCI_BASE_ADDRESS_0, region.start);  in yenta_config_init()
1054 	config_writew(socket, PCI_COMMAND,  in yenta_config_init()
1061 	config_writeb(socket, PCI_CACHE_LINE_SIZE, L1_CACHE_BYTES / 4);  in yenta_config_init()
1062 	config_writeb(socket, PCI_LATENCY_TIMER, 168);  in yenta_config_init()
1063 	config_writel(socket, PCI_PRIMARY_BUS,  in yenta_config_init()
1075 	bridge = config_readw(socket, CB_BRIDGE_CONTROL);  in yenta_config_init()
1078 	config_writew(socket, CB_BRIDGE_CONTROL, bridge);  in yenta_config_init()
1161 	struct yenta_socket *socket;  in yenta_probe()  local
1174 	socket = kzalloc(sizeof(struct yenta_socket), GFP_KERNEL);  in yenta_probe()
1175 	if (!socket)  in yenta_probe()
1179 	socket->socket.ops = &yenta_socket_operations;  in yenta_probe()
1180 	socket->socket.resource_ops = &pccard_nonstatic_ops;  in yenta_probe()
1181 	socket->socket.dev.parent = &dev->dev;  in yenta_probe()
1182 	socket->socket.driver_data = socket;  in yenta_probe()
1183 	socket->socket.owner = THIS_MODULE;  in yenta_probe()
1184 	socket->socket.features = SS_CAP_PAGE_REGS | SS_CAP_PCCARD;  in yenta_probe()
1185 	socket->socket.map_size = 0x1000;  in yenta_probe()
1186 	socket->socket.cb_dev = dev;  in yenta_probe()
1189 	socket->dev = dev;  in yenta_probe()
1190 	pci_set_drvdata(dev, socket);  in yenta_probe()
1214 	socket->base = ioremap(pci_resource_start(dev, 0), 0x1000);  in yenta_probe()
1215 	if (!socket->base) {  in yenta_probe()
1227 	yenta_config_init(socket);  in yenta_probe()
1230 	cb_writel(socket, CB_SOCKET_MASK, 0x0);  in yenta_probe()
1233 	yenta_allocate_resources(socket);  in yenta_probe()
1235 	socket->cb_irq = dev->irq;  in yenta_probe()
1240 		socket->type = &cardbus_type[id->driver_data];  in yenta_probe()
1242 		ret = socket->type->override(socket);  in yenta_probe()
1249 …if (!socket->cb_irq || request_irq(socket->cb_irq, yenta_interrupt, IRQF_SHARED, "yenta", socket))…  in yenta_probe()
1251 		socket->cb_irq = 0; /* But zero is a valid IRQ number. */  in yenta_probe()
1252 		timer_setup(&socket->poll_timer, yenta_interrupt_wrapper, 0);  in yenta_probe()
1253 		mod_timer(&socket->poll_timer, jiffies + HZ);  in yenta_probe()
1259 		socket->socket.features |= SS_CAP_CARDBUS;  in yenta_probe()
1263 	yenta_interrogate(socket);  in yenta_probe()
1264 	yenta_get_socket_capabilities(socket, isa_interrupts);  in yenta_probe()
1266 		 cb_readl(socket, CB_SOCKET_STATE));  in yenta_probe()
1271 	ret = pcmcia_register_socket(&socket->socket);  in yenta_probe()
1284 	pcmcia_unregister_socket(&socket->socket);  in yenta_probe()
1286 	if (socket->cb_irq)  in yenta_probe()
1287 		free_irq(socket->cb_irq, socket);  in yenta_probe()
1289 		timer_shutdown_sync(&socket->poll_timer);  in yenta_probe()
1291 	iounmap(socket->base);  in yenta_probe()
1292 	yenta_free_resources(socket);  in yenta_probe()
1299 	kfree(socket);  in yenta_probe()
1307 	struct yenta_socket *socket = pci_get_drvdata(pdev);  in yenta_dev_suspend_noirq()  local
1309 	if (!socket)  in yenta_dev_suspend_noirq()
1312 	if (socket->type && socket->type->save_state)  in yenta_dev_suspend_noirq()
1313 		socket->type->save_state(socket);  in yenta_dev_suspend_noirq()
1316 	pci_read_config_dword(pdev, 16*4, &socket->saved_state[0]);  in yenta_dev_suspend_noirq()
1317 	pci_read_config_dword(pdev, 17*4, &socket->saved_state[1]);  in yenta_dev_suspend_noirq()
1326 	struct yenta_socket *socket = pci_get_drvdata(pdev);  in yenta_dev_resume_noirq()  local
1329 	if (!socket)  in yenta_dev_resume_noirq()
1332 	pci_write_config_dword(pdev, 16*4, socket->saved_state[0]);  in yenta_dev_resume_noirq()
1333 	pci_write_config_dword(pdev, 17*4, socket->saved_state[1]);  in yenta_dev_resume_noirq()
1341 	if (socket->type && socket->type->restore_state)  in yenta_dev_resume_noirq()
1342 		socket->type->restore_state(socket);  in yenta_dev_resume_noirq()