3 * Information Element Handling
5 * Copyright (C) 2005-2006 Intel Corporation
6 * Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com>
7 * Reinette Chatre <reinette.chatre@intel.com>
9 * This program is free software; you can redistribute it and/or
10 * modify it under the terms of the GNU General Public License version
11 * 2 as published by the Free Software Foundation.
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
27 #include <linux/slab.h>
28 #include <linux/export.h>
29 #include "uwb-internal.h"
32 * uwb_ie_next - get the next IE in a buffer
33 * @ptr: start of the buffer containing the IE data
34 * @len: length of the buffer
36 * Both @ptr and @len are updated so subsequent calls to uwb_ie_next()
37 * will get the next IE.
39 * NULL is returned (and @ptr and @len will not be updated) if there
40 * are no more IEs in the buffer or the buffer is too short.
42 struct uwb_ie_hdr
*uwb_ie_next(void **ptr
, size_t *len
)
44 struct uwb_ie_hdr
*hdr
;
47 if (*len
< sizeof(struct uwb_ie_hdr
))
51 ie_len
= sizeof(struct uwb_ie_hdr
) + hdr
->length
;
61 EXPORT_SYMBOL_GPL(uwb_ie_next
);
64 * uwb_ie_dump_hex - print IEs to a character buffer
65 * @ies: the IEs to print.
66 * @len: length of all the IEs.
67 * @buf: the destination buffer.
68 * @size: size of @buf.
70 * Returns the number of characters written.
72 int uwb_ie_dump_hex(const struct uwb_ie_hdr
*ies
, size_t len
,
73 char *buf
, size_t size
)
76 const struct uwb_ie_hdr
*ie
;
82 ie
= uwb_ie_next(&ptr
, &len
);
86 r
+= scnprintf(buf
+ r
, size
- r
, "%02x %02x",
87 (unsigned)ie
->element_id
,
88 (unsigned)ie
->length
);
89 d
= (uint8_t *)ie
+ sizeof(struct uwb_ie_hdr
);
90 while (d
!= ptr
&& r
< size
)
91 r
+= scnprintf(buf
+ r
, size
- r
, " %02x", (unsigned)*d
++);
100 * Get the IEs that a radio controller is sending in its beacon
102 * @uwb_rc: UWB Radio Controller
103 * @returns: Size read from the system
105 * We don't need to lock the uwb_rc's mutex because we don't modify
106 * anything. Once done with the iedata buffer, call
107 * uwb_rc_ie_release(iedata). Don't call kfree on it.
110 ssize_t
uwb_rc_get_ie(struct uwb_rc
*uwb_rc
, struct uwb_rc_evt_get_ie
**pget_ie
)
113 struct device
*dev
= &uwb_rc
->uwb_dev
.dev
;
114 struct uwb_rccb
*cmd
= NULL
;
115 struct uwb_rceb
*reply
= NULL
;
116 struct uwb_rc_evt_get_ie
*get_ie
;
118 cmd
= kzalloc(sizeof(*cmd
), GFP_KERNEL
);
122 cmd
->bCommandType
= UWB_RC_CET_GENERAL
;
123 cmd
->wCommand
= cpu_to_le16(UWB_RC_CMD_GET_IE
);
124 result
= uwb_rc_vcmd(uwb_rc
, "GET_IE", cmd
, sizeof(*cmd
),
125 UWB_RC_CET_GENERAL
, UWB_RC_CMD_GET_IE
,
131 get_ie
= container_of(reply
, struct uwb_rc_evt_get_ie
, rceb
);
132 if (result
< sizeof(*get_ie
)) {
133 dev_err(dev
, "not enough data returned for decoding GET IE "
134 "(%zu bytes received vs %zu needed)\n",
135 result
, sizeof(*get_ie
));
137 } else if (result
< sizeof(*get_ie
) + le16_to_cpu(get_ie
->wIELength
)) {
138 dev_err(dev
, "not enough data returned for decoding GET IE "
139 "payload (%zu bytes received vs %zu needed)\n", result
,
140 sizeof(*get_ie
) + le16_to_cpu(get_ie
->wIELength
));
150 * Replace all IEs currently being transmitted by a device
152 * @cmd: pointer to the SET-IE command with the IEs to set
153 * @size: size of @buf
155 int uwb_rc_set_ie(struct uwb_rc
*rc
, struct uwb_rc_cmd_set_ie
*cmd
)
158 struct device
*dev
= &rc
->uwb_dev
.dev
;
159 struct uwb_rc_evt_set_ie reply
;
161 reply
.rceb
.bEventType
= UWB_RC_CET_GENERAL
;
162 reply
.rceb
.wEvent
= UWB_RC_CMD_SET_IE
;
163 result
= uwb_rc_cmd(rc
, "SET-IE", &cmd
->rccb
,
164 sizeof(*cmd
) + le16_to_cpu(cmd
->wIELength
),
165 &reply
.rceb
, sizeof(reply
));
168 else if (result
!= sizeof(reply
)) {
169 dev_err(dev
, "SET-IE: not enough data to decode reply "
170 "(%d bytes received vs %zu needed)\n",
171 result
, sizeof(reply
));
173 } else if (reply
.bResultCode
!= UWB_RC_RES_SUCCESS
) {
174 dev_err(dev
, "SET-IE: command execution failed: %s (%d)\n",
175 uwb_rc_strerror(reply
.bResultCode
), reply
.bResultCode
);
183 /* Cleanup the whole IE management subsystem */
184 void uwb_rc_ie_init(struct uwb_rc
*uwb_rc
)
186 mutex_init(&uwb_rc
->ies_mutex
);
191 * uwb_rc_ie_setup - setup a radio controller's IE manager
192 * @uwb_rc: the radio controller.
194 * The current set of IEs are obtained from the hardware with a GET-IE
195 * command (since the radio controller is not yet beaconing this will
196 * be just the hardware's MAC and PHY Capability IEs).
198 * Returns 0 on success; -ve on an error.
200 int uwb_rc_ie_setup(struct uwb_rc
*uwb_rc
)
202 struct uwb_rc_evt_get_ie
*ie_info
= NULL
;
205 capacity
= uwb_rc_get_ie(uwb_rc
, &ie_info
);
209 mutex_lock(&uwb_rc
->ies_mutex
);
211 uwb_rc
->ies
= (struct uwb_rc_cmd_set_ie
*)ie_info
;
212 uwb_rc
->ies
->rccb
.bCommandType
= UWB_RC_CET_GENERAL
;
213 uwb_rc
->ies
->rccb
.wCommand
= cpu_to_le16(UWB_RC_CMD_SET_IE
);
214 uwb_rc
->ies_capacity
= capacity
;
216 mutex_unlock(&uwb_rc
->ies_mutex
);
222 /* Cleanup the whole IE management subsystem */
223 void uwb_rc_ie_release(struct uwb_rc
*uwb_rc
)
227 uwb_rc
->ies_capacity
= 0;
231 static int uwb_rc_ie_add_one(struct uwb_rc
*rc
, const struct uwb_ie_hdr
*new_ie
)
233 struct uwb_rc_cmd_set_ie
*new_ies
;
235 struct uwb_ie_hdr
*ie
;
236 size_t length
, new_ie_len
, new_capacity
, size
, prev_size
;
238 length
= le16_to_cpu(rc
->ies
->wIELength
);
239 new_ie_len
= sizeof(struct uwb_ie_hdr
) + new_ie
->length
;
240 new_capacity
= sizeof(struct uwb_rc_cmd_set_ie
) + length
+ new_ie_len
;
242 if (new_capacity
> rc
->ies_capacity
) {
243 new_ies
= krealloc(rc
->ies
, new_capacity
, GFP_KERNEL
);
249 ptr
= rc
->ies
->IEData
;
254 ie
= uwb_ie_next(&ptr
, &size
);
255 if (!ie
|| ie
->element_id
> new_ie
->element_id
)
259 memmove(prev_ie
+ new_ie_len
, prev_ie
, prev_size
);
260 memcpy(prev_ie
, new_ie
, new_ie_len
);
261 rc
->ies
->wIELength
= cpu_to_le16(length
+ new_ie_len
);
267 * uwb_rc_ie_add - add new IEs to the radio controller's beacon
268 * @uwb_rc: the radio controller.
269 * @ies: the buffer containing the new IE or IEs to be added to
270 * the device's beacon.
271 * @size: length of all the IEs.
273 * According to WHCI 0.95 [4.13.6] the driver will only receive the RCEB
274 * after the device sent the first beacon that includes the IEs specified
275 * in the SET IE command. We thus cannot send this command if the device is
276 * not beaconing. Instead, a SET IE command will be sent later right after
277 * we start beaconing.
279 * Setting an IE on the device will overwrite all current IEs in device. So
280 * we take the current IEs being transmitted by the device, insert the
281 * new one, and call SET IE with all the IEs needed.
283 * Returns 0 on success; or -ENOMEM.
285 int uwb_rc_ie_add(struct uwb_rc
*uwb_rc
,
286 const struct uwb_ie_hdr
*ies
, size_t size
)
290 const struct uwb_ie_hdr
*ie
;
292 mutex_lock(&uwb_rc
->ies_mutex
);
296 ie
= uwb_ie_next(&ptr
, &size
);
300 result
= uwb_rc_ie_add_one(uwb_rc
, ie
);
306 if (uwb_rc
->beaconing
!= -1)
307 result
= uwb_rc_set_ie(uwb_rc
, uwb_rc
->ies
);
312 mutex_unlock(&uwb_rc
->ies_mutex
);
316 EXPORT_SYMBOL_GPL(uwb_rc_ie_add
);
320 * Remove an IE from internal cache
322 * We are dealing with our internal IE cache so no need to verify that the
323 * IEs are valid (it has been done already).
325 * Should be called with ies_mutex held
327 * We do not break out once an IE is found in the cache. It is currently
328 * possible to have more than one IE with the same ID included in the
329 * beacon. We don't reallocate, we just mark the size smaller.
332 void uwb_rc_ie_cache_rm(struct uwb_rc
*uwb_rc
, enum uwb_ie to_remove
)
334 struct uwb_ie_hdr
*ie
;
335 size_t len
= le16_to_cpu(uwb_rc
->ies
->wIELength
);
339 ptr
= uwb_rc
->ies
->IEData
;
342 ie
= uwb_ie_next(&ptr
, &size
);
345 if (ie
->element_id
== to_remove
) {
346 len
-= sizeof(struct uwb_ie_hdr
) + ie
->length
;
347 memmove(ie
, ptr
, size
);
351 uwb_rc
->ies
->wIELength
= cpu_to_le16(len
);
356 * uwb_rc_ie_rm - remove an IE from the radio controller's beacon
357 * @uwb_rc: the radio controller.
358 * @element_id: the element ID of the IE to remove.
360 * Only IEs previously added with uwb_rc_ie_add() may be removed.
362 * Returns 0 on success; or -ve the SET-IE command to the radio
365 int uwb_rc_ie_rm(struct uwb_rc
*uwb_rc
, enum uwb_ie element_id
)
369 mutex_lock(&uwb_rc
->ies_mutex
);
371 uwb_rc_ie_cache_rm(uwb_rc
, element_id
);
373 if (uwb_rc
->beaconing
!= -1)
374 result
= uwb_rc_set_ie(uwb_rc
, uwb_rc
->ies
);
376 mutex_unlock(&uwb_rc
->ies_mutex
);
380 EXPORT_SYMBOL_GPL(uwb_rc_ie_rm
);
This page took 0.037744 seconds and 5 git commands to generate.