]>
Commit | Line | Data |
---|---|---|
2865d42c LF |
1 | /****************************************************************************** |
2 | * rtl871x_io.c | |
3 | * | |
4 | * Copyright(c) 2007 - 2010 Realtek Corporation. All rights reserved. | |
5 | * Linux device driver for RTL8192SU | |
6 | * | |
7 | * This program is free software; you can redistribute it and/or modify it | |
8 | * under the terms of version 2 of the GNU General Public License as | |
9 | * published by the Free Software Foundation. | |
10 | * | |
11 | * This program is distributed in the hope that it will be useful, but WITHOUT | |
12 | * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or | |
13 | * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for | |
14 | * more details. | |
15 | * | |
16 | * You should have received a copy of the GNU General Public License along with | |
17 | * this program; if not, write to the Free Software Foundation, Inc., | |
18 | * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA | |
19 | * | |
20 | * Modifications for inclusion into the Linux staging tree are | |
21 | * Copyright(c) 2010 Larry Finger. All rights reserved. | |
22 | * | |
23 | * Contact information: | |
24 | * WLAN FAE <wlanfae@realtek.com> | |
25 | * Larry Finger <Larry.Finger@lwfinger.net> | |
26 | * | |
27 | ******************************************************************************/ | |
28 | /* | |
29 | * | |
30 | * The purpose of rtl871x_io.c | |
31 | * | |
32 | * a. provides the API | |
33 | * b. provides the protocol engine | |
34 | * c. provides the software interface between caller and the hardware interface | |
35 | * | |
36 | * For r8712u, both sync/async operations are provided. | |
37 | * | |
38 | * Only sync read/write_mem operations are provided. | |
39 | * | |
40 | */ | |
41 | ||
42 | #define _RTL871X_IO_C_ | |
43 | ||
44 | #include "osdep_service.h" | |
45 | #include "drv_types.h" | |
46 | #include "rtl871x_io.h" | |
47 | #include "osdep_intf.h" | |
48 | #include "usb_ops.h" | |
49 | ||
50 | static uint _init_intf_hdl(struct _adapter *padapter, | |
51 | struct intf_hdl *pintf_hdl) | |
52 | { | |
53 | struct intf_priv *pintf_priv; | |
54 | void (*set_intf_option)(u32 *poption) = NULL; | |
55 | void (*set_intf_funs)(struct intf_hdl *pintf_hdl); | |
56 | void (*set_intf_ops)(struct _io_ops *pops); | |
57 | uint (*init_intf_priv)(struct intf_priv *pintfpriv); | |
58 | ||
59 | set_intf_option = &(r8712_usb_set_intf_option); | |
60 | set_intf_funs = &(r8712_usb_set_intf_funs); | |
61 | set_intf_ops = &r8712_usb_set_intf_ops; | |
62 | init_intf_priv = &r8712_usb_init_intf_priv; | |
91d435fe VO |
63 | pintf_priv = pintf_hdl->pintfpriv = kmalloc(sizeof(struct intf_priv), |
64 | GFP_ATOMIC); | |
2865d42c LF |
65 | if (pintf_priv == NULL) |
66 | goto _init_intf_hdl_fail; | |
67 | pintf_hdl->adapter = (u8 *)padapter; | |
68 | set_intf_option(&pintf_hdl->intf_option); | |
69 | set_intf_funs(pintf_hdl); | |
70 | set_intf_ops(&pintf_hdl->io_ops); | |
71 | pintf_priv->intf_dev = (u8 *)&(padapter->dvobjpriv); | |
72 | if (init_intf_priv(pintf_priv) == _FAIL) | |
73 | goto _init_intf_hdl_fail; | |
74 | return _SUCCESS; | |
75 | _init_intf_hdl_fail: | |
40083865 | 76 | kfree(pintf_priv); |
2865d42c LF |
77 | return _FAIL; |
78 | } | |
79 | ||
80 | static void _unload_intf_hdl(struct intf_priv *pintfpriv) | |
81 | { | |
82 | void (*unload_intf_priv)(struct intf_priv *pintfpriv); | |
83 | ||
84 | unload_intf_priv = &r8712_usb_unload_intf_priv; | |
85 | unload_intf_priv(pintfpriv); | |
40083865 | 86 | kfree(pintfpriv); |
2865d42c LF |
87 | } |
88 | ||
89 | static uint register_intf_hdl(u8 *dev, struct intf_hdl *pintfhdl) | |
90 | { | |
91 | struct _adapter *adapter = (struct _adapter *)dev; | |
92 | ||
93 | pintfhdl->intf_option = 0; | |
94 | pintfhdl->adapter = dev; | |
95 | pintfhdl->intf_dev = (u8 *)&(adapter->dvobjpriv); | |
366ba427 | 96 | if (!_init_intf_hdl(adapter, pintfhdl)) |
2865d42c LF |
97 | goto register_intf_hdl_fail; |
98 | return _SUCCESS; | |
99 | register_intf_hdl_fail: | |
100 | return false; | |
101 | } | |
102 | ||
103 | static void unregister_intf_hdl(struct intf_hdl *pintfhdl) | |
104 | { | |
105 | _unload_intf_hdl(pintfhdl->pintfpriv); | |
106 | memset((u8 *)pintfhdl, 0, sizeof(struct intf_hdl)); | |
107 | } | |
108 | ||
109 | uint r8712_alloc_io_queue(struct _adapter *adapter) | |
110 | { | |
111 | u32 i; | |
112 | struct io_queue *pio_queue; | |
113 | struct io_req *pio_req; | |
114 | ||
bd9dc62c | 115 | pio_queue = kmalloc(sizeof(*pio_queue), GFP_ATOMIC); |
2865d42c LF |
116 | if (pio_queue == NULL) |
117 | goto alloc_io_queue_fail; | |
534c4acd JS |
118 | INIT_LIST_HEAD(&pio_queue->free_ioreqs); |
119 | INIT_LIST_HEAD(&pio_queue->processing); | |
120 | INIT_LIST_HEAD(&pio_queue->pending); | |
2865d42c | 121 | spin_lock_init(&pio_queue->lock); |
91d435fe | 122 | pio_queue->pallocated_free_ioreqs_buf = kmalloc(NUM_IOREQ * |
57b6686e TP |
123 | (sizeof(struct io_req)) + 4, |
124 | GFP_ATOMIC); | |
2865d42c LF |
125 | if ((pio_queue->pallocated_free_ioreqs_buf) == NULL) |
126 | goto alloc_io_queue_fail; | |
127 | memset(pio_queue->pallocated_free_ioreqs_buf, 0, | |
128 | (NUM_IOREQ * (sizeof(struct io_req)) + 4)); | |
129 | pio_queue->free_ioreqs_buf = pio_queue->pallocated_free_ioreqs_buf + 4 | |
130 | - ((addr_t)(pio_queue->pallocated_free_ioreqs_buf) | |
131 | & 3); | |
132 | pio_req = (struct io_req *)(pio_queue->free_ioreqs_buf); | |
133 | for (i = 0; i < NUM_IOREQ; i++) { | |
534c4acd | 134 | INIT_LIST_HEAD(&pio_req->list); |
fdfbf789 | 135 | list_add_tail(&pio_req->list, &pio_queue->free_ioreqs); |
2865d42c LF |
136 | pio_req++; |
137 | } | |
138 | if ((register_intf_hdl((u8 *)adapter, &(pio_queue->intf))) == _FAIL) | |
139 | goto alloc_io_queue_fail; | |
140 | adapter->pio_queue = pio_queue; | |
141 | return _SUCCESS; | |
142 | alloc_io_queue_fail: | |
143 | if (pio_queue) { | |
144 | kfree(pio_queue->pallocated_free_ioreqs_buf); | |
646da830 | 145 | kfree(pio_queue); |
2865d42c LF |
146 | } |
147 | adapter->pio_queue = NULL; | |
148 | return _FAIL; | |
149 | } | |
150 | ||
151 | void r8712_free_io_queue(struct _adapter *adapter) | |
152 | { | |
153 | struct io_queue *pio_queue = (struct io_queue *)(adapter->pio_queue); | |
154 | ||
155 | if (pio_queue) { | |
156 | kfree(pio_queue->pallocated_free_ioreqs_buf); | |
157 | adapter->pio_queue = NULL; | |
158 | unregister_intf_hdl(&pio_queue->intf); | |
646da830 | 159 | kfree(pio_queue); |
2865d42c LF |
160 | } |
161 | } |