Merge remote-tracking branch 'nouveau/drm-nouveau-next' into drm-fixes
[firefly-linux-kernel-4.4.55.git] / drivers / uwb / pal.c
1 /*
2  * UWB PAL support.
3  *
4  * Copyright (C) 2008 Cambridge Silicon Radio Ltd.
5  *
6  * This program is free software; you can redistribute it and/or
7  * modify it under the terms of the GNU General Public License version
8  * 2 as published by the Free Software Foundation.
9  *
10  * This program is distributed in the hope that it will be useful,
11  * but WITHOUT ANY WARRANTY; without even the implied warranty of
12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
13  * GNU General Public License for more details.
14  *
15  * You should have received a copy of the GNU General Public License
16  * along with this program.  If not, see <http://www.gnu.org/licenses/>.
17  */
18 #include <linux/kernel.h>
19 #include <linux/debugfs.h>
20 #include <linux/uwb.h>
21 #include <linux/export.h>
22
23 #include "uwb-internal.h"
24
25 /**
26  * uwb_pal_init - initialize a UWB PAL
27  * @pal: the PAL to initialize
28  */
29 void uwb_pal_init(struct uwb_pal *pal)
30 {
31         INIT_LIST_HEAD(&pal->node);
32 }
33 EXPORT_SYMBOL_GPL(uwb_pal_init);
34
35 /**
36  * uwb_pal_register - register a UWB PAL
37  * @pal: the PAL
38  *
39  * The PAL must be initialized with uwb_pal_init().
40  */
41 int uwb_pal_register(struct uwb_pal *pal)
42 {
43         struct uwb_rc *rc = pal->rc;
44         int ret;
45
46         if (pal->device) {
47                 /* create a link to the uwb_rc in the PAL device's directory. */
48                 ret = sysfs_create_link(&pal->device->kobj,
49                                         &rc->uwb_dev.dev.kobj, "uwb_rc");
50                 if (ret < 0)
51                         return ret;
52                 /* create a link to the PAL in the UWB device's directory. */
53                 ret = sysfs_create_link(&rc->uwb_dev.dev.kobj,
54                                         &pal->device->kobj, pal->name);
55                 if (ret < 0) {
56                         sysfs_remove_link(&pal->device->kobj, "uwb_rc");
57                         return ret;
58                 }
59         }
60
61         pal->debugfs_dir = uwb_dbg_create_pal_dir(pal);
62
63         mutex_lock(&rc->uwb_dev.mutex);
64         list_add(&pal->node, &rc->pals);
65         mutex_unlock(&rc->uwb_dev.mutex);
66
67         return 0;
68 }
69 EXPORT_SYMBOL_GPL(uwb_pal_register);
70
71 static int find_rc(struct device *dev, const void *data)
72 {
73         const struct uwb_rc *target_rc = data;
74         struct uwb_rc *rc = dev_get_drvdata(dev);
75
76         if (rc == NULL) {
77                 WARN_ON(1);
78                 return 0;
79         }
80         if (rc == target_rc) {
81                 if (rc->ready == 0)
82                         return 0;
83                 else
84                         return 1;
85         }
86         return 0;
87 }
88
89 /**
90  * Given a radio controller descriptor see if it is registered.
91  *
92  * @returns false if the rc does not exist or is quiescing; true otherwise.
93  */
94 static bool uwb_rc_class_device_exists(struct uwb_rc *target_rc)
95 {
96         struct device *dev;
97
98         dev = class_find_device(&uwb_rc_class, NULL, target_rc, find_rc);
99
100         return (dev != NULL);
101 }
102
103 /**
104  * uwb_pal_unregister - unregister a UWB PAL
105  * @pal: the PAL
106  */
107 void uwb_pal_unregister(struct uwb_pal *pal)
108 {
109         struct uwb_rc *rc = pal->rc;
110
111         uwb_radio_stop(pal);
112
113         mutex_lock(&rc->uwb_dev.mutex);
114         list_del(&pal->node);
115         mutex_unlock(&rc->uwb_dev.mutex);
116
117         debugfs_remove(pal->debugfs_dir);
118
119         if (pal->device) {
120                 /* remove link to the PAL in the UWB device's directory. */
121                 if (uwb_rc_class_device_exists(rc))
122                         sysfs_remove_link(&rc->uwb_dev.dev.kobj, pal->name);
123
124                 /* remove link to uwb_rc in the PAL device's directory. */
125                 sysfs_remove_link(&pal->device->kobj, "uwb_rc");
126         }
127 }
128 EXPORT_SYMBOL_GPL(uwb_pal_unregister);
129
130 /**
131  * uwb_rc_pal_init - initialize the PAL related parts of a radio controller
132  * @rc: the radio controller
133  */
134 void uwb_rc_pal_init(struct uwb_rc *rc)
135 {
136         INIT_LIST_HEAD(&rc->pals);
137 }