mirror of
				https://git.kernel.org/pub/scm/linux/kernel/git/chenhuacai/linux-loongson
				synced 2025-10-31 22:26:12 +00:00 
			
		
		
		
	 9591463af7
			
		
	
	
		9591463af7
		
	
	
	
	
		
			
			Acked-by: Greg Kroah-Hartman <gregkh@suse.de> Signed-off-by: Kay Sievers <kay.sievers@vrfy.org>
		
			
				
	
	
		
			289 lines
		
	
	
		
			8.4 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			289 lines
		
	
	
		
			8.4 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /* Code to support devices on the DIO and DIO-II bus
 | |
|  * Copyright (C) 05/1998 Peter Maydell <pmaydell@chiark.greenend.org.uk>
 | |
|  * Copyright (C) 2004 Jochen Friedrich <jochen@scram.de>
 | |
|  * 
 | |
|  * This code has basically these routines at the moment:
 | |
|  * int dio_find(u_int deviceid)
 | |
|  *    Search the list of DIO devices and return the select code
 | |
|  *    of the next unconfigured device found that matches the given device ID.
 | |
|  *    Note that the deviceid parameter should be the encoded ID.
 | |
|  *    This means that framebuffers should pass it as 
 | |
|  *    DIO_ENCODE_ID(DIO_ID_FBUFFER,DIO_ID2_TOPCAT)
 | |
|  *    (or whatever); everybody else just uses DIO_ID_FOOBAR.
 | |
|  * unsigned long dio_scodetophysaddr(int scode)
 | |
|  *    Return the physical address corresponding to the given select code.
 | |
|  * int dio_scodetoipl(int scode)
 | |
|  *    Every DIO card has a fixed interrupt priority level. This function 
 | |
|  *    returns it, whatever it is.
 | |
|  * const char *dio_scodetoname(int scode)
 | |
|  *    Return a character string describing this board [might be "" if 
 | |
|  *    not CONFIG_DIO_CONSTANTS]
 | |
|  * void dio_config_board(int scode)     mark board as configured in the list
 | |
|  * void dio_unconfig_board(int scode)   mark board as no longer configured
 | |
|  *
 | |
|  * This file is based on the way the Amiga port handles Zorro II cards, 
 | |
|  * although we aren't so complicated...
 | |
|  */
 | |
| #include <linux/module.h>
 | |
| #include <linux/string.h>
 | |
| #include <linux/types.h>
 | |
| #include <linux/kernel.h>
 | |
| #include <linux/init.h>
 | |
| #include <linux/dio.h>
 | |
| #include <linux/slab.h>                         /* kmalloc() */
 | |
| #include <asm/uaccess.h>
 | |
| #include <asm/io.h>                             /* readb() */
 | |
| 
 | |
| struct dio_bus dio_bus = {
 | |
| 	.resources = {
 | |
| 		/* DIO range */
 | |
| 		{ .name = "DIO mem", .start = 0x00600000, .end = 0x007fffff },
 | |
| 		/* DIO-II range */
 | |
| 		{ .name = "DIO-II mem", .start = 0x01000000, .end = 0x1fffffff }
 | |
| 	},
 | |
| 	.name = "DIO bus"
 | |
| };
 | |
| 
 | |
| /* not a real config option yet! */
 | |
| #define CONFIG_DIO_CONSTANTS
 | |
| 
 | |
| #ifdef CONFIG_DIO_CONSTANTS
 | |
| /* We associate each numeric ID with an appropriate descriptive string
 | |
|  * using a constant array of these structs.
 | |
|  * FIXME: we should be able to arrange to throw away most of the strings
 | |
|  * using the initdata stuff. Then we wouldn't need to worry about 
 | |
|  * carrying them around...
 | |
|  * I think we do this by copying them into newly kmalloc()ed memory and 
 | |
|  * marking the names[] array as .initdata ?
 | |
|  */
 | |
| struct dioname
 | |
| {
 | |
|         int id;
 | |
|         const char *name;
 | |
| };
 | |
| 
 | |
| /* useful macro */
 | |
| #define DIONAME(x) { DIO_ID_##x, DIO_DESC_##x }
 | |
| #define DIOFBNAME(x) { DIO_ENCODE_ID( DIO_ID_FBUFFER, DIO_ID2_##x), DIO_DESC2_##x }
 | |
| 
 | |
| static struct dioname names[] = 
 | |
