class.c 3.6 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
	rtc_proc_add_device(rtc);
94

A
Alessandro Zummo 已提交
95 96 97 98 99 100 101 102 103
	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 已提交
104
	mutex_lock(&idr_lock);
A
Alessandro Zummo 已提交
105
	idr_remove(&rtc_idr, id);
S
Sonny Rao 已提交
106
	mutex_unlock(&idr_lock);
A
Alessandro Zummo 已提交
107 108

exit:
109 110
	dev_err(dev, "rtc core: unable to register %s, err = %d\n",
			name, err);
A
Alessandro Zummo 已提交
111 112 113 114 115 116 117 118 119 120 121 122
	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 已提交
123 124 125 126 127
	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
		 */
128
		rtc_sysfs_del_device(rtc);
129
		rtc_dev_del_device(rtc);
130
		rtc_proc_del_device(rtc);
D
David Brownell 已提交
131 132 133 134 135
		class_device_unregister(&rtc->class_dev);
		rtc->ops = NULL;
		mutex_unlock(&rtc->ops_lock);
		class_device_put(&rtc->class_dev);
	}
A
Alessandro Zummo 已提交
136 137 138 139 140 141 142 143 144 145
}
EXPORT_SYMBOL_GPL(rtc_device_unregister);

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);
	}
146
	rtc_dev_init();
147
	rtc_sysfs_init(rtc_class);
A
Alessandro Zummo 已提交
148 149 150 151 152
	return 0;
}

static void __exit rtc_exit(void)
{
153
	rtc_dev_exit();
A
Alessandro Zummo 已提交
154 155 156
	class_destroy(rtc_class);
}

157
subsys_initcall(rtc_init);
A
Alessandro Zummo 已提交
158 159
module_exit(rtc_exit);

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