V4L/DVB (10012): m5602: Start to unify read/write sensor functions
[linux-2.6] / drivers / uwb / drp.c
1 /*
2  * Ultra Wide Band
3  * Dynamic Reservation Protocol handling
4  *
5  * Copyright (C) 2005-2006 Intel Corporation
6  * Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com>
7  * Copyright (C) 2008 Cambridge Silicon Radio Ltd.
8  *
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.
12  *
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.
17  *
18  * You should have received a copy of the GNU General Public License
19  * along with this program.  If not, see <http://www.gnu.org/licenses/>.
20  */
21 #include <linux/kthread.h>
22 #include <linux/freezer.h>
23 #include <linux/delay.h>
24 #include "uwb-internal.h"
25
26 /**
27  * Construct and send the SET DRP IE
28  *
29  * @rc:         UWB Host controller
30  * @returns:    >= 0 number of bytes still available in the beacon
31  *              < 0 errno code on error.
32  *
33  * See WUSB[8.6.2.7]: The host must set all the DRP IEs that it wants the
34  * device to include in its beacon at the same time. We thus have to
35  * traverse all reservations and include the DRP IEs of all PENDING
36  * and NEGOTIATED reservations in a SET DRP command for transmission.
37  *
38  * A DRP Availability IE is appended.
39  *
40  * rc->uwb_dev.mutex is held
41  *
42  * FIXME We currently ignore the returned value indicating the remaining space
43  * in beacon. This could be used to deny reservation requests earlier if
44  * determined that they would cause the beacon space to be exceeded.
45  */
46 static
47 int uwb_rc_gen_send_drp_ie(struct uwb_rc *rc)
48 {
49         int result;
50         struct device *dev = &rc->uwb_dev.dev;
51         struct uwb_rc_cmd_set_drp_ie *cmd;
52         struct uwb_rc_evt_set_drp_ie reply;
53         struct uwb_rsv *rsv;
54         int num_bytes = 0;
55         u8 *IEDataptr;
56
57         result = -ENOMEM;
58         /* First traverse all reservations to determine memory needed. */
59         list_for_each_entry(rsv, &rc->reservations, rc_node) {
60                 if (rsv->drp_ie != NULL)
61                         num_bytes += rsv->drp_ie->hdr.length + 2;
62         }
63         num_bytes += sizeof(rc->drp_avail.ie);
64         cmd = kzalloc(sizeof(*cmd) + num_bytes, GFP_KERNEL);
65         if (cmd == NULL)
66                 goto error;
67         cmd->rccb.bCommandType = UWB_RC_CET_GENERAL;
68         cmd->rccb.wCommand = cpu_to_le16(UWB_RC_CMD_SET_DRP_IE);
69         cmd->wIELength = num_bytes;
70         IEDataptr = (u8 *)&cmd->IEData[0];
71
72         /* Next traverse all reservations to place IEs in allocated memory. */
73         list_for_each_entry(rsv, &rc->reservations, rc_node) {
74                 if (rsv->drp_ie != NULL) {
75                         memcpy(IEDataptr, rsv->drp_ie,
76                                rsv->drp_ie->hdr.length + 2);
77                         IEDataptr += rsv->drp_ie->hdr.length + 2;
78                 }
79         }
80         memcpy(IEDataptr, &rc->drp_avail.ie, sizeof(rc->drp_avail.ie));
81
82         reply.rceb.bEventType = UWB_RC_CET_GENERAL;
83         reply.rceb.wEvent = UWB_RC_CMD_SET_DRP_IE;
84         result = uwb_rc_cmd(rc, "SET-DRP-IE", &cmd->rccb,
85                         sizeof(*cmd) + num_bytes, &reply.rceb,
86                         sizeof(reply));
87         if (result < 0)
88                 goto error_cmd;
89         result = le16_to_cpu(reply.wRemainingSpace);
90         if (reply.bResultCode != UWB_RC_RES_SUCCESS) {
91                 dev_err(&rc->uwb_dev.dev, "SET-DRP-IE: command execution "
92                                 "failed: %s (%d). RemainingSpace in beacon "
93                                 "= %d\n", uwb_rc_strerror(reply.bResultCode),
94                                 reply.bResultCode, result);
95                 result = -EIO;
96         } else {
97                 dev_dbg(dev, "SET-DRP-IE sent. RemainingSpace in beacon "
98                              "= %d.\n", result);
99                 result = 0;
100         }
101 error_cmd:
102         kfree(cmd);
103 error:
104         return result;
105
106 }
107 /**
108  * Send all DRP IEs associated with this host
109  *
110  * @returns:    >= 0 number of bytes still available in the beacon
111  *              < 0 errno code on error.
112  *
113  * As per the protocol we obtain the host controller device lock to access
114  * bandwidth structures.
115  */
116 int uwb_rc_send_all_drp_ie(struct uwb_rc *rc)
117 {
118         int result;
119
120         mutex_lock(&rc->uwb_dev.mutex);
121         result = uwb_rc_gen_send_drp_ie(rc);
122         mutex_unlock(&rc->uwb_dev.mutex);
123         return result;
124 }
125
126 void uwb_drp_handle_timeout(struct uwb_rsv *rsv)
127 {
128         struct device *dev = &rsv->rc->uwb_dev.dev;
129
130         dev_dbg(dev, "reservation timeout in state %s (%d)\n",
131                 uwb_rsv_state_str(rsv->state), rsv->state);
132
133         switch (rsv->state) {
134         case UWB_RSV_STATE_O_INITIATED:
135                 if (rsv->is_multicast) {
136                         uwb_rsv_set_state(rsv, UWB_RSV_STATE_O_ESTABLISHED);
137                         return;
138                 }
139                 break;
140         case UWB_RSV_STATE_O_ESTABLISHED:
141                 if (rsv->is_multicast)
142                         return;
143                 break;
144         default:
145                 break;
146         }
147         uwb_rsv_remove(rsv);
148 }
149
150 /*
151  * Based on the DRP IE, transition a target reservation to a new
152  * state.
153  */
154 static void uwb_drp_process_target(struct uwb_rc *rc, struct uwb_rsv *rsv,
155                                    struct uwb_ie_drp *drp_ie)
156 {
157         struct device *dev = &rc->uwb_dev.dev;
158         int status;
159         enum uwb_drp_reason reason_code;
160
161         status = uwb_ie_drp_status(drp_ie);
162         reason_code = uwb_ie_drp_reason_code(drp_ie);
163
164         if (status) {
165                 switch (reason_code) {
166                 case UWB_DRP_REASON_ACCEPTED:
167                         uwb_rsv_set_state(rsv, UWB_RSV_STATE_T_ACCEPTED);
168                         break;
169                 case UWB_DRP_REASON_MODIFIED:
170                         dev_err(dev, "FIXME: unhandled reason code (%d/%d)\n",
171                                 reason_code, status);
172                         break;
173                 default:
174                         dev_warn(dev, "ignoring invalid DRP IE state (%d/%d)\n",
175                                  reason_code, status);
176                 }
177         } else {
178                 switch (reason_code) {
179                 case UWB_DRP_REASON_ACCEPTED:
180                         /* New reservations are handled in uwb_rsv_find(). */
181                         break;
182                 case UWB_DRP_REASON_DENIED:
183                         uwb_rsv_set_state(rsv, UWB_RSV_STATE_NONE);
184                         break;
185                 case UWB_DRP_REASON_CONFLICT:
186                 case UWB_DRP_REASON_MODIFIED:
187                         dev_err(dev, "FIXME: unhandled reason code (%d/%d)\n",
188                                 reason_code, status);
189                         break;
190                 default:
191                         dev_warn(dev, "ignoring invalid DRP IE state (%d/%d)\n",
192                                  reason_code, status);
193                 }
194         }
195 }
196
197 /*
198  * Based on the DRP IE, transition an owner reservation to a new
199  * state.
200  */
201 static void uwb_drp_process_owner(struct uwb_rc *rc, struct uwb_rsv *rsv,
202                                   struct uwb_ie_drp *drp_ie)
203 {
204         struct device *dev = &rc->uwb_dev.dev;
205         int status;
206         enum uwb_drp_reason reason_code;
207
208         status = uwb_ie_drp_status(drp_ie);
209         reason_code = uwb_ie_drp_reason_code(drp_ie);
210
211         if (status) {
212                 switch (reason_code) {
213                 case UWB_DRP_REASON_ACCEPTED:
214                         uwb_rsv_set_state(rsv, UWB_RSV_STATE_O_ESTABLISHED);
215                         break;
216                 case UWB_DRP_REASON_MODIFIED:
217                         dev_err(dev, "FIXME: unhandled reason code (%d/%d)\n",
218                                 reason_code, status);
219                         break;
220                 default:
221                         dev_warn(dev, "ignoring invalid DRP IE state (%d/%d)\n",
222                                  reason_code, status);
223                 }
224         } else {
225                 switch (reason_code) {
226                 case UWB_DRP_REASON_PENDING:
227                         uwb_rsv_set_state(rsv, UWB_RSV_STATE_O_PENDING);
228                         break;
229                 case UWB_DRP_REASON_DENIED:
230                         uwb_rsv_set_state(rsv, UWB_RSV_STATE_NONE);
231                         break;
232                 case UWB_DRP_REASON_CONFLICT:
233                 case UWB_DRP_REASON_MODIFIED:
234                         dev_err(dev, "FIXME: unhandled reason code (%d/%d)\n",
235                                 reason_code, status);
236                         break;
237                 default:
238                         dev_warn(dev, "ignoring invalid DRP IE state (%d/%d)\n",
239                                  reason_code, status);
240                 }
241         }
242 }
243
244 /*
245  * Process a received DRP IE, it's either for a reservation owned by
246  * the RC or targeted at it (or it's for a WUSB cluster reservation).
247  */
248 static void uwb_drp_process(struct uwb_rc *rc, struct uwb_dev *src,
249                      struct uwb_ie_drp *drp_ie)
250 {
251         struct uwb_rsv *rsv;
252
253         rsv = uwb_rsv_find(rc, src, drp_ie);
254         if (!rsv) {
255                 /*
256                  * No reservation? It's either for a recently
257                  * terminated reservation; or the DRP IE couldn't be
258                  * processed (e.g., an invalid IE or out of memory).
259                  */
260                 return;
261         }
262
263         /*
264          * Do nothing with DRP IEs for reservations that have been
265          * terminated.
266          */
267         if (rsv->state == UWB_RSV_STATE_NONE) {
268                 uwb_rsv_set_state(rsv, UWB_RSV_STATE_NONE);
269                 return;
270         }
271
272         if (uwb_ie_drp_owner(drp_ie))
273                 uwb_drp_process_target(rc, rsv, drp_ie);
274         else
275                 uwb_drp_process_owner(rc, rsv, drp_ie);
276 }
277
278
279 /*
280  * Process all the DRP IEs (both DRP IEs and the DRP Availability IE)
281  * from a device.
282  */
283 static
284 void uwb_drp_process_all(struct uwb_rc *rc, struct uwb_rc_evt_drp *drp_evt,
285                          size_t ielen, struct uwb_dev *src_dev)
286 {
287         struct device *dev = &rc->uwb_dev.dev;
288         struct uwb_ie_hdr *ie_hdr;
289         void *ptr;
290
291         ptr = drp_evt->ie_data;
292         for (;;) {
293                 ie_hdr = uwb_ie_next(&ptr, &ielen);
294                 if (!ie_hdr)
295                         break;
296
297                 switch (ie_hdr->element_id) {
298                 case UWB_IE_DRP_AVAILABILITY:
299                         /* FIXME: does something need to be done with this? */
300                         break;
301                 case UWB_IE_DRP:
302                         uwb_drp_process(rc, src_dev, (struct uwb_ie_drp *)ie_hdr);
303                         break;
304                 default:
305                         dev_warn(dev, "unexpected IE in DRP notification\n");
306                         break;
307                 }
308         }
309
310         if (ielen > 0)
311                 dev_warn(dev, "%d octets remaining in DRP notification\n",
312                          (int)ielen);
313 }
314
315
316 /*
317  * Go through all the DRP IEs and find the ones that conflict with our
318  * reservations.
319  *
320  * FIXME: must resolve the conflict according the the rules in
321  * [ECMA-368].
322  */
323 static
324 void uwb_drp_process_conflict_all(struct uwb_rc *rc, struct uwb_rc_evt_drp *drp_evt,
325                                   size_t ielen, struct uwb_dev *src_dev)
326 {
327         struct device *dev = &rc->uwb_dev.dev;
328         struct uwb_ie_hdr *ie_hdr;
329         struct uwb_ie_drp *drp_ie;
330         void *ptr;
331
332         ptr = drp_evt->ie_data;
333         for (;;) {
334                 ie_hdr = uwb_ie_next(&ptr, &ielen);
335                 if (!ie_hdr)
336                         break;
337
338                 drp_ie = container_of(ie_hdr, struct uwb_ie_drp, hdr);
339
340                 /* FIXME: check if this DRP IE conflicts. */
341         }
342
343         if (ielen > 0)
344                 dev_warn(dev, "%d octets remaining in DRP notification\n",
345                          (int)ielen);
346 }
347
348
349 /*
350  * Terminate all reservations owned by, or targeted at, 'uwb_dev'.
351  */
352 static void uwb_drp_terminate_all(struct uwb_rc *rc, struct uwb_dev *uwb_dev)
353 {
354         struct uwb_rsv *rsv;
355
356         list_for_each_entry(rsv, &rc->reservations, rc_node) {
357                 if (rsv->owner == uwb_dev
358                     || (rsv->target.type == UWB_RSV_TARGET_DEV && rsv->target.dev == uwb_dev))
359                         uwb_rsv_remove(rsv);
360         }
361 }
362
363
364 /**
365  * uwbd_evt_handle_rc_drp - handle a DRP_IE event
366  * @evt: the DRP_IE event from the radio controller
367  *
368  * This processes DRP notifications from the radio controller, either
369  * initiating a new reservation or transitioning an existing
370  * reservation into a different state.
371  *
372  * DRP notifications can occur for three different reasons:
373  *
374  * - UWB_DRP_NOTIF_DRP_IE_RECVD: one or more DRP IEs with the RC as
375  *   the target or source have been recieved.
376  *
377  *   These DRP IEs could be new or for an existing reservation.
378  *
379  *   If the DRP IE for an existing reservation ceases to be to
380  *   recieved for at least mMaxLostBeacons, the reservation should be
381  *   considered to be terminated.  Note that the TERMINATE reason (see
382  *   below) may not always be signalled (e.g., the remote device has
383  *   two or more reservations established with the RC).
384  *
385  * - UWB_DRP_NOTIF_CONFLICT: DRP IEs from any device in the beacon
386  *   group conflict with the RC's reservations.
387  *
388  * - UWB_DRP_NOTIF_TERMINATE: DRP IEs are no longer being received
389  *   from a device (i.e., it's terminated all reservations).
390  *
391  * Only the software state of the reservations is changed; the setting
392  * of the radio controller's DRP IEs is done after all the events in
393  * an event buffer are processed.  This saves waiting multiple times
394  * for the SET_DRP_IE command to complete.
395  */
396 int uwbd_evt_handle_rc_drp(struct uwb_event *evt)
397 {
398         struct device *dev = &evt->rc->uwb_dev.dev;
399         struct uwb_rc *rc = evt->rc;
400         struct uwb_rc_evt_drp *drp_evt;
401         size_t ielength, bytes_left;
402         struct uwb_dev_addr src_addr;
403         struct uwb_dev *src_dev;
404         int reason;
405
406         /* Is there enough data to decode the event (and any IEs in
407            its payload)? */
408         if (evt->notif.size < sizeof(*drp_evt)) {
409                 dev_err(dev, "DRP event: Not enough data to decode event "
410                         "[%zu bytes left, %zu needed]\n",
411                         evt->notif.size, sizeof(*drp_evt));
412                 return 0;
413         }
414         bytes_left = evt->notif.size - sizeof(*drp_evt);
415         drp_evt = container_of(evt->notif.rceb, struct uwb_rc_evt_drp, rceb);
416         ielength = le16_to_cpu(drp_evt->ie_length);
417         if (bytes_left != ielength) {
418                 dev_err(dev, "DRP event: Not enough data in payload [%zu"
419                         "bytes left, %zu declared in the event]\n",
420                         bytes_left, ielength);
421                 return 0;
422         }
423
424         memcpy(src_addr.data, &drp_evt->src_addr, sizeof(src_addr));
425         src_dev = uwb_dev_get_by_devaddr(rc, &src_addr);
426         if (!src_dev) {
427                 /*
428                  * A DRP notification from an unrecognized device.
429                  *
430                  * This is probably from a WUSB device that doesn't
431                  * have an EUI-48 and therefore doesn't show up in the
432                  * UWB device database.  It's safe to simply ignore
433                  * these.
434                  */
435                 return 0;
436         }
437
438         mutex_lock(&rc->rsvs_mutex);
439
440         reason = uwb_rc_evt_drp_reason(drp_evt);
441
442         switch (reason) {
443         case UWB_DRP_NOTIF_DRP_IE_RCVD:
444                 uwb_drp_process_all(rc, drp_evt, ielength, src_dev);
445                 break;
446         case UWB_DRP_NOTIF_CONFLICT:
447                 uwb_drp_process_conflict_all(rc, drp_evt, ielength, src_dev);
448                 break;
449         case UWB_DRP_NOTIF_TERMINATE:
450                 uwb_drp_terminate_all(rc, src_dev);
451                 break;
452         default:
453                 dev_warn(dev, "ignored DRP event with reason code: %d\n", reason);
454                 break;
455         }
456
457         mutex_unlock(&rc->rsvs_mutex);
458
459         uwb_dev_put(src_dev);
460         return 0;
461 }