| {
 | |
|         DIONAME(DCA0), DIONAME(DCA0REM), DIONAME(DCA1), DIONAME(DCA1REM),
 | |
|         DIONAME(DCM), DIONAME(DCMREM),
 | |
|         DIONAME(LAN),
 | |
|         DIONAME(FHPIB), DIONAME(NHPIB),
 | |
|         DIONAME(SCSI0), DIONAME(SCSI1), DIONAME(SCSI2), DIONAME(SCSI3),
 | |
|         DIONAME(FBUFFER),
 | |
|         DIONAME(PARALLEL), DIONAME(VME), DIONAME(DCL), DIONAME(DCLREM),
 | |
|         DIONAME(MISC0), DIONAME(MISC1), DIONAME(MISC2), DIONAME(MISC3),
 | |
|         DIONAME(MISC4), DIONAME(MISC5), DIONAME(MISC6), DIONAME(MISC7),
 | |
|         DIONAME(MISC8), DIONAME(MISC9), DIONAME(MISC10), DIONAME(MISC11), 
 | |
|         DIONAME(MISC12), DIONAME(MISC13),
 | |
|         DIOFBNAME(GATORBOX), DIOFBNAME(TOPCAT), DIOFBNAME(RENAISSANCE),
 | |
|         DIOFBNAME(LRCATSEYE), DIOFBNAME(HRCCATSEYE), DIOFBNAME(HRMCATSEYE),
 | |
|         DIOFBNAME(DAVINCI), DIOFBNAME(XXXCATSEYE), DIOFBNAME(HYPERION),
 | |
|         DIOFBNAME(XGENESIS), DIOFBNAME(TIGER), DIOFBNAME(YGENESIS)   
 | |
| };
 | |
| 
 | |
| #undef DIONAME
 | |
| #undef DIOFBNAME
 | |
| 
 | |
| static const char *unknowndioname 
 | |
|         = "unknown DIO board -- please email <linux-m68k@lists.linux-m68k.org>!";
 | |
| 
 | |
| static const char *dio_getname(int id)
 | |
| {
 | |
|         /* return pointer to a constant string describing the board with given ID */
 | |
| 	unsigned int i;
 | |
| 	for (i = 0; i < ARRAY_SIZE(names); i++)
 | |
|                 if (names[i].id == id) 
 | |
|                         return names[i].name;
 | |
| 
 | |
|         return unknowndioname;
 | |
| }
 | |
| 
 | |
| #else
 | |
| 
 | |
| static char dio_no_name[] = { 0 };
 | |
| #define dio_getname(_id)	(dio_no_name)
 | |
| 
 | |
| #endif /* CONFIG_DIO_CONSTANTS */
 | |
| 
 | |
| int __init dio_find(int deviceid)
 | |
