← Back to branch summary

~ubuntu-branches/ubuntu/precise/linux-lowlatency/precise

« back to all changes in this revision

Viewing changes to drivers/staging/rtl8712/rtl871x_eeprom.c

  • Committer: Package Import Robot
  • Author(s): Alessio Igor Bogani
  • Date: 2011-10-26 11:13:05 UTC
  • Revision ID: package-import@ubuntu.com-20111026111305-tz023xykf0i6eosh
Tags: upstream-3.2.0
Import upstream version 3.2.0

Show diffs side-by-side

added added

removed removed

Lines of Context:
drivers/staging/rtl8712/rtl871x_eeprom.c
 
1
/******************************************************************************
 
2
 * rtl871x_eeprom.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
#define _RTL871X_EEPROM_C_
 
30
 
 
31
#include "osdep_service.h"
 
32
#include "drv_types.h"
 
33
 
 
34
static void up_clk(struct _adapter *padapter, u16 *x)
 
35
{
 
36
        *x = *x | _EESK;
 
37
        r8712_write8(padapter, EE_9346CR, (u8)*x);
 
38
        udelay(CLOCK_RATE);
 
39
}
 
40
 
 
41
static void down_clk(struct _adapter *padapter, u16 *x)
 
42
{
 
43
        *x = *x & ~_EESK;
 
44
        r8712_write8(padapter, EE_9346CR, (u8)*x);
 
45
        udelay(CLOCK_RATE);
 
46
}
 
47
 
 
48
static void shift_out_bits(struct _adapter *padapter, u16 data, u16 count)
 
49
{
 
50
        u16 x, mask;
 
51
 
 
52
        if (padapter->bSurpriseRemoved == true)
 
53
                goto out;
 
54
        mask = 0x01 << (count - 1);
 
55
        x = r8712_read8(padapter, EE_9346CR);
 
56
        x &= ~(_EEDO | _EEDI);
 
57
        do {
 
58
                x &= ~_EEDI;
 
59
                if (data & mask)
 
60
                        x |= _EEDI;
 
61
                if (padapter->bSurpriseRemoved == true)
 
62
                        goto out;
 
63
                r8712_write8(padapter, EE_9346CR, (u8)x);
 
64
                udelay(CLOCK_RATE);
 
65
                up_clk(padapter, &x);
 
66
                down_clk(padapter, &x);
 
67
                mask = mask >> 1;
 
68
        } while (mask);
 
69
        if (padapter->bSurpriseRemoved == true)
 
70
                goto out;
 
71
        x &= ~_EEDI;
 
72
        r8712_write8(padapter, EE_9346CR, (u8)x);
 
73
out:;
 
74
}
 
75
 
 
76
static u16 shift_in_bits(struct _adapter *padapter)
 
77
{
 
78
        u16 x, d = 0, i;
 
79
 
 
80
        if (padapter->bSurpriseRemoved == true)
 
81
                goto out;
 
82
        x = r8712_read8(padapter, EE_9346CR);
 
83
        x &= ~(_EEDO | _EEDI);
 
84
        d = 0;
 
85
        for (i = 0; i < 16; i++) {
 
86
                d = d << 1;
 
87
                up_clk(padapter, &x);
 
88
                if (padapter->bSurpriseRemoved == true)
 
89
                        goto out;
 
90
                x = r8712_read8(padapter, EE_9346CR);
 
91
                x &= ~(_EEDI);
 
92
                if (x & _EEDO)
 
93
                        d |= 1;
 
94
                down_clk(padapter, &x);
 
95
        }
 
96
out:
 
97
        return d;
 
98
}
 
99
 
 
100
static void standby(struct _adapter *padapter)
 
101
{
 
102
        u8   x;
 
103
 
 
104
        x = r8712_read8(padapter, EE_9346CR);
 
105
        x &= ~(_EECS | _EESK);
 
106
        r8712_write8(padapter, EE_9346CR, x);
 
107
        udelay(CLOCK_RATE);
 
108
        x |= _EECS;
 
109
        r8712_write8(padapter, EE_9346CR, x);
 
110
        udelay(CLOCK_RATE);
 
111
}
 
112
 
 
113
static u16 wait_eeprom_cmd_done(struct _adapter *padapter)
 
114
{
 
115
        u8      x;
 
116
        u16     i;
 
117
 
 
118
        standby(padapter);
 
119
        for (i = 0; i < 200; i++) {
 
120
                x = r8712_read8(padapter, EE_9346CR);
 
121
                if (x & _EEDO)
 
122
                        return true;
 
123
                udelay(CLOCK_RATE);
 
124
        }
 
125
        return false;
 
126
}
 
127
 
 
128
static void eeprom_clean(struct _adapter *padapter)
 
129
{
 
130
        u16 x;
 
131
 
 
132
        if (padapter->bSurpriseRemoved == true)
 
133
                return;
 
134
        x = r8712_read8(padapter, EE_9346CR);
 
135
        if (padapter->bSurpriseRemoved == true)
 
136
                return;
 
137
        x &= ~(_EECS | _EEDI);
 
138
        r8712_write8(padapter, EE_9346CR, (u8)x);
 
139
        if (padapter->bSurpriseRemoved == true)
 
140
                return;
 
141
        up_clk(padapter, &x);
 
142
        if (padapter->bSurpriseRemoved == true)
 
143
                return;
 
144
        down_clk(padapter, &x);
 
145
}
 
146
 
 
147
void r8712_eeprom_write16(struct _adapter *padapter, u16 reg, u16 data)
 
148
{
 
149
        u8 x;
 
150
        u8 tmp8_ori, tmp8_new, tmp8_clk_ori, tmp8_clk_new;
 
151
 
 
152
        tmp8_ori = r8712_read8(padapter, 0x102502f1);
 
153
        tmp8_new = tmp8_ori & 0xf7;
 
154
        if (tmp8_ori != tmp8_new)
 
155
                r8712_write8(padapter, 0x102502f1, tmp8_new);
 
156
        tmp8_clk_ori = r8712_read8(padapter, 0x10250003);
 
157
        tmp8_clk_new = tmp8_clk_ori | 0x20;
 
158
        if (tmp8_clk_new != tmp8_clk_ori)
 
159
                r8712_write8(padapter, 0x10250003, tmp8_clk_new);
 
160
        x = r8712_read8(padapter, EE_9346CR);
 
161
        x &= ~(_EEDI | _EEDO | _EESK | _EEM0);
 
162
        x |= _EEM1 | _EECS;
 
163
        r8712_write8(padapter, EE_9346CR, x);
 
164
        shift_out_bits(padapter, EEPROM_EWEN_OPCODE, 5);
 
165
        if (padapter->EepromAddressSize == 8)   /*CF+ and SDIO*/
 
