class.c 3.7 KB
Newer Older
A
Alessandro Zummo 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18
/*
 * RTC subsystem, base class
 *
 * Copyright (C) 2005 Tower Technologies
 * Author: Alessandro Zummo <a.zummo@towertech.it>
 *
 * class skeleton from drivers/hwmon/hwmon.c
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
*/

#include <linux/module.h>
#include <linux/rtc.h>
#include <linux/kdev_t.h>
#include <linux/idr.h>

19 20 21
#include "rtc-core.h"


A
Alessandro Zummo 已提交
22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44
static DEFINE_IDR(rtc_idr);
static DEFINE_MUTEX(idr_lock);
struct class *rtc_class;

static void rtc_device_release(struct class_device *class_dev)
{
	struct rtc_device *rtc = to_rtc_device(class_dev);
	mutex_lock(&idr_lock);
	idr_remove(&rtc_idr, rtc->id);
	mutex_unlock(&idr_lock);
	kfree(rtc);
}

/**
 * rtc_device_register - register w/ RTC class
 * @dev: the device to register
 *
 * rtc_device_unregister() must be called when the class device is no
 * longer needed.
 *
 * Returns the pointer to the new struct class device.
 */
struct rtc_device *rtc_device_register(const char *name, struct device *dev,
45
					const struct rtc_class_ops *ops,
A
Alessandro Zummo 已提交
46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74
					struct module *owner)
{
	struct rtc_device *rtc;
	int id, err;

	if (idr_pre_get(&rtc_idr, GFP_KERNEL) == 0) {
		err = -ENOMEM;
		goto exit;
	}


	mutex_lock(&idr_lock);
	err = idr_get_new(&rtc_idr, NULL, &id);
	mutex_unlock(&idr_lock);

	if (err < 0)
		goto exit;

	id = id & MAX_ID_MASK;

	rtc = kzalloc(sizeof(struct rtc_device), GFP_KERNEL);
	if (rtc == NULL) {
		err = -ENOMEM;
		goto exit_idr;
	}

	rtc->id = id;
	rtc->ops = ops;
	rtc->owner = owner;
75
	rtc->max_user_freq = 64;
A
Alessandro Zummo 已提交
76 77 78 79 80 81 82 83 84 85 86 87 88 89 90
	rtc->class_dev.dev = dev;
	rtc->class_dev.class = rtc_class;
	rtc->class_dev.release = rtc_device_release;

	mutex_init(&rtc->ops_lock);
	spin_lock_init(&rtc->irq_lock);
	spin_lock_init(&rtc->irq_task_lock);

	strlcpy(rtc->name, name, RTC_DEVICE_NAME_SIZE);
	snprintf(rtc->class_dev.class_id, BUS_ID_SIZE, "rtc%d", id);

	err = class_device_register(&rtc->class_dev);
	if (err)
		goto exit_kfree;

91
	rtc_dev_add_device(rtc);
92
	rtc_sysfs_add_device(rtc);
93

A
Alessandro Zummo 已提交
94 95 96 97 98 99 100 101 102
	dev_info(dev, "rtc core: registered %s as %s\n",
			rtc->name, rtc->class_dev.class_id);

	return rtc;

exit_kfree:
	kfree(rtc);

exit_idr:
S
Sonny Rao 已提交
103
	mutex_lock(&idr_lock);
A
Alessandro Zummo 已提交
104
	idr_remove(&rtc_idr, id);
S
Sonny Rao 已提交
105
	mutex_unlock(&idr_lock);
A
Alessandro Zummo 已提交
106 107

exit:
108 109
	dev_err(dev, "rtc core: unable to register %s, err = %d\n",
			name, err);
A
Alessandro Zummo 已提交
110 111 112 113 114 115 116 117 118 119 120 121
	return ERR_PTR(err);
}
EXPORT_SYMBOL_GPL(rtc_device_register);


/**
 * rtc_device_unregister - removes the previously registered RTC class device
 *
 * @rtc: the RTC class device to destroy
 */
void rtc_device_unregister(struct rtc_device *rtc)
{
D
David Brownell 已提交
122 123 124 125 126
	if (class_device_get(&rtc->class_dev) != NULL) {
		mutex_lock(&rtc->ops_lock);
		/* remove innards of this RTC, then disable it, before
		 * letting any rtc_class_open() users access it again
		 */
127
		rtc_sysfs_del_device(rtc);
128
		rtc_dev_del_device(rtc);
D
David Brownell 已提交
129 130 131 132 133
		class_device_unregister(&rtc->class_dev);
		rtc->ops = NULL;
		mutex_unlock(&rtc->ops_lock);
		class_device_put(&rtc->class_dev);
	}
A
Alessandro Zummo 已提交
134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150
}
EXPORT_SYMBOL_GPL(rtc_device_unregister);

int rtc_interface_register(struct class_interface *intf)
{
	intf->class = rtc_class;
	return class_interface_register(intf);
}
EXPORT_SYMBOL_GPL(rtc_interface_register);

static int __init rtc_init(void)
{
	rtc_class = class_create(THIS_MODULE, "rtc");
	if (IS_ERR(rtc_class)) {
		printk(KERN_ERR "%s: couldn't create class\n", __FILE__);
		return PTR_ERR(rtc_class);
	}
151
	rtc_dev_init();
152
	rtc_sysfs_init(rtc_class);
A
Alessandro Zummo 已提交
153 154 155 156 157
	return 0;
}

static void __exit rtc_exit(void)
{
158
	rtc_dev_exit();
A
Alessandro Zummo 已提交
159 160 161
	class_destroy(rtc_class);
}

162
subsys_initcall(rtc_init);
A
Alessandro Zummo 已提交
163 164
module_exit(rtc_exit);

165
MODULE_AUTHOR("Alessandro Zummo <a.zummo@towertech.it>");
A
Alessandro Zummo 已提交
166 167
MODULE_DESCRIPTION("RTC class support");
MODULE_LICENSE("GPL");