| {
 | |
| 	/* Called to find a DIO device before the full bus scan has run.
 | |
| 	 * Only used by the console driver.
 | |
| 	 */
 | |
| 	int scode, id;
 | |
| 	u_char prid, secid, i;
 | |
| 	mm_segment_t fs;
 | |
| 
 | |
| 	for (scode = 0; scode < DIO_SCMAX; scode++) {
 | |
| 		void *va;
 | |
| 		unsigned long pa;
 | |
| 
 | |
|                 if (DIO_SCINHOLE(scode))
 | |
|                         continue;
 | |
| 
 | |
|                 pa = dio_scodetophysaddr(scode);
 | |
| 
 | |
| 		if (!pa)
 | |
| 			continue;
 | |
| 
 | |
| 		if (scode < DIOII_SCBASE)
 | |
| 			va = (void *)(pa + DIO_VIRADDRBASE);
 | |
| 		else
 | |
| 			va = ioremap(pa, PAGE_SIZE);
 | |
| 
 | |
| 		fs = get_fs();
 | |
| 		set_fs(KERNEL_DS);
 | |
| 
 | |
|                 if (get_user(i, (unsigned char *)va + DIO_IDOFF)) {
 | |
| 			set_fs(fs);
 | |
| 			if (scode >= DIOII_SCBASE)
 | |
| 				iounmap(va);
 | |
|                         continue;             /* no board present at that select code */
 | |
| 		}
 | |
| 
 | |
| 		set_fs(fs);
 | |
| 		prid = DIO_ID(va);
 | |
| 
 | |
|                 if (DIO_NEEDSSECID(prid)) {
 | |
|                         secid = DIO_SECID(va);
 | |
|                         id = DIO_ENCODE_ID(prid, secid);
 | |
|                 } else
 | |
| 			id = prid;
 | |
| 
 | |
| 		if (id == deviceid) {
 | |
| 			if (scode >= DIOII_SCBASE)
 | |
| 				iounmap(va);
 | |
| 			return scode;
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	return -1;
 | |
| }
 | |
| 
 | |
| /* This is the function that scans the DIO space and works out what
 | |
|  * hardware is actually present.
 | |
|  */
 | |
| static int __init dio_init(void)
 | |
| {
 | |
| 	int scode;
 | |
| 	mm_segment_t fs;
 | |
| 	int i;
 | |
| 	struct dio_dev *dev;
 | |
| 	int error;
 | |
| 
 | |
| 	if (!MACH_IS_HP300)
 | |
| 		return 0;
 | |
| 
 | |
|         printk(KERN_INFO "Scanning for DIO devices...\n");
 | |
| 
 | |
| 	/* Initialize the DIO bus */ 
 | |
| 	INIT_LIST_HEAD(&dio_bus.devices);
 | |
| 	dev_set_name(&dio_bus.dev, "dio");
 | |
| 	error = device_register(&dio_bus.dev);
 | |
| 	if (error) {
 | |
| 		pr_err("DIO: Error registering dio_bus\n");
 | |
| 		return error;
 | |
| 	}
 | |
| 
 | |
| 	/* Request all resources */
 | |
| 	dio_bus.num_resources = (hp300_model == HP_320 ? 1 : 2);
 | |
| 	for (i = 0; i < dio_bus.num_resources; i++)
 | |
| 		request_resource(&iomem_resource, &dio_bus.resources[i]);
 | |
| 
 | |
| 	/* Register all devices */
 | |
|         for (scode = 0; scode < DIO_SCMAX; ++scode)
 | |
|         {
 | |
|                 u_char prid, secid = 0;        /* primary, secondary ID bytes */
 | |
|                 u_char *va;
 | |
| 		unsigned long pa;
 | |
|                 
 | |
|                 if (DIO_SCINHOLE(scode))
 | |
|                         continue;
 | |
| 
 | |
| 		pa = dio_scodetophysaddr(scode);
 | |
| 
 | |
| 		if (!pa)
 | |
| 			continue;
 | |
| 
 | |
| 		if (scode < DIOII_SCBASE)
 | |
| 			va = (void *)(pa + DIO_VIRADDRBASE);
 | |
| 		else
 | |
| 			va = ioremap(pa, PAGE_SIZE);
 | |
| 
 | |
| 		fs = get_fs();
 | |
| 		set_fs(KERNEL_DS);
 | |
| 
 | |
|                 if (get_user(i, (unsigned char *)va + DIO_IDOFF)) {
 | |
| 			set_fs(fs);
 | |
| 			if (scode >= DIOII_SCBASE)
 | |
| 				iounmap(va);
 | |
|                         continue;              /* no board present at that select code */
 | |
| 		}
 | |
| 
 | |
| 		set_fs(fs);
 | |
| 
 | |
|                 /* Found a board, allocate it an entry in the list */
 | |
| 		dev = kzalloc(sizeof(struct dio_dev), GFP_KERNEL);
 | |
| 		if (!dev)
 | |
| 			return 0;
 | |
| 
 | |
| 		dev->bus = &dio_bus;
 | |
| 		dev->dev.parent = &dio_bus.dev;
 | |
| 		dev->dev.bus = &dio_bus_type;
 | |
| 		dev->scode = scode;
 | |
| 		dev->resource.start = pa;
 | |
| 		dev->resource.end = pa + DIO_SIZE(scode, va);
 | |
| 		dev_set_name(&dev->dev, "%02x", scode);
 | |
| 
 | |
|                 /* read the ID byte(s) and encode if necessary. */
 | |
| 		prid = DIO_ID(va);
 | |
| 
 | |
|                 if (DIO_NEEDSSECID(prid)) {
 | |
|                         secid = DIO_SECID(va);
 | |
|                         dev->id = DIO_ENCODE_ID(prid, secid);
 | |
|                 } else
 | |
|                         dev->id = prid;
 | |
| 
 | |
|                 dev->ipl = DIO_IPL(va);
 | |
|                 strcpy(dev->name,dio_getname(dev->id));
 | |
|                 printk(KERN_INFO "select code %3d: ipl %d: ID %02X", dev->scode, dev->ipl, prid);
 | |
|                 if (DIO_NEEDSSECID(prid))
 | |
|                         printk(":%02X", secid);
 | |
|                 printk(": %s\n", dev->name);
 | |
| 
 | |
| 		if (scode >= DIOII_SCBASE)
 | |
| 			iounmap(va);
 | |
| 		error = device_register(&dev->dev);
 | |
| 		if (error) {
 | |
| 			pr_err("DIO: Error registering device %s\n",
 | |
| 			       dev->name);
 | |
| 			continue;
 | |
| 		}
 | |
| 		error = dio_create_sysfs_dev_files(dev);
 | |
| 		if (error)
 | |
| 			dev_err(&dev->dev, "Error creating sysfs files\n");
 | |
|         }
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| subsys_initcall(dio_init);
 | |
| 
 | |
| /* Bear in mind that this is called in the very early stages of initialisation
 | |
|  * in order to get the address of the serial port for the console...
 | |
|  */
 | |
| unsigned long dio_scodetophysaddr(int scode)
 | |
| {
 | |
|         if (scode >= DIOII_SCBASE) {
 | |
|                 return (DIOII_BASE + (scode - 132) * DIOII_DEVSIZE);
 | |
|         } else if (scode > DIO_SCMAX || scode < 0)
 | |
|                 return 0;
 | |
|         else if (DIO_SCINHOLE(scode))
 | |
|                 return 0;
 | |
| 
 | |
|         return (DIO_BASE + scode * DIO_DEVSIZE);
 | |
| }
 |