mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
synced 2024-08-27 03:10:12 +00:00
![Yang Yingliang](/assets/img/avatar_default.png)
If device_register() returns error, the 'dev' and name needs be freed. Add a release function, and then call put_device() in the error path, so the name is freed in kobject_cleanup() and to the 'dev' is freed in release function. Fixes:2e4c77bea3
("m68k: dio - Kill warn_unused_result warnings") Fixes:1fa5ae857b
("driver core: get rid of struct device's bus_id string array") Signed-off-by: Yang Yingliang <yangyingliang@huawei.com> Link: https://lore.kernel.org/r/20221109064036.1835346-1-yangyingliang@huawei.com Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
287 lines
7.8 KiB
C
287 lines
7.8 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/* 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 <linux/uaccess.h>
|
|
#include <linux/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 */
|
|
|
|
static void dio_dev_release(struct device *dev)
|
|
{
|
|
struct dio_dev *ddev = container_of(dev, typeof(struct dio_dev), dev);
|
|
kfree(ddev);
|
|
}
|
|
|
|
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;
|
|
|
|
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);
|
|
|
|
if (copy_from_kernel_nofault(&i,
|
|
(unsigned char *)va + DIO_IDOFF, 1)) {
|
|
if (scode >= DIOII_SCBASE)
|
|
iounmap(va);
|
|
continue; /* no board present at that select code */
|
|
}
|
|
|
|
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;
|
|
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);
|
|
|
|
if (copy_from_kernel_nofault(&i,
|
|
(unsigned char *)va + DIO_IDOFF, 1)) {
|
|
if (scode >= DIOII_SCBASE)
|
|
iounmap(va);
|
|
continue; /* no board present at that select code */
|
|
}
|
|
|
|
/* Found a board, allocate it an entry in the list */
|
|
dev = kzalloc(sizeof(struct dio_dev), GFP_KERNEL);
|
|
if (!dev) {
|
|
if (scode >= DIOII_SCBASE)
|
|
iounmap(va);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
dev->bus = &dio_bus;
|
|
dev->dev.parent = &dio_bus.dev;
|
|
dev->dev.bus = &dio_bus_type;
|
|
dev->dev.release = dio_dev_release;
|
|
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);
|
|
put_device(&dev->dev);
|
|
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);
|
|
}
|