1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
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
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
|
/*
* Copyright (C) 2013-2014 Kay Sievers
* Copyright (C) 2013-2014 Greg Kroah-Hartman <gregkh@linuxfoundation.org>
* Copyright (C) 2013-2014 Daniel Mack <daniel@zonque.org>
* Copyright (C) 2013-2014 David Herrmann <dh.herrmann@gmail.com>
* Copyright (C) 2013-2014 Linux Foundation
*
* kdbus is free software; you can redistribute it and/or modify it under
* the terms of the GNU Lesser General Public License as published by the
* Free Software Foundation; either version 2.1 of the License, or (at
* your option) any later version.
*/
#include <linux/device.h>
#include <linux/fs.h>
#include <linux/init.h>
#include <linux/module.h>
#include <linux/mutex.h>
#include <linux/spinlock.h>
#include <linux/sched.h>
#include <linux/slab.h>
#include "bus.h"
#include "connection.h"
#include "endpoint.h"
#include "item.h"
#include "message.h"
#include "notify.h"
static int kdbus_notify_reply(struct kdbus_bus *bus, u64 id,
u64 cookie, u64 msg_type)
{
struct kdbus_kmsg *kmsg = NULL;
BUG_ON(id == 0);
kmsg = kdbus_kmsg_new(0);
if (IS_ERR(kmsg))
return PTR_ERR(kmsg);
/*
* a kernel-generated notification can only contain one
* struct kdbus_item, so make a shortcut here for
* faster lookup in the match db.
*/
kmsg->notify_type = msg_type;
kmsg->msg.dst_id = id;
kmsg->msg.src_id = KDBUS_SRC_ID_KERNEL;
kmsg->msg.payload_type = KDBUS_PAYLOAD_KERNEL;
kmsg->msg.cookie_reply = cookie;
kmsg->msg.items[0].type = msg_type;
spin_lock(&bus->notify_lock);
list_add_tail(&kmsg->queue_entry, &bus->notify_list);
spin_unlock(&bus->notify_lock);
return 0;
}
/**
* kdbus_notify_reply_timeout() - queue a timeout reply
* @bus: Bus which queues the messages
* @id: The destination's connection ID
* @cookie: The cookie to set in the reply.
*
* Queues a message that has a KDBUS_ITEM_REPLY_TIMEOUT item attached.
*
* Return: 0 on success, negative errno on failure.
*/
int kdbus_notify_reply_timeout(struct kdbus_bus *bus, u64 id, u64 cookie)
{
return kdbus_notify_reply(bus, id, cookie, KDBUS_ITEM_REPLY_TIMEOUT);
}
/**
* kdbus_notify_reply_dead() - queue a 'dead' reply
* @bus: Bus which queues the messages
* @id: The destination's connection ID
* @cookie: The cookie to set in the reply.
*
* Queues a message that has a KDBUS_ITEM_REPLY_DEAD item attached.
*
* Return: 0 on success, negative errno on failure.
*/
int kdbus_notify_reply_dead(struct kdbus_bus *bus, u64 id, u64 cookie)
{
return kdbus_notify_reply(bus, id, cookie, KDBUS_ITEM_REPLY_DEAD);
}
/**
* kdbus_notify_name_change() - queue a notification about a name owner change
* @bus: Bus which queues the messages
* @type: The type if the notification; KDBUS_ITEM_NAME_ADD,
* KDBUS_ITEM_NAME_CHANGE or KDBUS_ITEM_NAME_REMOVE
* @old_id: The id of the connection that used to own the name
* @new_id: The id of the new owner connection
* @old_flags: The flags to pass in the KDBUS_ITEM flags field for
* the old owner
* @new_flags: The flags to pass in the KDBUS_ITEM flags field for
* the new owner
* @name: The name that was removed or assigned to a new owner
*
* Return: 0 on success, negative errno on failure.
*/
int kdbus_notify_name_change(struct kdbus_bus *bus, u64 type,
u64 old_id, u64 new_id,
u64 old_flags, u64 new_flags,
const char *name)
{
struct kdbus_kmsg *kmsg = NULL;
size_t name_len, extra_size;
name_len = strlen(name) + 1;
extra_size = sizeof(struct kdbus_notify_name_change) + name_len;
kmsg = kdbus_kmsg_new(extra_size);
if (IS_ERR(kmsg))
return PTR_ERR(kmsg);
kmsg->msg.dst_id = KDBUS_DST_ID_BROADCAST;
kmsg->msg.src_id = KDBUS_SRC_ID_KERNEL;
kmsg->msg.payload_type = KDBUS_PAYLOAD_KERNEL;
kmsg->notify_type = type;
kmsg->notify_old_id = old_id;
kmsg->notify_new_id = new_id;
kmsg->msg.items[0].type = type;
kmsg->msg.items[0].name_change.old_id.id = old_id;
kmsg->msg.items[0].name_change.old_id.flags = old_flags;
kmsg->msg.items[0].name_change.new_id.id = new_id;
kmsg->msg.items[0].name_change.new_id.flags = new_flags;
memcpy(kmsg->msg.items[0].name_change.name, name, name_len);
kmsg->notify_name = kmsg->msg.items[0].name_change.name;
spin_lock(&bus->notify_lock);
list_add_tail(&kmsg->queue_entry, &bus->notify_list);
spin_unlock(&bus->notify_lock);
return 0;
}
/**
* kdbus_notify_id_change() - queue a notification about a unique ID change
* @bus: Bus which queues the messages
* @type: The type if the notification; KDBUS_ITEM_ID_ADD or
* KDBUS_ITEM_ID_REMOVE
* @id: The id of the connection that was added or removed
* @flags: The flags to pass in the KDBUS_ITEM flags field
*
* Return: 0 on success, negative errno on failure.
*/
int kdbus_notify_id_change(struct kdbus_bus *bus, u64 type, u64 id, u64 flags)
{
struct kdbus_kmsg *kmsg = NULL;
kmsg = kdbus_kmsg_new(sizeof(struct kdbus_notify_id_change));
if (IS_ERR(kmsg))
return PTR_ERR(kmsg);
kmsg->msg.dst_id = KDBUS_DST_ID_BROADCAST;
kmsg->msg.src_id = KDBUS_SRC_ID_KERNEL;
kmsg->msg.payload_type = KDBUS_PAYLOAD_KERNEL;
kmsg->notify_type = type;
switch (type) {
case KDBUS_ITEM_ID_ADD:
kmsg->notify_new_id = id;
break;
case KDBUS_ITEM_ID_REMOVE:
kmsg->notify_old_id = id;
break;
default:
BUG();
}
kmsg->msg.items[0].type = type;
kmsg->msg.items[0].id_change.id = id;
kmsg->msg.items[0].id_change.flags = flags;
spin_lock(&bus->notify_lock);
list_add_tail(&kmsg->queue_entry, &bus->notify_list);
spin_unlock(&bus->notify_lock);
return 0;
}
/**
* kdbus_notify_flush() - send a list of collected messages
* @bus: Bus which queues the messages
*
* The list is empty after sending the messages.
*/
void kdbus_notify_flush(struct kdbus_bus *bus)
{
LIST_HEAD(notify_list);
struct kdbus_kmsg *kmsg, *tmp;
struct kdbus_ep *ep = NULL;
/* bus->ep is only valid as long as the bus is alive */
mutex_lock(&bus->lock);
if (!bus->disconnected)
ep = kdbus_ep_ref(bus->ep);
mutex_unlock(&bus->lock);
mutex_lock(&bus->notify_flush_lock);
spin_lock(&bus->notify_lock);
list_splice_init(&bus->notify_list, ¬ify_list);
spin_unlock(&bus->notify_lock);
list_for_each_entry_safe(kmsg, tmp, ¬ify_list, queue_entry) {
if (ep)
kdbus_conn_kmsg_send(ep, NULL, kmsg);
list_del(&kmsg->queue_entry);
kdbus_kmsg_free(kmsg);
}
mutex_unlock(&bus->notify_flush_lock);
kdbus_ep_unref(ep);
}
/**
* kdbus_notify_free() - free a list of collected messages
* @bus: Bus which queues the messages
*/
void kdbus_notify_free(struct kdbus_bus *bus)
{
struct kdbus_kmsg *kmsg, *tmp;
list_for_each_entry_safe(kmsg, tmp, &bus->notify_list, queue_entry) {
list_del(&kmsg->queue_entry);
kdbus_kmsg_free(kmsg);
}
}
|