166
                shift_out_bits(padapter, 0, 6);
 
167
        else    /* USB */
 
168
                shift_out_bits(padapter, 0, 4);
 
169
        standby(padapter);
 
170
        /* Erase this particular word.  Write the erase opcode and register
 
171
         * number in that order. The opcode is 3bits in length; reg is 6
 
172
         * bits long.
 
173
         */
 
174
        standby(padapter);
 
175
        /* write the new word to the EEPROM
 
176
         * send the write opcode the EEPORM
 
177
         */
 
178
        shift_out_bits(padapter, EEPROM_WRITE_OPCODE, 3);
 
179
        /* select which word in the EEPROM that we are writing to. */
 
180
        shift_out_bits(padapter, reg, padapter->EepromAddressSize);
 
181
        /* write the data to the selected EEPROM word. */
 
182
        shift_out_bits(padapter, data, 16);
 
183
        if (wait_eeprom_cmd_done(padapter)) {
 
184
                standby(padapter);
 
185
                shift_out_bits(padapter, EEPROM_EWDS_OPCODE, 5);
 
186
                shift_out_bits(padapter, reg, 4);
 
187
                eeprom_clean(padapter);
 
188
        }
 
189
        if (tmp8_clk_new != tmp8_clk_ori)
 
190
                r8712_write8(padapter, 0x10250003, tmp8_clk_ori);
 
191
        if (tmp8_new != tmp8_ori)
 
192
                r8712_write8(padapter, 0x102502f1, tmp8_ori);
 
193
}
 
194
 
 
195
u16 r8712_eeprom_read16(struct _adapter *padapter, u16 reg) /*ReadEEprom*/
 
196
{
 
197
        u16 x;
 
198
        u16 data = 0;
 
199
        u8 tmp8_ori, tmp8_new, tmp8_clk_ori, tmp8_clk_new;
 
200
 
 
201
        tmp8_ori = r8712_read8(padapter, 0x102502f1);
 
202
        tmp8_new = tmp8_ori & 0xf7;
 
203
        if (tmp8_ori != tmp8_new)
 
204
                r8712_write8(padapter, 0x102502f1, tmp8_new);
 
205
        tmp8_clk_ori = r8712_read8(padapter, 0x10250003);
 
206
        tmp8_clk_new = tmp8_clk_ori | 0x20;
 
207
        if (tmp8_clk_new != tmp8_clk_ori)
 
208
                r8712_write8(padapter, 0x10250003, tmp8_clk_new);
 
209
        if (padapter->bSurpriseRemoved == true)
 
210
                goto out;
 
211
        /* select EEPROM, reset bits, set _EECS */
 
212
        x = r8712_read8(padapter, EE_9346CR);
 
213
        if (padapter->bSurpriseRemoved == true)
 
214
                goto out;
 
215
        x &= ~(_EEDI | _EEDO | _EESK | _EEM0);
 
216
        x |= _EEM1 | _EECS;
 
217
        r8712_write8(padapter, EE_9346CR, (unsigned char)x);
 
218
        /* write the read opcode and register number in that order
 
219
         * The opcode is 3bits in length, reg is 6 bits long
 
220
         */
 
221
        shift_out_bits(padapter, EEPROM_READ_OPCODE, 3);
 
222
        shift_out_bits(padapter, reg, padapter->EepromAddressSize);
 
223
        /* Now read the data (16 bits) in from the selected EEPROM word */
 
224
        data = shift_in_bits(padapter);
 
225
        eeprom_clean(padapter);
 
226
out:
 
227
        if (tmp8_clk_new != tmp8_clk_ori)
 
228
                r8712_write8(padapter, 0x10250003, tmp8_clk_ori);
 
229
        if (tmp8_new != tmp8_ori)
 
230
                r8712_write8(padapter, 0x102502f1, tmp8_ori);
 
231
        return data;
 
232
}
 
233