2005-04-16 16:20:36 -06:00
|
|
|
/*
|
2012-01-19 12:02:25 -07:00
|
|
|
* smsc47b397.c - Part of lm_sensors, Linux kernel modules
|
|
|
|
* for hardware monitoring
|
|
|
|
*
|
|
|
|
* Supports the SMSC LPC47B397-NC Super-I/O chip.
|
|
|
|
*
|
|
|
|
* Author/Maintainer: Mark M. Hoffman <mhoffman@lightlink.com>
|
|
|
|
* Copyright (C) 2004 Utilitek Systems, Inc.
|
|
|
|
*
|
|
|
|
* derived in part from smsc47m1.c:
|
|
|
|
* Copyright (C) 2002 Mark D. Studebaker <mdsxyz123@yahoo.com>
|
|
|
|
* Copyright (C) 2004 Jean Delvare <khali@linux-fr.org>
|
|
|
|
*
|
|
|
|
* This program is free software; you can redistribute it and/or modify
|
|
|
|
* it under the terms of the GNU General Public License as published by
|
|
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
|
|
* (at your option) any later version.
|
|
|
|
*
|
|
|
|
* This program is distributed in the hope that it will be useful,
|
|
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
|
|
* GNU General Public License for more details.
|
|
|
|
*
|
|
|
|
* You should have received a copy of the GNU General Public License
|
|
|
|
* along with this program; if not, write to the Free Software
|
|
|
|
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
|
|
|
*/
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2010-10-20 00:51:48 -06:00
|
|
|
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
|
|
|
|
|
2005-04-16 16:20:36 -06:00
|
|
|
#include <linux/module.h>
|
|
|
|
#include <linux/slab.h>
|
|
|
|
#include <linux/ioport.h>
|
|
|
|
#include <linux/jiffies.h>
|
2007-05-08 09:22:03 -06:00
|
|
|
#include <linux/platform_device.h>
|
2005-07-15 19:39:18 -06:00
|
|
|
#include <linux/hwmon.h>
|
2007-05-08 09:22:03 -06:00
|
|
|
#include <linux/hwmon-sysfs.h>
|
2005-07-15 19:39:18 -06:00
|
|
|
#include <linux/err.h>
|
2005-04-16 16:20:36 -06:00
|
|
|
#include <linux/init.h>
|
2006-01-18 15:19:26 -07:00
|
|
|
#include <linux/mutex.h>
|
2009-01-07 08:37:35 -07:00
|
|
|
#include <linux/acpi.h>
|
2009-09-15 09:18:13 -06:00
|
|
|
#include <linux/io.h>
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2007-12-06 15:13:42 -07:00
|
|
|
static unsigned short force_id;
|
|
|
|
module_param(force_id, ushort, 0);
|
|
|
|
MODULE_PARM_DESC(force_id, "Override the detected device ID");
|
|
|
|
|
2007-05-08 09:22:03 -06:00
|
|
|
static struct platform_device *pdev;
|
|
|
|
|
|
|
|
#define DRVNAME "smsc47b397"
|
2005-04-16 16:20:36 -06:00
|
|
|
|
|
|
|
/* Super-I/0 registers and commands */
|
|
|
|
|
|
|
|
#define REG 0x2e /* The register to read/write */
|
|
|
|
#define VAL 0x2f /* The value to read/write */
|
|
|
|
|
|
|
|
static inline void superio_outb(int reg, int val)
|
|
|
|
{
|
|
|
|
outb(reg, REG);
|
|
|
|
outb(val, VAL);
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline int superio_inb(int reg)
|
|
|
|
{
|
|
|
|
outb(reg, REG);
|
|
|
|
return inb(VAL);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* select superio logical device */
|
|
|
|
static inline void superio_select(int ld)
|
|
|
|
{
|
|
|
|
superio_outb(0x07, ld);
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void superio_enter(void)
|
|
|
|
{
|
|
|
|
outb(0x55, REG);
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void superio_exit(void)
|
|
|
|
{
|
|
|
|
outb(0xAA, REG);
|
|
|
|
}
|
|
|
|
|
|
|
|
#define SUPERIO_REG_DEVID 0x20
|
|
|
|
#define SUPERIO_REG_DEVREV 0x21
|
|
|
|
#define SUPERIO_REG_BASE_MSB 0x60
|
|
|
|
#define SUPERIO_REG_BASE_LSB 0x61
|
|
|
|
#define SUPERIO_REG_LD8 0x08
|
|
|
|
|
|
|
|
#define SMSC_EXTENT 0x02
|
|
|
|
|
|
|
|
/* 0 <= nr <= 3 */
|
|
|
|
static u8 smsc47b397_reg_temp[] = {0x25, 0x26, 0x27, 0x80};
|
|
|
|
#define SMSC47B397_REG_TEMP(nr) (smsc47b397_reg_temp[(nr)])
|
|
|
|
|
|
|
|
/* 0 <= nr <= 3 */
|
|
|
|
#define SMSC47B397_REG_FAN_LSB(nr) (0x28 + 2 * (nr))
|
|
|
|
#define SMSC47B397_REG_FAN_MSB(nr) (0x29 + 2 * (nr))
|
|
|
|
|
|
|
|
struct smsc47b397_data {
|
2007-05-08 09:22:03 -06:00
|
|
|
unsigned short addr;
|
|
|
|
const char *name;
|
2007-08-20 14:46:20 -06:00
|
|
|
struct device *hwmon_dev;
|
2006-01-18 15:19:26 -07:00
|
|
|
struct mutex lock;
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2006-01-18 15:19:26 -07:00
|
|
|
struct mutex update_lock;
|
2005-04-16 16:20:36 -06:00
|
|
|
unsigned long last_updated; /* in jiffies */
|
|
|
|
int valid;
|
|
|
|
|
|
|
|
/* register values */
|
|
|
|
u16 fan[4];
|
|
|
|
u8 temp[4];
|
|
|
|
};
|
|
|
|
|
2011-11-04 05:00:47 -06:00
|
|
|
static int smsc47b397_read_value(struct smsc47b397_data *data, u8 reg)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
|
|
|
int res;
|
|
|
|
|
2006-01-18 15:19:26 -07:00
|
|
|
mutex_lock(&data->lock);
|
2007-05-08 09:22:03 -06:00
|
|
|
outb(reg, data->addr);
|
|
|
|
res = inb_p(data->addr + 1);
|
2006-01-18 15:19:26 -07:00
|
|
|
mutex_unlock(&data->lock);
|
2005-04-16 16:20:36 -06:00
|
|
|
return res;
|
|
|
|
}
|
|
|
|
|
|
|
|
static struct smsc47b397_data *smsc47b397_update_device(struct device *dev)
|
|
|
|
{
|
2007-05-08 09:22:03 -06:00
|
|
|
struct smsc47b397_data *data = dev_get_drvdata(dev);
|
2005-04-16 16:20:36 -06:00
|
|
|
int i;
|
|
|
|
|
2006-01-18 15:19:26 -07:00
|
|
|
mutex_lock(&data->update_lock);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
|
|
|
if (time_after(jiffies, data->last_updated + HZ) || !data->valid) {
|
2007-05-08 09:22:03 -06:00
|
|
|
dev_dbg(dev, "starting device update...\n");
|
2005-04-16 16:20:36 -06:00
|
|
|
|
|
|
|
/* 4 temperature inputs, 4 fan inputs */
|
|
|
|
for (i = 0; i < 4; i++) {
|
2007-05-08 09:22:03 -06:00
|
|
|
data->temp[i] = smsc47b397_read_value(data,
|
2005-04-16 16:20:36 -06:00
|
|
|
SMSC47B397_REG_TEMP(i));
|
|
|
|
|
|
|
|
/* must read LSB first */
|
2007-05-08 09:22:03 -06:00
|
|
|
data->fan[i] = smsc47b397_read_value(data,
|
2005-04-16 16:20:36 -06:00
|
|
|
SMSC47B397_REG_FAN_LSB(i));
|
2007-05-08 09:22:03 -06:00
|
|
|
data->fan[i] |= smsc47b397_read_value(data,
|
2005-04-16 16:20:36 -06:00
|
|
|
SMSC47B397_REG_FAN_MSB(i)) << 8;
|
|
|
|
}
|
|
|
|
|
|
|
|
data->last_updated = jiffies;
|
|
|
|
data->valid = 1;
|
|
|
|
|
2007-05-08 09:22:03 -06:00
|
|
|
dev_dbg(dev, "... device update complete\n");
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
|
|
|
|
2006-01-18 15:19:26 -07:00
|
|
|
mutex_unlock(&data->update_lock);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
|
|
|
return data;
|
|
|
|
}
|
|
|
|
|
2012-01-19 12:02:25 -07:00
|
|
|
/*
|
|
|
|
* TEMP: 0.001C/bit (-128C to +127C)
|
|
|
|
* REG: 1C/bit, two's complement
|
|
|
|
*/
|
2005-04-16 16:20:36 -06:00
|
|
|
static int temp_from_reg(u8 reg)
|
|
|
|
{
|
|
|
|
return (s8)reg * 1000;
|
|
|
|
}
|
|
|
|
|
2007-05-08 09:22:03 -06:00
|
|
|
static ssize_t show_temp(struct device *dev, struct device_attribute
|
|
|
|
*devattr, char *buf)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
2007-05-08 09:22:03 -06:00
|
|
|
struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
|
2005-04-16 16:20:36 -06:00
|
|
|
struct smsc47b397_data *data = smsc47b397_update_device(dev);
|
2007-05-08 09:22:03 -06:00
|
|
|
return sprintf(buf, "%d\n", temp_from_reg(data->temp[attr->index]));
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
|
|
|
|
2007-05-08 09:22:03 -06:00
|
|
|
static SENSOR_DEVICE_ATTR(temp1_input, S_IRUGO, show_temp, NULL, 0);
|
|
|
|
static SENSOR_DEVICE_ATTR(temp2_input, S_IRUGO, show_temp, NULL, 1);
|
|
|
|
static SENSOR_DEVICE_ATTR(temp3_input, S_IRUGO, show_temp, NULL, 2);
|
|
|
|
static SENSOR_DEVICE_ATTR(temp4_input, S_IRUGO, show_temp, NULL, 3);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2012-01-19 12:02:25 -07:00
|
|
|
/*
|
|
|
|
* FAN: 1 RPM/bit
|
|
|
|
* REG: count of 90kHz pulses / revolution
|
|
|
|
*/
|
2005-04-16 16:20:36 -06:00
|
|
|
static int fan_from_reg(u16 reg)
|
|
|
|
{
|
2007-06-23 06:58:22 -06:00
|
|
|
if (reg == 0 || reg == 0xffff)
|
|
|
|
return 0;
|
2005-04-16 16:20:36 -06:00
|
|
|
return 90000 * 60 / reg;
|
|
|
|
}
|
|
|
|
|
2007-05-08 09:22:03 -06:00
|
|
|
static ssize_t show_fan(struct device *dev, struct device_attribute
|
|
|
|
*devattr, char *buf)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
2007-05-08 09:22:03 -06:00
|
|
|
struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
|
|
|
|
struct smsc47b397_data *data = smsc47b397_update_device(dev);
|
|
|
|
return sprintf(buf, "%d\n", fan_from_reg(data->fan[attr->index]));
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
2007-05-08 09:22:03 -06:00
|
|
|
static SENSOR_DEVICE_ATTR(fan1_input, S_IRUGO, show_fan, NULL, 0);
|
|
|
|
static SENSOR_DEVICE_ATTR(fan2_input, S_IRUGO, show_fan, NULL, 1);
|
|
|
|
static SENSOR_DEVICE_ATTR(fan3_input, S_IRUGO, show_fan, NULL, 2);
|
|
|
|
static SENSOR_DEVICE_ATTR(fan4_input, S_IRUGO, show_fan, NULL, 3);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2007-05-08 09:22:03 -06:00
|
|
|
static ssize_t show_name(struct device *dev, struct device_attribute
|
|
|
|
*devattr, char *buf)
|
|
|
|
{
|
|
|
|
struct smsc47b397_data *data = dev_get_drvdata(dev);
|
|
|
|
return sprintf(buf, "%s\n", data->name);
|
|
|
|
}
|
|
|
|
static DEVICE_ATTR(name, S_IRUGO, show_name, NULL);
|
|
|
|
|
2006-09-24 12:59:49 -06:00
|
|
|
static struct attribute *smsc47b397_attributes[] = {
|
2007-05-08 09:22:03 -06:00
|
|
|
&sensor_dev_attr_temp1_input.dev_attr.attr,
|
|
|
|
&sensor_dev_attr_temp2_input.dev_attr.attr,
|
|
|
|
&sensor_dev_attr_temp3_input.dev_attr.attr,
|
|
|
|
&sensor_dev_attr_temp4_input.dev_attr.attr,
|
|
|
|
&sensor_dev_attr_fan1_input.dev_attr.attr,
|
|
|
|
&sensor_dev_attr_fan2_input.dev_attr.attr,
|
|
|
|
&sensor_dev_attr_fan3_input.dev_attr.attr,
|
|
|
|
&sensor_dev_attr_fan4_input.dev_attr.attr,
|
2006-09-24 12:59:49 -06:00
|
|
|
|
2007-05-08 09:22:03 -06:00
|
|
|
&dev_attr_name.attr,
|
2006-09-24 12:59:49 -06:00
|
|
|
NULL
|
|
|
|
};
|
|
|
|
|
|
|
|
static const struct attribute_group smsc47b397_group = {
|
|
|
|
.attrs = smsc47b397_attributes,
|
|
|
|
};
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2007-05-08 09:22:03 -06:00
|
|
|
static int __devexit smsc47b397_remove(struct platform_device *pdev)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
2007-05-08 09:22:03 -06:00
|
|
|
struct smsc47b397_data *data = platform_get_drvdata(pdev);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2007-08-20 14:46:20 -06:00
|
|
|
hwmon_device_unregister(data->hwmon_dev);
|
2007-05-08 09:22:03 -06:00
|
|
|
sysfs_remove_group(&pdev->dev.kobj, &smsc47b397_group);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2007-05-08 09:22:03 -06:00
|
|
|
static int smsc47b397_probe(struct platform_device *pdev);
|
[PATCH] I2C: Separate non-i2c hwmon drivers from i2c-core (5/9)
Call the ISA chip drivers detection function directly instead of relying
on i2c_detect. The net effect is that address lists won't be handled
anymore, but they were mostly useless in the ISA case anyway (pc87360,
smsc47m1, smsc47b397 had already dropped them).
We don't need to handle multiple devices, all we may need is a way to
force a given address instead of the original one (some drivers already
do: sis5595, via686a, w83627hf), and, for drivers supporting multiple
chips, a way to force one given kind. All this may be added later on
demand, but I actually don't think there will be much demand.
Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
2005-07-19 15:56:35 -06:00
|
|
|
|
2007-05-08 09:22:03 -06:00
|
|
|
static struct platform_driver smsc47b397_driver = {
|
2005-11-26 12:37:41 -07:00
|
|
|
.driver = {
|
2006-09-03 14:36:14 -06:00
|
|
|
.owner = THIS_MODULE,
|
2007-05-08 09:22:03 -06:00
|
|
|
.name = DRVNAME,
|
2005-11-26 12:37:41 -07:00
|
|
|
},
|
2007-05-08 09:22:03 -06:00
|
|
|
.probe = smsc47b397_probe,
|
2012-11-19 11:21:20 -07:00
|
|
|
.remove = smsc47b397_remove,
|
2005-04-16 16:20:36 -06:00
|
|
|
};
|
|
|
|
|
2012-11-19 11:22:35 -07:00
|
|
|
static int smsc47b397_probe(struct platform_device *pdev)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
2007-05-08 09:22:03 -06:00
|
|
|
struct device *dev = &pdev->dev;
|
2005-04-16 16:20:36 -06:00
|
|
|
struct smsc47b397_data *data;
|
2007-05-08 09:22:03 -06:00
|
|
|
struct resource *res;
|
2005-04-16 16:20:36 -06:00
|
|
|
int err = 0;
|
|
|
|
|
2007-05-08 09:22:03 -06:00
|
|
|
res = platform_get_resource(pdev, IORESOURCE_IO, 0);
|
2012-06-02 13:04:06 -06:00
|
|
|
if (!devm_request_region(dev, res->start, SMSC_EXTENT,
|
|
|
|
smsc47b397_driver.driver.name)) {
|
2007-05-08 09:22:03 -06:00
|
|
|
dev_err(dev, "Region 0x%lx-0x%lx already in use!\n",
|
|
|
|
(unsigned long)res->start,
|
|
|
|
(unsigned long)res->start + SMSC_EXTENT - 1);
|
2005-04-16 16:20:36 -06:00
|
|
|
return -EBUSY;
|
|
|
|
}
|
|
|
|
|
2012-06-02 13:04:06 -06:00
|
|
|
data = devm_kzalloc(dev, sizeof(struct smsc47b397_data), GFP_KERNEL);
|
|
|
|
if (!data)
|
|
|
|
return -ENOMEM;
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2007-05-08 09:22:03 -06:00
|
|
|
data->addr = res->start;
|
|
|
|
data->name = "smsc47b397";
|
2006-01-18 15:19:26 -07:00
|
|
|
mutex_init(&data->lock);
|
|
|
|
mutex_init(&data->update_lock);
|
2007-05-08 09:22:03 -06:00
|
|
|
platform_set_drvdata(pdev, data);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2011-11-04 05:00:47 -06:00
|
|
|
err = sysfs_create_group(&dev->kobj, &smsc47b397_group);
|
|
|
|
if (err)
|
2012-06-02 13:04:06 -06:00
|
|
|
return err;
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2007-08-20 14:46:20 -06:00
|
|
|
data->hwmon_dev = hwmon_device_register(dev);
|
|
|
|
if (IS_ERR(data->hwmon_dev)) {
|
|
|
|
err = PTR_ERR(data->hwmon_dev);
|
2006-09-24 12:59:49 -06:00
|
|
|
goto error_remove;
|
2005-07-15 19:39:18 -06:00
|
|
|
}
|
|
|
|
|
2005-04-16 16:20:36 -06:00
|
|
|
return 0;
|
|
|
|
|
2006-09-24 12:59:49 -06:00
|
|
|
error_remove:
|
2007-05-08 09:22:03 -06:00
|
|
|
sysfs_remove_group(&dev->kobj, &smsc47b397_group);
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int __init smsc47b397_device_add(unsigned short address)
|
|
|
|
{
|
|
|
|
struct resource res = {
|
|
|
|
.start = address,
|
|
|
|
.end = address + SMSC_EXTENT - 1,
|
|
|
|
.name = DRVNAME,
|
|
|
|
.flags = IORESOURCE_IO,
|
|
|
|
};
|
|
|
|
int err;
|
|
|
|
|
2009-01-07 08:37:35 -07:00
|
|
|
err = acpi_check_resource_conflict(&res);
|
|
|
|
if (err)
|
|
|
|
goto exit;
|
|
|
|
|
2007-05-08 09:22:03 -06:00
|
|
|
pdev = platform_device_alloc(DRVNAME, address);
|
|
|
|
if (!pdev) {
|
|
|
|
err = -ENOMEM;
|
2010-10-20 00:51:48 -06:00
|
|
|
pr_err("Device allocation failed\n");
|
2007-05-08 09:22:03 -06:00
|
|
|
goto exit;
|
|
|
|
}
|
|
|
|
|
|
|
|
err = platform_device_add_resources(pdev, &res, 1);
|
|
|
|
if (err) {
|
2010-10-20 00:51:48 -06:00
|
|
|
pr_err("Device resource addition failed (%d)\n", err);
|
2007-05-08 09:22:03 -06:00
|
|
|
goto exit_device_put;
|
|
|
|
}
|
|
|
|
|
|
|
|
err = platform_device_add(pdev);
|
|
|
|
if (err) {
|
2010-10-20 00:51:48 -06:00
|
|
|
pr_err("Device addition failed (%d)\n", err);
|
2007-05-08 09:22:03 -06:00
|
|
|
goto exit_device_put;
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
exit_device_put:
|
|
|
|
platform_device_put(pdev);
|
|
|
|
exit:
|
2005-04-16 16:20:36 -06:00
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2012-03-28 09:35:26 -06:00
|
|
|
static int __init smsc47b397_find(void)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
|
|
|
u8 id, rev;
|
2008-02-29 10:24:44 -07:00
|
|
|
char *name;
|
2012-03-28 09:35:26 -06:00
|
|
|
unsigned short addr;
|
2005-04-16 16:20:36 -06:00
|
|
|
|
|
|
|
superio_enter();
|
2007-12-06 15:13:42 -07:00
|
|
|
id = force_id ? force_id : superio_inb(SUPERIO_REG_DEVID);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2011-11-04 05:00:47 -06:00
|
|
|
switch (id) {
|
2008-02-29 10:24:44 -07:00
|
|
|
case 0x81:
|
|
|
|
name = "SCH5307-NS";
|
|
|
|
break;
|
|
|
|
case 0x6f:
|
|
|
|
name = "LPC47B397-NC";
|
|
|
|
break;
|
|
|
|
case 0x85:
|
|
|
|
case 0x8c:
|
|
|
|
name = "SCH5317";
|
|
|
|
break;
|
|
|
|
default:
|
2005-04-16 16:20:36 -06:00
|
|
|
superio_exit();
|
|
|
|
return -ENODEV;
|
|
|
|
}
|
|
|
|
|
|
|
|
rev = superio_inb(SUPERIO_REG_DEVREV);
|
|
|
|
|
|
|
|
superio_select(SUPERIO_REG_LD8);
|
2012-03-28 09:35:26 -06:00
|
|
|
addr = (superio_inb(SUPERIO_REG_BASE_MSB) << 8)
|
2005-04-16 16:20:36 -06:00
|
|
|
| superio_inb(SUPERIO_REG_BASE_LSB);
|
|
|
|
|
2010-10-20 00:51:48 -06:00
|
|
|
pr_info("found SMSC %s (base address 0x%04x, revision %u)\n",
|
2012-03-28 09:35:26 -06:00
|
|
|
name, addr, rev);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
|
|
|
superio_exit();
|
2012-03-28 09:35:26 -06:00
|
|
|
return addr;
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
|
|
|
|
|
|
|
static int __init smsc47b397_init(void)
|
|
|
|
{
|
2007-05-08 09:22:03 -06:00
|
|
|
unsigned short address;
|
2005-04-16 16:20:36 -06:00
|
|
|
int ret;
|
|
|
|
|
2012-03-28 09:35:26 -06:00
|
|
|
ret = smsc47b397_find();
|
|
|
|
if (ret < 0)
|
2005-04-16 16:20:36 -06:00
|
|
|
return ret;
|
2012-03-28 09:35:26 -06:00
|
|
|
address = ret;
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2007-05-08 09:22:03 -06:00
|
|
|
ret = platform_driver_register(&smsc47b397_driver);
|
|
|
|
if (ret)
|
|
|
|
goto exit;
|
|
|
|
|
|
|
|
/* Sets global pdev as a side effect */
|
|
|
|
ret = smsc47b397_device_add(address);
|
|
|
|
if (ret)
|
|
|
|
goto exit_driver;
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
exit_driver:
|
|
|
|
platform_driver_unregister(&smsc47b397_driver);
|
|
|
|
exit:
|
|
|
|
return ret;
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
|
|
|
|
|
|
|
static void __exit smsc47b397_exit(void)
|
|
|
|
{
|
2007-05-08 09:22:03 -06:00
|
|
|
platform_device_unregister(pdev);
|
|
|
|
platform_driver_unregister(&smsc47b397_driver);
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
|
|
|
|
|
|
|
MODULE_AUTHOR("Mark M. Hoffman <mhoffman@lightlink.com>");
|
|
|
|
MODULE_DESCRIPTION("SMSC LPC47B397 driver");
|
|
|
|
MODULE_LICENSE("GPL");
|
|
|
|
|
|
|
|
module_init(smsc47b397_init);
|
|
|
|
module_exit(smsc47b397_exit);
|