wlan_prot.c
8.9 KB
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
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
/*
* Copyright (c) 2006-2021, RT-Thread Development Team
*
* SPDX-License-Identifier: Apache-2.0
*
* Change Logs:
* Date Author Notes
* 2018-08-14 tyx the first version
*/
#include <rthw.h>
#include <rtthread.h>
#include <wlan_dev.h>
#include <wlan_prot.h>
#define DBG_TAG "WLAN.prot"
#ifdef RT_WLAN_PROT_DEBUG
#define DBG_LVL DBG_LOG
#else
#define DBG_LVL DBG_INFO
#endif /* RT_WLAN_PROT_DEBUG */
#include <rtdbg.h>
#ifdef RT_WLAN_PROT_ENABLE
#if RT_WLAN_PROT_NAME_LEN < 4
#error "The name is too short"
#endif
struct rt_wlan_prot_event_des
{
rt_wlan_prot_event_handler handler;
struct rt_wlan_prot *prot;
};
static struct rt_wlan_prot *_prot[RT_WLAN_PROT_MAX];
static struct rt_wlan_prot_event_des prot_event_tab[RT_WLAN_PROT_EVT_MAX][RT_WLAN_PROT_MAX];
static void rt_wlan_prot_event_handle(struct rt_wlan_device *wlan, rt_wlan_dev_event_t event, struct rt_wlan_buff *buff, void *parameter)
{
int i;
struct rt_wlan_prot *wlan_prot;
struct rt_wlan_prot *prot;
rt_wlan_prot_event_handler handler;
rt_wlan_prot_event_t prot_event;
LOG_D("F:%s L:%d event:%d", __FUNCTION__, __LINE__, event);
wlan_prot = wlan->prot;
handler = RT_NULL;
prot = RT_NULL;
switch (event)
{
case RT_WLAN_DEV_EVT_INIT_DONE:
{
LOG_D("L%d event: INIT_DONE", __LINE__);
prot_event = RT_WLAN_PROT_EVT_INIT_DONE;
break;
}
case RT_WLAN_DEV_EVT_CONNECT:
{
LOG_D("L%d event: CONNECT", __LINE__);
prot_event = RT_WLAN_PROT_EVT_CONNECT;
break;
}
case RT_WLAN_DEV_EVT_DISCONNECT:
{
LOG_D("L%d event: DISCONNECT", __LINE__);
prot_event = RT_WLAN_PROT_EVT_DISCONNECT;
break;
}
case RT_WLAN_DEV_EVT_AP_START:
{
LOG_D("L%d event: AP_START", __LINE__);
prot_event = RT_WLAN_PROT_EVT_AP_START;
break;
}
case RT_WLAN_DEV_EVT_AP_STOP:
{
LOG_D("L%d event: AP_STOP", __LINE__);
prot_event = RT_WLAN_PROT_EVT_AP_STOP;
break;
}
case RT_WLAN_DEV_EVT_AP_ASSOCIATED:
{
LOG_D("L%d event: AP_ASSOCIATED", __LINE__);
prot_event = RT_WLAN_PROT_EVT_AP_ASSOCIATED;
break;
}
case RT_WLAN_DEV_EVT_AP_DISASSOCIATED:
{
LOG_D("L%d event: AP_DISASSOCIATED", __LINE__);
prot_event = RT_WLAN_PROT_EVT_AP_DISASSOCIATED;
break;
}
default:
{
return;
}
}
for (i = 0; i < RT_WLAN_PROT_MAX; i++)
{
if ((prot_event_tab[prot_event][i].handler != RT_NULL) &&
(prot_event_tab[prot_event][i].prot->id == wlan_prot->id))
{
handler = prot_event_tab[prot_event][i].handler;
prot = prot_event_tab[prot_event][i].prot;
break;
}
}
if (handler != RT_NULL)
{
handler(prot, wlan, prot_event);
}
}
static struct rt_wlan_device *rt_wlan_prot_find_by_name(const char *name)
{
rt_device_t device;
if (name == RT_NULL)
{
LOG_E("F:%s L:%d Parameter Wrongful", __FUNCTION__, __LINE__);
return RT_NULL;
}
device = rt_device_find(name);
if (device == RT_NULL)
{
LOG_E("F:%s L:%d not find wlan dev!! name:%s", __FUNCTION__, __LINE__, name);
return RT_NULL;
}
return (struct rt_wlan_device *)device;
}
rt_err_t rt_wlan_prot_attach(const char *dev_name, const char *prot_name)
{
struct rt_wlan_device *wlan;
wlan = rt_wlan_prot_find_by_name(dev_name);
if (wlan == RT_NULL)
{
return -RT_ERROR;
}
return rt_wlan_prot_attach_dev(wlan, prot_name);
}
rt_err_t rt_wlan_prot_detach(const char *name)
{
struct rt_wlan_device *wlan;
wlan = rt_wlan_prot_find_by_name(name);
if (wlan == RT_NULL)
{
return -RT_ERROR;
}
return rt_wlan_prot_detach_dev(wlan);
}
rt_err_t rt_wlan_prot_attach_dev(struct rt_wlan_device *wlan, const char *prot_name)
{
int i = 0;
struct rt_wlan_prot *prot = wlan->prot;
rt_wlan_dev_event_handler handler = rt_wlan_prot_event_handle;
if (wlan == RT_NULL)
{
LOG_E("F:%s L:%d wlan is null", __FUNCTION__, __LINE__);
return -RT_ERROR;
}
if (prot != RT_NULL &&
(rt_strcmp(prot->name, prot_name) == 0))
{
LOG_D("prot is register");
return RT_EOK;
}
/* if prot not NULL */
if (prot != RT_NULL)
rt_wlan_prot_detach_dev(wlan);
#ifdef RT_WLAN_PROT_LWIP_PBUF_FORCE
if (rt_strcmp(RT_WLAN_PROT_LWIP_NAME, prot_name) != 0)
{
return -RT_ERROR;
}
#endif
/* find prot */
for (i = 0; i < RT_WLAN_PROT_MAX; i++)
{
if ((_prot[i] != RT_NULL) && (rt_strcmp(_prot[i]->name, prot_name) == 0))
{
/* attach prot */
wlan->prot = _prot[i]->ops->dev_reg_callback(_prot[i], wlan);
break;
}
}
if (i >= RT_WLAN_PROT_MAX)
{
LOG_E("F:%s L:%d not find wlan protocol", __FUNCTION__, __LINE__);
return -RT_ERROR;
}
rt_wlan_dev_register_event_handler(wlan, RT_WLAN_DEV_EVT_CONNECT, handler, RT_NULL);
rt_wlan_dev_register_event_handler(wlan, RT_WLAN_DEV_EVT_DISCONNECT, handler, RT_NULL);
rt_wlan_dev_register_event_handler(wlan, RT_WLAN_DEV_EVT_AP_START, handler, RT_NULL);
rt_wlan_dev_register_event_handler(wlan, RT_WLAN_DEV_EVT_AP_STOP, handler, RT_NULL);
rt_wlan_dev_register_event_handler(wlan, RT_WLAN_DEV_EVT_AP_ASSOCIATED, handler, RT_NULL);
rt_wlan_dev_register_event_handler(wlan, RT_WLAN_DEV_EVT_AP_DISASSOCIATED, handler, RT_NULL);
return RT_EOK;
}
rt_err_t rt_wlan_prot_detach_dev(struct rt_wlan_device *wlan)
{
struct rt_wlan_prot *prot = wlan->prot;
rt_wlan_dev_event_t event;
if (prot == RT_NULL)
return RT_EOK;
for (event = RT_WLAN_DEV_EVT_INIT_DONE; event < RT_WLAN_DEV_EVT_MAX; event ++)
{
rt_wlan_dev_unregister_event_handler(wlan, event, rt_wlan_prot_event_handle);
}
/* detach prot */
prot->ops->dev_unreg_callback(prot, wlan);
wlan->prot = RT_NULL;
return RT_EOK;
}
rt_err_t rt_wlan_prot_regisetr(struct rt_wlan_prot *prot)
{
int i;
rt_uint32_t id;
static rt_uint8_t num;
/* Parameter checking */
if ((prot == RT_NULL) ||
(prot->ops->prot_recv == RT_NULL) ||
(prot->ops->dev_reg_callback == RT_NULL))
{
LOG_E("F:%s L:%d Parameter Wrongful", __FUNCTION__, __LINE__);
return -RT_EINVAL;
}
/* save prot */
for (i = 0; i < RT_WLAN_PROT_MAX; i++)
{
if (_prot[i] == RT_NULL)
{
id = (RT_LWAN_ID_PREFIX << 16) | num;
prot->id = id;
_prot[i] = prot;
num ++;
break;
}
else if (rt_strcmp(_prot[i]->name, prot->name) == 0)
{
break;
}
}
/* is full */
if (i >= RT_WLAN_PROT_MAX)
{
LOG_E("F:%s L:%d Space full", __FUNCTION__, __LINE__);
return -RT_ERROR;
}
return RT_EOK;
}
rt_err_t rt_wlan_prot_event_register(struct rt_wlan_prot *prot, rt_wlan_prot_event_t event, rt_wlan_prot_event_handler handler)
{
int i;
if ((prot == RT_NULL) || (handler == RT_NULL))
{
return -RT_EINVAL;
}
for (i = 0; i < RT_WLAN_PROT_MAX; i++)
{
if (prot_event_tab[event][i].handler == RT_NULL)
{
prot_event_tab[event][i].handler = handler;
prot_event_tab[event][i].prot = prot;
return RT_EOK;
}
}
return -RT_ERROR;
}
rt_err_t rt_wlan_prot_event_unregister(struct rt_wlan_prot *prot, rt_wlan_prot_event_t event)
{
int i;
if (prot == RT_NULL)
{
return -RT_EINVAL;
}
for (i = 0; i < RT_WLAN_PROT_MAX; i++)
{
if ((prot_event_tab[event][i].handler != RT_NULL) &&
(prot_event_tab[event][i].prot == prot))
{
rt_memset(&prot_event_tab[event][i], 0, sizeof(struct rt_wlan_prot_event_des));
return RT_EOK;
}
}
return -RT_ERROR;
}
rt_err_t rt_wlan_prot_transfer_dev(struct rt_wlan_device *wlan, void *buff, int len)
{
if (wlan->ops->wlan_send != RT_NULL)
{
return wlan->ops->wlan_send(wlan, buff, len);
}
return -RT_ERROR;
}
rt_err_t rt_wlan_dev_transfer_prot(struct rt_wlan_device *wlan, void *buff, int len)
{
struct rt_wlan_prot *prot = wlan->prot;
if (prot != RT_NULL)
{
return prot->ops->prot_recv(wlan, buff, len);
}
return -RT_ERROR;
}
extern int rt_wlan_prot_ready_event(struct rt_wlan_device *wlan, struct rt_wlan_buff *buff);
int rt_wlan_prot_ready(struct rt_wlan_device *wlan, struct rt_wlan_buff *buff)
{
return rt_wlan_prot_ready_event(wlan, buff);
}
void rt_wlan_prot_dump(void)
{
int i;
rt_kprintf(" name id \n");
rt_kprintf("-------- --------\n");
for (i = 0; i < RT_WLAN_PROT_MAX; i++)
{
if (_prot[i] != RT_NULL)
{
rt_kprintf("%-8.8s ", _prot[i]->name);
rt_kprintf("%08x\n", _prot[i]->id);
}
}
}
#endif