drivers/staging/brcm80211/sys/wlc_event.c

   1 /*
   2  * Copyright (c) 2010 Broadcom Corporation
   3  *
   4  * Permission to use, copy, modify, and/or distribute this software for any
   5  * purpose with or without fee is hereby granted, provided that the above
   6  * copyright notice and this permission notice appear in all copies.
   7  *
   8  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
   9  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  10  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
  11  * SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  12  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION
  13  * OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN
  14  * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  15  */
  16
  17 #include <linux/kernel.h>
  18 #include <bcmdefs.h>
  19 #include <linuxver.h>
  20 #include <bcmutils.h>
  21 #include <siutils.h>
  22 #include <wlioctl.h>
  23 #include <wlc_cfg.h>
  24 #include <wlc_pub.h>
  25 #include <wlc_key.h>
  26 #include <wl_export.h>
  27 #include <wlc_event.h>
  28
  29 #include <d11.h>
  30 #include <wlc_rate.h>
  31 #include <wlc_mac80211.h>
  32 #ifdef MSGTRACE
  33 #include <msgtrace.h>
  34 #endif
  35
  36 /* Local prototypes */
  37 static void wlc_timer_cb(void *arg);
  38
  39 /* Private data structures */
  40 struct wlc_eventq {
  41         wlc_event_t *head;
  42         wlc_event_t *tail;
  43         struct wlc_info *wlc;
  44         void *wl;
  45         wlc_pub_t *pub;
  46         bool tpending;
  47         bool workpending;
  48         struct wl_timer *timer;
  49         wlc_eventq_cb_t cb;
  50         u8 event_inds_mask[broken_roundup(WLC_E_LAST, NBBY) / NBBY];
  51 };
  52
  53 /*
  54  * Export functions
  55  */
  56 wlc_eventq_t *wlc_eventq_attach(wlc_pub_t *pub, struct wlc_info *wlc, void *wl,
  57                                 wlc_eventq_cb_t cb)
  58 {
  59         wlc_eventq_t *eq;
  60
  61         eq = kzalloc(sizeof(wlc_eventq_t), GFP_ATOMIC);
  62         if (eq == NULL)
  63                 return NULL;
  64
  65         eq->cb = cb;
  66         eq->wlc = wlc;
  67         eq->wl = wl;
  68         eq->pub = pub;
  69
  70         eq->timer = wl_init_timer(eq->wl, wlc_timer_cb, eq, "eventq");
  71         if (!eq->timer) {
  72                 WL_ERROR(("wl%d: wlc_eventq_attach: timer failed\n",
  73                           pub->unit));
  74                 kfree(eq);
  75                 return NULL;
  76         }
  77
  78         return eq;
  79 }
  80
  81 int wlc_eventq_detach(wlc_eventq_t *eq)
  82 {
  83         /* Clean up pending events */
  84         wlc_eventq_down(eq);
  85
  86         if (eq->timer) {
  87                 if (eq->tpending) {
  88                         wl_del_timer(eq->wl, eq->timer);
  89                         eq->tpending = false;
  90                 }
  91                 wl_free_timer(eq->wl, eq->timer);
  92                 eq->timer = NULL;
  93         }
  94
  95         ASSERT(wlc_eventq_avail(eq) == false);
  96         kfree(eq);
  97         return 0;
  98 }
  99
 100 int wlc_eventq_down(wlc_eventq_t *eq)
 101 {
 102         int callbacks = 0;
 103         if (eq->tpending && !eq->workpending) {
 104                 if (!wl_del_timer(eq->wl, eq->timer))
 105                         callbacks++;
 106
 107                 ASSERT(wlc_eventq_avail(eq) == true);
 108                 ASSERT(eq->workpending == false);
 109                 eq->workpending = true;
 110                 if (eq->cb)
 111                         eq->cb(eq->wlc);
 112
 113                 ASSERT(eq->workpending == true);
 114                 eq->workpending = false;
 115                 eq->tpending = false;
 116         } else {
 117                 ASSERT(eq->workpending || wlc_eventq_avail(eq) == false);
 118         }
 119         return callbacks;
 120 }
 121
 122 wlc_event_t *wlc_event_alloc(wlc_eventq_t *eq)
 123 {
 124         wlc_event_t *e;
 125
 126         e = kzalloc(sizeof(wlc_event_t), GFP_ATOMIC);
 127
 128         if (e == NULL)
 129                 return NULL;
 130
 131         return e;
 132 }
 133
 134 void wlc_event_free(wlc_eventq_t *eq, wlc_event_t *e)
 135 {
 136         ASSERT(e->data == NULL);
 137         ASSERT(e->next == NULL);
 138         kfree(e);
 139 }
 140
 141 void wlc_eventq_enq(wlc_eventq_t *eq, wlc_event_t *e)
 142 {
 143         ASSERT(e->next == NULL);
 144         e->next = NULL;
 145
 146         if (eq->tail) {
 147                 eq->tail->next = e;
 148                 eq->tail = e;
 149         } else
 150                 eq->head = eq->tail = e;
 151
 152         if (!eq->tpending) {
 153                 eq->tpending = true;
 154                 /* Use a zero-delay timer to trigger
 155                  * delayed processing of the event.
 156                  */
 157                 wl_add_timer(eq->wl, eq->timer, 0, 0);
 158         }
 159 }
 160
 161 wlc_event_t *wlc_eventq_deq(wlc_eventq_t *eq)
 162 {
 163         wlc_event_t *e;
 164
 165         e = eq->head;
 166         if (e) {
 167                 eq->head = e->next;
 168                 e->next = NULL;
 169
 170                 if (eq->head == NULL)
 171                         eq->tail = eq->head;
 172         }
 173         return e;
 174 }
 175
 176 wlc_event_t *wlc_eventq_next(wlc_eventq_t *eq, wlc_event_t *e)
 177 {
 178 #ifdef BCMDBG
 179         wlc_event_t *etmp;
 180
 181         for (etmp = eq->head; etmp; etmp = etmp->next) {
 182                 if (etmp == e)
 183                         break;
 184         }
 185         ASSERT(etmp != NULL);
 186 #endif
 187
 188         return e->next;
 189 }
 190
 191 int wlc_eventq_cnt(wlc_eventq_t *eq)
 192 {
 193         wlc_event_t *etmp;
 194         int cnt = 0;
 195
 196         for (etmp = eq->head; etmp; etmp = etmp->next)
 197                 cnt++;
 198
 199         return cnt;
 200 }
 201
 202 bool wlc_eventq_avail(wlc_eventq_t *eq)
 203 {
 204         return (eq->head != NULL);
 205 }
 206
 207 /*
 208  * Local Functions
 209  */
 210 static void wlc_timer_cb(void *arg)
 211 {
 212         struct wlc_eventq *eq = (struct wlc_eventq *)arg;
 213
 214         ASSERT(eq->tpending == true);
 215         ASSERT(wlc_eventq_avail(eq) == true);
 216         ASSERT(eq->workpending == false);
 217         eq->workpending = true;
 218
 219         if (eq->cb)
 220                 eq->cb(eq->wlc);
 221
 222         ASSERT(wlc_eventq_avail(eq) == false);
 223         ASSERT(eq->tpending == true);
 224         eq->workpending = false;
 225         eq->tpending = false;
 226 }