52 #define to_icom_adapter(d) container_of(d, struct icom_adapter, kref)
856 	struct icom_adapter *icom_adapter;  in icom_interrupt()  local
860 	icom_adapter = (struct icom_adapter *) dev_id;  in icom_interrupt()
862 	if (icom_adapter->version == ADAPTER_V2) {  in icom_interrupt()
863 		int_reg = icom_adapter->base_addr + 0x8024;  in icom_interrupt()
869 			icom_port = &icom_adapter->port_info[2];  in icom_interrupt()
876 			icom_port = &icom_adapter->port_info[3];  in icom_interrupt()
888 		int_reg = icom_adapter->base_addr + 0x8004;  in icom_interrupt()
890 		int_reg = icom_adapter->base_addr + 0x4004;  in icom_interrupt()
897 		icom_port = &icom_adapter->port_info[0];  in icom_interrupt()
904 		icom_port = &icom_adapter->port_info[1];  in icom_interrupt()
1305 static int icom_init_ports(struct icom_adapter *icom_adapter)  in icom_init_ports()  argument
1307 	u32 subsystem_id = icom_adapter->subsystem_id;  in icom_init_ports()
1311 	if (icom_adapter->version == ADAPTER_V1) {  in icom_init_ports()
1312 		icom_adapter->numb_ports = 2;  in icom_init_ports()
1315 			icom_port = &icom_adapter->port_info[i];  in icom_init_ports()
1322 			icom_adapter->numb_ports = 4;  in icom_init_ports()
1325 				icom_port = &icom_adapter->port_info[i];  in icom_init_ports()
1332 			icom_adapter->numb_ports = 4;  in icom_init_ports()
1334 			icom_adapter->port_info[0].port = 0;  in icom_init_ports()
1335 			icom_adapter->port_info[0].status = ICOM_PORT_ACTIVE;  in icom_init_ports()
1339 				icom_adapter->port_info[0].imbed_modem = ICOM_IMBED_MODEM;  in icom_init_ports()
1341 				icom_adapter->port_info[0].imbed_modem = ICOM_RVX;  in icom_init_ports()
1344 			icom_adapter->port_info[1].status = ICOM_PORT_OFF;  in icom_init_ports()
1346 			icom_adapter->port_info[2].port = 2;  in icom_init_ports()
1347 			icom_adapter->port_info[2].status = ICOM_PORT_ACTIVE;  in icom_init_ports()
1348 			icom_adapter->port_info[2].imbed_modem = ICOM_RVX;  in icom_init_ports()
1349 			icom_adapter->port_info[3].status = ICOM_PORT_OFF;  in icom_init_ports()
1356 static void icom_port_active(struct icom_port *icom_port, struct icom_adapter *icom_adapter, int po…  in icom_port_active()  argument
1358 	if (icom_adapter->version == ADAPTER_V1) {  in icom_port_active()
1359 		icom_port->global_reg = icom_adapter->base_addr + 0x4000;  in icom_port_active()
1360 		icom_port->int_reg = icom_adapter->base_addr +  in icom_port_active()
1363 		icom_port->global_reg = icom_adapter->base_addr + 0x8000;  in icom_port_active()
1365 			icom_port->int_reg = icom_adapter->base_addr +  in icom_port_active()
1368 			icom_port->int_reg = icom_adapter->base_addr +  in icom_port_active()
1372 static int icom_load_ports(struct icom_adapter *icom_adapter)  in icom_load_ports()  argument
1377 	for (port_num = 0; port_num < icom_adapter->numb_ports; port_num++) {  in icom_load_ports()
1379 		icom_port = &icom_adapter->port_info[port_num];  in icom_load_ports()
1382 			icom_port_active(icom_port, icom_adapter, port_num);  in icom_load_ports()
1383 			icom_port->dram = icom_adapter->base_addr +  in icom_load_ports()
1386 			icom_port->adapter = icom_adapter;  in icom_load_ports()
1398 static int icom_alloc_adapter(struct icom_adapter  in icom_alloc_adapter()
1402 	struct icom_adapter *icom_adapter;  in icom_alloc_adapter()  local
1403 	struct icom_adapter *cur_adapter_entry;  in icom_alloc_adapter()
1406 	icom_adapter = kzalloc(sizeof(struct icom_adapter), GFP_KERNEL);  in icom_alloc_adapter()
1408 	if (!icom_adapter) {  in icom_alloc_adapter()
1414 		    list_entry(tmp, struct icom_adapter,  in icom_alloc_adapter()
1422 	icom_adapter->index = adapter_count;  in icom_alloc_adapter()
1423 	list_add_tail(&icom_adapter->icom_adapter_entry, tmp);  in icom_alloc_adapter()
1425 	*icom_adapter_ref = icom_adapter;  in icom_alloc_adapter()
1429 static void icom_free_adapter(struct icom_adapter *icom_adapter)  in icom_free_adapter()  argument
1431 	list_del(&icom_adapter->icom_adapter_entry);  in icom_free_adapter()
1432 	kfree(icom_adapter);  in icom_free_adapter()
1435 static void icom_remove_adapter(struct icom_adapter *icom_adapter)  in icom_remove_adapter()  argument
1440 	for (index = 0; index < icom_adapter->numb_ports; index++) {  in icom_remove_adapter()
1441 		icom_port = &icom_adapter->port_info[index];  in icom_remove_adapter()
1444 			dev_info(&icom_adapter->pci_dev->dev,  in icom_remove_adapter()
1463 	free_irq(icom_adapter->pci_dev->irq, (void *) icom_adapter);  in icom_remove_adapter()
1464 	iounmap(icom_adapter->base_addr);  in icom_remove_adapter()
1465 	pci_release_regions(icom_adapter->pci_dev);  in icom_remove_adapter()
1466 	icom_free_adapter(icom_adapter);  in icom_remove_adapter()
1471 	struct icom_adapter *icom_adapter;  in icom_kref_release()  local
1473 	icom_adapter = to_icom_adapter(kref);  in icom_kref_release()
1474 	icom_remove_adapter(icom_adapter);  in icom_kref_release()
1483 	struct icom_adapter *icom_adapter;  in icom_probe()  local
1519 	retval = icom_alloc_adapter(&icom_adapter);  in icom_probe()
1526 	icom_adapter->base_addr_pci = pci_resource_start(dev, 0);  in icom_probe()
1527 	icom_adapter->pci_dev = dev;  in icom_probe()
1528 	icom_adapter->version = ent->driver_data;  in icom_probe()
1529 	icom_adapter->subsystem_id = ent->subdevice;  in icom_probe()
1532 	retval = icom_init_ports(icom_adapter);  in icom_probe()
1538 	icom_adapter->base_addr = pci_ioremap_bar(dev, 0);  in icom_probe()
1540 	if (!icom_adapter->base_addr) {  in icom_probe()
1546 …etval = request_irq(dev->irq, icom_interrupt, IRQF_SHARED, ICOM_DRIVER_NAME, (void *)icom_adapter);  in icom_probe()
1551 	retval = icom_load_ports(icom_adapter);  in icom_probe()
1553 	for (index = 0; index < icom_adapter->numb_ports; index++) {  in icom_probe()
1554 		icom_port = &icom_adapter->port_info[index];  in icom_probe()
1561 				(unsigned char __iomem *)icom_adapter->base_addr_pci;  in icom_probe()
1565 		        icom_port->port + icom_adapter->index * 4;  in icom_probe()
1574 	kref_init(&icom_adapter->kref);  in icom_probe()
1578 	iounmap(icom_adapter->base_addr);  in icom_probe()
1580 	icom_free_adapter(icom_adapter);  in icom_probe()
1591 	struct icom_adapter *icom_adapter;  in icom_remove()  local
1595 		icom_adapter = list_entry(tmp, struct icom_adapter,  in icom_remove()
1597 		if (icom_adapter->pci_dev == dev) {  in icom_remove()
1598 			kref_put(&icom_adapter->kref, icom_kref_release);  in icom_remove()