Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (c) 1996, 2003 VIA Networking Technologies, Inc. |
| 3 | * All rights reserved. |
| 4 | * |
| 5 | * This program is free software; you can redistribute it and/or modify |
| 6 | * it under the terms of the GNU General Public License as published by |
| 7 | * the Free Software Foundation; either version 2 of the License, or |
| 8 | * (at your option) any later version. |
| 9 | * |
| 10 | * This program is distributed in the hope that it will be useful, |
| 11 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 12 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 13 | * GNU General Public License for more details. |
| 14 | * |
| 15 | * You should have received a copy of the GNU General Public License along |
| 16 | * with this program; if not, write to the Free Software Foundation, Inc., |
| 17 | * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. |
| 18 | * |
| 19 | * |
| 20 | * File: baseband.c |
| 21 | * |
| 22 | * Purpose: Implement functions to access baseband |
| 23 | * |
| 24 | * Author: Jerry Chen |
| 25 | * |
| 26 | * Date: Jun. 5, 2002 |
| 27 | * |
| 28 | * Functions: |
Peter Senna Tschudin | 618d7d0 | 2014-07-15 23:23:25 +0200 | [diff] [blame] | 29 | * vnt_get_frame_time - Calculate data frame transmitting time |
| 30 | * vnt_get_phy_field - Calculate PhyLength, PhyService and Phy |
| 31 | * Signal parameter for baseband Tx |
Malcolm Priestley | 7534180 | 2014-07-16 22:21:53 +0100 | [diff] [blame] | 32 | * vnt_vt3184_init - VIA VT3184 baseband chip init code |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 33 | * |
| 34 | * Revision History: |
| 35 | * |
| 36 | * |
| 37 | */ |
| 38 | |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 39 | #include "mac.h" |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 40 | #include "baseband.h" |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 41 | #include "rf.h" |
Malcolm Priestley | 62c8526 | 2014-05-26 13:59:07 +0100 | [diff] [blame] | 42 | #include "usbpipe.h" |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 43 | |
Malcolm Priestley | 170ce6d | 2014-07-12 20:12:43 +0100 | [diff] [blame] | 44 | static u8 vnt_vt3184_agc[] = { |
Malcolm Priestley | 4fd6e9f | 2014-07-12 20:12:42 +0100 | [diff] [blame] | 45 | 0x00, 0x00, 0x02, 0x02, 0x04, 0x04, 0x06, 0x06, |
| 46 | 0x08, 0x08, 0x0a, 0x0a, 0x0c, 0x0c, 0x0e, 0x0e, /* 0x0f */ |
| 47 | 0x10, 0x10, 0x12, 0x12, 0x14, 0x14, 0x16, 0x16, |
| 48 | 0x18, 0x18, 0x1a, 0x1a, 0x1c, 0x1c, 0x1e, 0x1e, /* 0x1f */ |
| 49 | 0x20, 0x20, 0x22, 0x22, 0x24, 0x24, 0x26, 0x26, |
| 50 | 0x28, 0x28, 0x2a, 0x2a, 0x2c, 0x2c, 0x2e, 0x2e, /* 0x2f */ |
| 51 | 0x30, 0x30, 0x32, 0x32, 0x34, 0x34, 0x36, 0x36, |
| 52 | 0x38, 0x38, 0x3a, 0x3a, 0x3c, 0x3c, 0x3e, 0x3e /* 0x3f */ |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 53 | }; |
| 54 | |
Malcolm Priestley | ab48ab2 | 2014-07-12 20:12:44 +0100 | [diff] [blame] | 55 | static u8 vnt_vt3184_al2230[] = { |
Malcolm Priestley | 4fd6e9f | 2014-07-12 20:12:42 +0100 | [diff] [blame] | 56 | 0x31, 0x00, 0x00, 0x00, 0x00, 0x80, 0x00, 0x00, |
| 57 | 0x70, 0x45, 0x2a, 0x76, 0x00, 0x00, 0x80, 0x00, /* 0x0f */ |
| 58 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 59 | 0x00, 0x00, 0x00, 0x8e, 0x0a, 0x00, 0x00, 0x00, /* 0x1f */ |
| 60 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x4a, 0x00, 0x00, |
| 61 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x4a, 0x00, 0x0c, /* 0x2f */ |
| 62 | 0x26, 0x5b, 0x00, 0x00, 0x00, 0x00, 0xaa, 0xaa, |
| 63 | 0xff, 0xff, 0x79, 0x00, 0x00, 0x0b, 0x48, 0x04, /* 0x3f */ |
| 64 | 0x00, 0x08, 0x00, 0x08, 0x08, 0x14, 0x05, 0x09, |
| 65 | 0x00, 0x00, 0x00, 0x00, 0x09, 0x73, 0x00, 0xc5, /* 0x4f */ |
| 66 | 0x00, 0x19, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 67 | 0x00, 0xd0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x5f */ |
| 68 | 0xe4, 0x80, 0x00, 0x00, 0x00, 0x00, 0x98, 0x0a, |
| 69 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x03, 0x01, 0x00, /* 0x6f */ |
| 70 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 71 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x7f */ |
| 72 | 0x8c, 0x01, 0x09, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 73 | 0x08, 0x00, 0x1f, 0xb7, 0x88, 0x47, 0xaa, 0x00, /* 0x8f */ |
| 74 | 0x20, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xeb, |
| 75 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01, /* 0x9f */ |
| 76 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0x00, |
| 77 | 0x18, 0x00, 0x00, 0x00, 0x00, 0x15, 0x00, 0x18, /* 0xaf */ |
| 78 | 0x38, 0x30, 0x00, 0x00, 0xff, 0x0f, 0xe4, 0xe2, |
| 79 | 0x00, 0x00, 0x00, 0x03, 0x01, 0x00, 0x00, 0x00, /* 0xbf */ |
| 80 | 0x18, 0x20, 0x07, 0x18, 0xff, 0xff, 0x0e, 0x0a, |
| 81 | 0x0e, 0x00, 0x82, 0xa7, 0x3c, 0x10, 0x30, 0x05, /* 0xcf */ |
| 82 | 0x40, 0x12, 0x00, 0x00, 0x10, 0x28, 0x80, 0x2a, |
| 83 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0xdf */ |
| 84 | 0x00, 0xf3, 0x00, 0x00, 0x00, 0x10, 0x00, 0x12, |
| 85 | 0x00, 0xf4, 0x00, 0xff, 0x79, 0x20, 0x30, 0x05, /* 0xef */ |
| 86 | 0x00, 0x3e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 87 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 /* 0xff */ |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 88 | }; |
| 89 | |
Peter Senna Tschudin | 618d7d0 | 2014-07-15 23:23:25 +0200 | [diff] [blame] | 90 | /* {{RobertYu:20060515, new BB setting for VT3226D0 */ |
Malcolm Priestley | 0a16b63 | 2014-07-12 20:12:45 +0100 | [diff] [blame] | 91 | static u8 vnt_vt3184_vt3226d0[] = { |
Malcolm Priestley | 4fd6e9f | 2014-07-12 20:12:42 +0100 | [diff] [blame] | 92 | 0x31, 0x00, 0x00, 0x00, 0x00, 0x80, 0x00, 0x00, |
| 93 | 0x70, 0x45, 0x2a, 0x76, 0x00, 0x00, 0x80, 0x00, /* 0x0f */ |
| 94 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 95 | 0x00, 0x00, 0x00, 0x8e, 0x0a, 0x00, 0x00, 0x00, /* 0x1f */ |
| 96 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x4a, 0x00, 0x00, |
| 97 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x4a, 0x00, 0x0c, /* 0x2f */ |
| 98 | 0x26, 0x5b, 0x00, 0x00, 0x00, 0x00, 0xaa, 0xaa, |
| 99 | 0xff, 0xff, 0x79, 0x00, 0x00, 0x0b, 0x48, 0x04, /* 0x3f */ |
| 100 | 0x00, 0x08, 0x00, 0x08, 0x08, 0x14, 0x05, 0x09, |
| 101 | 0x00, 0x00, 0x00, 0x00, 0x09, 0x73, 0x00, 0xc5, /* 0x4f */ |
| 102 | 0x00, 0x19, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 103 | 0x00, 0xd0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x5f */ |
| 104 | 0xe4, 0x80, 0x00, 0x00, 0x00, 0x00, 0x98, 0x0a, |
| 105 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x03, 0x01, 0x00, /* 0x6f */ |
| 106 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 107 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x7f */ |
| 108 | 0x8c, 0x01, 0x09, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 109 | 0x08, 0x00, 0x1f, 0xb7, 0x88, 0x47, 0xaa, 0x00, /* 0x8f */ |
| 110 | 0x20, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xeb, |
| 111 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01, /* 0x9f */ |
| 112 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0x00, |
| 113 | 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, /* 0xaf */ |
| 114 | 0x38, 0x30, 0x00, 0x00, 0xff, 0x0f, 0xe4, 0xe2, |
| 115 | 0x00, 0x00, 0x00, 0x03, 0x01, 0x00, 0x00, 0x00, /* 0xbf */ |
| 116 | 0x18, 0x20, 0x07, 0x18, 0xff, 0xff, 0x10, 0x0a, |
| 117 | 0x0e, 0x00, 0x84, 0xa7, 0x3c, 0x10, 0x24, 0x05, /* 0xcf */ |
| 118 | 0x40, 0x12, 0x00, 0x00, 0x10, 0x28, 0x80, 0x2a, |
| 119 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0xdf */ |
| 120 | 0x00, 0xf3, 0x00, 0x00, 0x00, 0x10, 0x00, 0x10, |
| 121 | 0x00, 0xf4, 0x00, 0xff, 0x79, 0x20, 0x30, 0x08, /* 0xef */ |
| 122 | 0x00, 0x3e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 123 | 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 /* 0xff */ |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 124 | }; |
| 125 | |
Malcolm Priestley | 231c6f1 | 2014-07-16 22:21:51 +0100 | [diff] [blame] | 126 | static const u16 vnt_frame_time[MAX_RATE] = { |
Peter Senna Tschudin | 42b138d | 2014-07-15 23:23:26 +0200 | [diff] [blame] | 127 | 10, 20, 55, 110, 24, 36, 48, 72, 96, 144, 192, 216 |
| 128 | }; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 129 | |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 130 | /* |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 131 | * Description: Calculate data frame transmitting time |
| 132 | * |
| 133 | * Parameters: |
| 134 | * In: |
Malcolm Priestley | 030ede1 | 2014-05-19 20:33:00 +0100 | [diff] [blame] | 135 | * preamble_type - Preamble Type |
| 136 | * pkt_type - PK_TYPE_11A, PK_TYPE_11B, PK_TYPE_11GB, PK_TYPE_11GA |
| 137 | * frame_length - Baseband Type |
Malcolm Priestley | 3b5a89c | 2014-05-19 20:32:59 +0100 | [diff] [blame] | 138 | * tx_rate - Tx Rate |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 139 | * Out: |
| 140 | * |
| 141 | * Return Value: FrameTime |
| 142 | * |
| 143 | */ |
Malcolm Priestley | d38ee5b | 2014-06-04 18:25:35 +0100 | [diff] [blame] | 144 | unsigned int vnt_get_frame_time(u8 preamble_type, u8 pkt_type, |
Malcolm Priestley | 030ede1 | 2014-05-19 20:33:00 +0100 | [diff] [blame] | 145 | unsigned int frame_length, u16 tx_rate) |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 146 | { |
Malcolm Priestley | 030ede1 | 2014-05-19 20:33:00 +0100 | [diff] [blame] | 147 | unsigned int frame_time; |
| 148 | unsigned int preamble; |
| 149 | unsigned int tmp; |
| 150 | unsigned int rate = 0; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 151 | |
Malcolm Priestley | 3b5a89c | 2014-05-19 20:32:59 +0100 | [diff] [blame] | 152 | if (tx_rate > RATE_54M) |
Malcolm Priestley | 4d99952 | 2014-05-19 20:32:58 +0100 | [diff] [blame] | 153 | return 0; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 154 | |
Malcolm Priestley | 231c6f1 | 2014-07-16 22:21:51 +0100 | [diff] [blame] | 155 | rate = (unsigned int)vnt_frame_time[tx_rate]; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 156 | |
Malcolm Priestley | 3b5a89c | 2014-05-19 20:32:59 +0100 | [diff] [blame] | 157 | if (tx_rate <= 3) { |
Malcolm Priestley | 030ede1 | 2014-05-19 20:33:00 +0100 | [diff] [blame] | 158 | if (preamble_type == 1) |
| 159 | preamble = 96; |
Malcolm Priestley | 4d99952 | 2014-05-19 20:32:58 +0100 | [diff] [blame] | 160 | else |
Malcolm Priestley | 030ede1 | 2014-05-19 20:33:00 +0100 | [diff] [blame] | 161 | preamble = 192; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 162 | |
Malcolm Priestley | 030ede1 | 2014-05-19 20:33:00 +0100 | [diff] [blame] | 163 | frame_time = (frame_length * 80) / rate; |
| 164 | tmp = (frame_time * rate) / 80; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 165 | |
Malcolm Priestley | 030ede1 | 2014-05-19 20:33:00 +0100 | [diff] [blame] | 166 | if (frame_length != tmp) |
| 167 | frame_time++; |
Malcolm Priestley | 4d99952 | 2014-05-19 20:32:58 +0100 | [diff] [blame] | 168 | |
Malcolm Priestley | 030ede1 | 2014-05-19 20:33:00 +0100 | [diff] [blame] | 169 | return preamble + frame_time; |
Malcolm Priestley | 4d99952 | 2014-05-19 20:32:58 +0100 | [diff] [blame] | 170 | } |
Rajbinder Brar | b377ed4 | 2014-09-17 21:27:03 +0530 | [diff] [blame] | 171 | frame_time = (frame_length * 8 + 22) / rate; |
| 172 | tmp = ((frame_time * rate) - 22) / 8; |
| 173 | |
| 174 | if (frame_length != tmp) |
| 175 | frame_time++; |
| 176 | |
| 177 | frame_time = frame_time * 4; |
| 178 | |
| 179 | if (pkt_type != PK_TYPE_11A) |
| 180 | frame_time += 6; |
| 181 | return 20 + frame_time; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 182 | } |
| 183 | |
| 184 | /* |
Justin P. Mattock | a0a1f61 | 2012-08-26 08:16:43 -0700 | [diff] [blame] | 185 | * Description: Calculate Length, Service, and Signal fields of Phy for Tx |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 186 | * |
| 187 | * Parameters: |
| 188 | * In: |
Malcolm Priestley | a1ff543 | 2014-05-19 20:33:02 +0100 | [diff] [blame] | 189 | * priv - Device Structure |
| 190 | * frame_length - Tx Frame Length |
| 191 | * tx_rate - Tx Rate |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 192 | * Out: |
Malcolm Priestley | aed387c | 2013-08-20 22:52:30 +0100 | [diff] [blame] | 193 | * struct vnt_phy_field *phy |
Peter Senna Tschudin | 618d7d0 | 2014-07-15 23:23:25 +0200 | [diff] [blame] | 194 | * - pointer to Phy Length field |
| 195 | * - pointer to Phy Service field |
| 196 | * - pointer to Phy Signal field |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 197 | * |
| 198 | * Return Value: none |
| 199 | * |
| 200 | */ |
Malcolm Priestley | 205056f | 2014-06-04 18:25:34 +0100 | [diff] [blame] | 201 | void vnt_get_phy_field(struct vnt_private *priv, u32 frame_length, |
Malcolm Priestley | a1ff543 | 2014-05-19 20:33:02 +0100 | [diff] [blame] | 202 | u16 tx_rate, u8 pkt_type, struct vnt_phy_field *phy) |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 203 | { |
Malcolm Priestley | a1ff543 | 2014-05-19 20:33:02 +0100 | [diff] [blame] | 204 | u32 bit_count; |
| 205 | u32 count = 0; |
| 206 | u32 tmp; |
| 207 | int ext_bit; |
Malcolm Priestley | 98e93fe | 2014-07-20 15:33:17 +0100 | [diff] [blame] | 208 | u8 preamble_type = priv->preamble_type; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 209 | |
Malcolm Priestley | a1ff543 | 2014-05-19 20:33:02 +0100 | [diff] [blame] | 210 | bit_count = frame_length * 8; |
| 211 | ext_bit = false; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 212 | |
Malcolm Priestley | a1ff543 | 2014-05-19 20:33:02 +0100 | [diff] [blame] | 213 | switch (tx_rate) { |
Malcolm Priestley | a4fb3e7 | 2014-05-19 20:33:01 +0100 | [diff] [blame] | 214 | case RATE_1M: |
Malcolm Priestley | a1ff543 | 2014-05-19 20:33:02 +0100 | [diff] [blame] | 215 | count = bit_count; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 216 | |
Malcolm Priestley | a4fb3e7 | 2014-05-19 20:33:01 +0100 | [diff] [blame] | 217 | phy->signal = 0x00; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 218 | |
Malcolm Priestley | a4fb3e7 | 2014-05-19 20:33:01 +0100 | [diff] [blame] | 219 | break; |
| 220 | case RATE_2M: |
Malcolm Priestley | a1ff543 | 2014-05-19 20:33:02 +0100 | [diff] [blame] | 221 | count = bit_count / 2; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 222 | |
Malcolm Priestley | a1ff543 | 2014-05-19 20:33:02 +0100 | [diff] [blame] | 223 | if (preamble_type == 1) |
Malcolm Priestley | a4fb3e7 | 2014-05-19 20:33:01 +0100 | [diff] [blame] | 224 | phy->signal = 0x09; |
| 225 | else |
| 226 | phy->signal = 0x01; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 227 | |
Malcolm Priestley | a4fb3e7 | 2014-05-19 20:33:01 +0100 | [diff] [blame] | 228 | break; |
| 229 | case RATE_5M: |
Malcolm Priestley | a1ff543 | 2014-05-19 20:33:02 +0100 | [diff] [blame] | 230 | count = (bit_count * 10) / 55; |
| 231 | tmp = (count * 55) / 10; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 232 | |
Malcolm Priestley | a1ff543 | 2014-05-19 20:33:02 +0100 | [diff] [blame] | 233 | if (tmp != bit_count) |
| 234 | count++; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 235 | |
Malcolm Priestley | a1ff543 | 2014-05-19 20:33:02 +0100 | [diff] [blame] | 236 | if (preamble_type == 1) |
Malcolm Priestley | a4fb3e7 | 2014-05-19 20:33:01 +0100 | [diff] [blame] | 237 | phy->signal = 0x0a; |
| 238 | else |
| 239 | phy->signal = 0x02; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 240 | |
Malcolm Priestley | a4fb3e7 | 2014-05-19 20:33:01 +0100 | [diff] [blame] | 241 | break; |
| 242 | case RATE_11M: |
Malcolm Priestley | a1ff543 | 2014-05-19 20:33:02 +0100 | [diff] [blame] | 243 | count = bit_count / 11; |
| 244 | tmp = count * 11; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 245 | |
Malcolm Priestley | a1ff543 | 2014-05-19 20:33:02 +0100 | [diff] [blame] | 246 | if (tmp != bit_count) { |
| 247 | count++; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 248 | |
Malcolm Priestley | a1ff543 | 2014-05-19 20:33:02 +0100 | [diff] [blame] | 249 | if ((bit_count - tmp) <= 3) |
| 250 | ext_bit = true; |
Malcolm Priestley | a4fb3e7 | 2014-05-19 20:33:01 +0100 | [diff] [blame] | 251 | } |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 252 | |
Malcolm Priestley | a1ff543 | 2014-05-19 20:33:02 +0100 | [diff] [blame] | 253 | if (preamble_type == 1) |
Malcolm Priestley | a4fb3e7 | 2014-05-19 20:33:01 +0100 | [diff] [blame] | 254 | phy->signal = 0x0b; |
| 255 | else |
| 256 | phy->signal = 0x03; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 257 | |
Malcolm Priestley | a4fb3e7 | 2014-05-19 20:33:01 +0100 | [diff] [blame] | 258 | break; |
| 259 | case RATE_6M: |
Malcolm Priestley | a1ff543 | 2014-05-19 20:33:02 +0100 | [diff] [blame] | 260 | if (pkt_type == PK_TYPE_11A) |
Malcolm Priestley | a4fb3e7 | 2014-05-19 20:33:01 +0100 | [diff] [blame] | 261 | phy->signal = 0x9b; |
| 262 | else |
| 263 | phy->signal = 0x8b; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 264 | |
Malcolm Priestley | a4fb3e7 | 2014-05-19 20:33:01 +0100 | [diff] [blame] | 265 | break; |
| 266 | case RATE_9M: |
Malcolm Priestley | a1ff543 | 2014-05-19 20:33:02 +0100 | [diff] [blame] | 267 | if (pkt_type == PK_TYPE_11A) |
Malcolm Priestley | a4fb3e7 | 2014-05-19 20:33:01 +0100 | [diff] [blame] | 268 | phy->signal = 0x9f; |
| 269 | else |
| 270 | phy->signal = 0x8f; |
| 271 | |
| 272 | break; |
| 273 | case RATE_12M: |
Malcolm Priestley | a1ff543 | 2014-05-19 20:33:02 +0100 | [diff] [blame] | 274 | if (pkt_type == PK_TYPE_11A) |
Malcolm Priestley | a4fb3e7 | 2014-05-19 20:33:01 +0100 | [diff] [blame] | 275 | phy->signal = 0x9a; |
| 276 | else |
| 277 | phy->signal = 0x8a; |
| 278 | |
| 279 | break; |
| 280 | case RATE_18M: |
Malcolm Priestley | a1ff543 | 2014-05-19 20:33:02 +0100 | [diff] [blame] | 281 | if (pkt_type == PK_TYPE_11A) |
Malcolm Priestley | a4fb3e7 | 2014-05-19 20:33:01 +0100 | [diff] [blame] | 282 | phy->signal = 0x9e; |
| 283 | else |
| 284 | phy->signal = 0x8e; |
| 285 | |
| 286 | break; |
| 287 | case RATE_24M: |
Malcolm Priestley | a1ff543 | 2014-05-19 20:33:02 +0100 | [diff] [blame] | 288 | if (pkt_type == PK_TYPE_11A) |
Malcolm Priestley | a4fb3e7 | 2014-05-19 20:33:01 +0100 | [diff] [blame] | 289 | phy->signal = 0x99; |
| 290 | else |
| 291 | phy->signal = 0x89; |
| 292 | |
| 293 | break; |
| 294 | case RATE_36M: |
Malcolm Priestley | a1ff543 | 2014-05-19 20:33:02 +0100 | [diff] [blame] | 295 | if (pkt_type == PK_TYPE_11A) |
Malcolm Priestley | a4fb3e7 | 2014-05-19 20:33:01 +0100 | [diff] [blame] | 296 | phy->signal = 0x9d; |
| 297 | else |
| 298 | phy->signal = 0x8d; |
| 299 | |
| 300 | break; |
| 301 | case RATE_48M: |
Malcolm Priestley | a1ff543 | 2014-05-19 20:33:02 +0100 | [diff] [blame] | 302 | if (pkt_type == PK_TYPE_11A) |
Malcolm Priestley | a4fb3e7 | 2014-05-19 20:33:01 +0100 | [diff] [blame] | 303 | phy->signal = 0x98; |
| 304 | else |
| 305 | phy->signal = 0x88; |
| 306 | |
| 307 | break; |
| 308 | case RATE_54M: |
Malcolm Priestley | a1ff543 | 2014-05-19 20:33:02 +0100 | [diff] [blame] | 309 | if (pkt_type == PK_TYPE_11A) |
Malcolm Priestley | a4fb3e7 | 2014-05-19 20:33:01 +0100 | [diff] [blame] | 310 | phy->signal = 0x9c; |
| 311 | else |
| 312 | phy->signal = 0x8c; |
| 313 | break; |
| 314 | default: |
Malcolm Priestley | a1ff543 | 2014-05-19 20:33:02 +0100 | [diff] [blame] | 315 | if (pkt_type == PK_TYPE_11A) |
Malcolm Priestley | a4fb3e7 | 2014-05-19 20:33:01 +0100 | [diff] [blame] | 316 | phy->signal = 0x9c; |
| 317 | else |
| 318 | phy->signal = 0x8c; |
| 319 | break; |
| 320 | } |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 321 | |
Malcolm Priestley | a1ff543 | 2014-05-19 20:33:02 +0100 | [diff] [blame] | 322 | if (pkt_type == PK_TYPE_11B) { |
Malcolm Priestley | aed387c | 2013-08-20 22:52:30 +0100 | [diff] [blame] | 323 | phy->service = 0x00; |
Malcolm Priestley | a1ff543 | 2014-05-19 20:33:02 +0100 | [diff] [blame] | 324 | if (ext_bit) |
Malcolm Priestley | aed387c | 2013-08-20 22:52:30 +0100 | [diff] [blame] | 325 | phy->service |= 0x80; |
Malcolm Priestley | a1ff543 | 2014-05-19 20:33:02 +0100 | [diff] [blame] | 326 | phy->len = cpu_to_le16((u16)count); |
Malcolm Priestley | 4ac306e | 2013-08-20 22:49:26 +0100 | [diff] [blame] | 327 | } else { |
Malcolm Priestley | aed387c | 2013-08-20 22:52:30 +0100 | [diff] [blame] | 328 | phy->service = 0x00; |
Malcolm Priestley | a1ff543 | 2014-05-19 20:33:02 +0100 | [diff] [blame] | 329 | phy->len = cpu_to_le16((u16)frame_length); |
Malcolm Priestley | 4ac306e | 2013-08-20 22:49:26 +0100 | [diff] [blame] | 330 | } |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 331 | } |
| 332 | |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 333 | /* |
| 334 | * Description: Set Antenna mode |
| 335 | * |
| 336 | * Parameters: |
| 337 | * In: |
Malcolm Priestley | 53dab32 | 2014-05-19 20:33:04 +0100 | [diff] [blame] | 338 | * priv - Device Structure |
| 339 | * antenna_mode - Antenna Mode |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 340 | * Out: |
| 341 | * none |
| 342 | * |
| 343 | * Return Value: none |
| 344 | * |
| 345 | */ |
Malcolm Priestley | 41868bf | 2014-07-16 22:21:52 +0100 | [diff] [blame] | 346 | void vnt_set_antenna_mode(struct vnt_private *priv, u8 antenna_mode) |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 347 | { |
Malcolm Priestley | 53dab32 | 2014-05-19 20:33:04 +0100 | [diff] [blame] | 348 | switch (antenna_mode) { |
Malcolm Priestley | efe40c0 | 2014-05-19 20:33:03 +0100 | [diff] [blame] | 349 | case ANT_TXA: |
| 350 | case ANT_TXB: |
| 351 | break; |
| 352 | case ANT_RXA: |
Malcolm Priestley | cd5856a | 2014-07-19 12:30:08 +0100 | [diff] [blame] | 353 | priv->bb_rx_conf &= 0xFC; |
Malcolm Priestley | efe40c0 | 2014-05-19 20:33:03 +0100 | [diff] [blame] | 354 | break; |
| 355 | case ANT_RXB: |
Malcolm Priestley | cd5856a | 2014-07-19 12:30:08 +0100 | [diff] [blame] | 356 | priv->bb_rx_conf &= 0xFE; |
| 357 | priv->bb_rx_conf |= 0x02; |
Malcolm Priestley | efe40c0 | 2014-05-19 20:33:03 +0100 | [diff] [blame] | 358 | break; |
| 359 | } |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 360 | |
Malcolm Priestley | 1390b02 | 2014-05-26 13:59:01 +0100 | [diff] [blame] | 361 | vnt_control_out(priv, MESSAGE_TYPE_SET_ANTMD, |
Malcolm Priestley | 53dab32 | 2014-05-19 20:33:04 +0100 | [diff] [blame] | 362 | (u16)antenna_mode, 0, 0, NULL); |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 363 | } |
| 364 | |
| 365 | /* |
| 366 | * Description: Set Antenna mode |
| 367 | * |
| 368 | * Parameters: |
| 369 | * In: |
| 370 | * pDevice - Device Structure |
| 371 | * byAntennaMode - Antenna Mode |
| 372 | * Out: |
| 373 | * none |
| 374 | * |
| 375 | * Return Value: none |
| 376 | * |
| 377 | */ |
Andres More | 6487c49 | 2010-08-02 20:51:57 -0300 | [diff] [blame] | 378 | |
Malcolm Priestley | 7534180 | 2014-07-16 22:21:53 +0100 | [diff] [blame] | 379 | int vnt_vt3184_init(struct vnt_private *priv) |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 380 | { |
Malcolm Priestley | 9b89b04 | 2013-12-07 11:40:28 +0000 | [diff] [blame] | 381 | int status; |
Malcolm Priestley | 4237fe4 | 2014-05-25 21:36:26 +0100 | [diff] [blame] | 382 | u16 length; |
Malcolm Priestley | 9b89b04 | 2013-12-07 11:40:28 +0000 | [diff] [blame] | 383 | u8 *addr; |
| 384 | u8 *agc; |
Malcolm Priestley | 4237fe4 | 2014-05-25 21:36:26 +0100 | [diff] [blame] | 385 | u16 length_agc; |
Malcolm Priestley | 9b89b04 | 2013-12-07 11:40:28 +0000 | [diff] [blame] | 386 | u8 array[256]; |
Malcolm Priestley | 9df6829 | 2013-11-07 21:49:04 +0000 | [diff] [blame] | 387 | u8 data; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 388 | |
Malcolm Priestley | 441c21c | 2014-05-26 13:59:02 +0100 | [diff] [blame] | 389 | status = vnt_control_in(priv, MESSAGE_TYPE_READ, 0, |
Malcolm Priestley | 9b89b04 | 2013-12-07 11:40:28 +0000 | [diff] [blame] | 390 | MESSAGE_REQUEST_EEPROM, EEP_MAX_CONTEXT_SIZE, |
Malcolm Priestley | bbb1126 | 2014-07-20 15:33:16 +0100 | [diff] [blame] | 391 | priv->eeprom); |
Malcolm Priestley | 9b89b04 | 2013-12-07 11:40:28 +0000 | [diff] [blame] | 392 | if (status != STATUS_SUCCESS) |
| 393 | return false; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 394 | |
Malcolm Priestley | bbb1126 | 2014-07-20 15:33:16 +0100 | [diff] [blame] | 395 | priv->rf_type = priv->eeprom[EEP_OFS_RFTYPE]; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 396 | |
Malcolm Priestley | 6242eca | 2014-07-19 12:30:07 +0100 | [diff] [blame] | 397 | dev_dbg(&priv->usb->dev, "RF Type %d\n", priv->rf_type); |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 398 | |
Malcolm Priestley | 6242eca | 2014-07-19 12:30:07 +0100 | [diff] [blame] | 399 | if ((priv->rf_type == RF_AL2230) || |
| 400 | (priv->rf_type == RF_AL2230S)) { |
Malcolm Priestley | cd5856a | 2014-07-19 12:30:08 +0100 | [diff] [blame] | 401 | priv->bb_rx_conf = vnt_vt3184_al2230[10]; |
Malcolm Priestley | ab48ab2 | 2014-07-12 20:12:44 +0100 | [diff] [blame] | 402 | length = sizeof(vnt_vt3184_al2230); |
| 403 | addr = vnt_vt3184_al2230; |
Malcolm Priestley | 170ce6d | 2014-07-12 20:12:43 +0100 | [diff] [blame] | 404 | agc = vnt_vt3184_agc; |
| 405 | length_agc = sizeof(vnt_vt3184_agc); |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 406 | |
Malcolm Priestley | c37cbd3 | 2014-07-20 15:33:25 +0100 | [diff] [blame] | 407 | priv->bb_vga[0] = 0x1C; |
| 408 | priv->bb_vga[1] = 0x10; |
| 409 | priv->bb_vga[2] = 0x0; |
| 410 | priv->bb_vga[3] = 0x0; |
Malcolm Priestley | 975c89f | 2014-07-20 15:33:26 +0100 | [diff] [blame] | 411 | |
Malcolm Priestley | 6242eca | 2014-07-19 12:30:07 +0100 | [diff] [blame] | 412 | } else if (priv->rf_type == RF_AIROHA7230) { |
Malcolm Priestley | cd5856a | 2014-07-19 12:30:08 +0100 | [diff] [blame] | 413 | priv->bb_rx_conf = vnt_vt3184_al2230[10]; |
Malcolm Priestley | ab48ab2 | 2014-07-12 20:12:44 +0100 | [diff] [blame] | 414 | length = sizeof(vnt_vt3184_al2230); |
| 415 | addr = vnt_vt3184_al2230; |
Malcolm Priestley | 170ce6d | 2014-07-12 20:12:43 +0100 | [diff] [blame] | 416 | agc = vnt_vt3184_agc; |
| 417 | length_agc = sizeof(vnt_vt3184_agc); |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 418 | |
Malcolm Priestley | 9b89b04 | 2013-12-07 11:40:28 +0000 | [diff] [blame] | 419 | addr[0xd7] = 0x06; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 420 | |
Malcolm Priestley | c37cbd3 | 2014-07-20 15:33:25 +0100 | [diff] [blame] | 421 | priv->bb_vga[0] = 0x1c; |
| 422 | priv->bb_vga[1] = 0x10; |
| 423 | priv->bb_vga[2] = 0x0; |
| 424 | priv->bb_vga[3] = 0x0; |
Malcolm Priestley | 975c89f | 2014-07-20 15:33:26 +0100 | [diff] [blame] | 425 | |
Malcolm Priestley | 6242eca | 2014-07-19 12:30:07 +0100 | [diff] [blame] | 426 | } else if ((priv->rf_type == RF_VT3226) || |
| 427 | (priv->rf_type == RF_VT3226D0)) { |
Malcolm Priestley | cd5856a | 2014-07-19 12:30:08 +0100 | [diff] [blame] | 428 | priv->bb_rx_conf = vnt_vt3184_vt3226d0[10]; |
Malcolm Priestley | 0a16b63 | 2014-07-12 20:12:45 +0100 | [diff] [blame] | 429 | length = sizeof(vnt_vt3184_vt3226d0); |
| 430 | addr = vnt_vt3184_vt3226d0; |
Malcolm Priestley | 170ce6d | 2014-07-12 20:12:43 +0100 | [diff] [blame] | 431 | agc = vnt_vt3184_agc; |
| 432 | length_agc = sizeof(vnt_vt3184_agc); |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 433 | |
Malcolm Priestley | c37cbd3 | 2014-07-20 15:33:25 +0100 | [diff] [blame] | 434 | priv->bb_vga[0] = 0x20; |
| 435 | priv->bb_vga[1] = 0x10; |
| 436 | priv->bb_vga[2] = 0x0; |
| 437 | priv->bb_vga[3] = 0x0; |
Malcolm Priestley | 975c89f | 2014-07-20 15:33:26 +0100 | [diff] [blame] | 438 | |
Malcolm Priestley | 9b89b04 | 2013-12-07 11:40:28 +0000 | [diff] [blame] | 439 | /* Fix VT3226 DFC system timing issue */ |
Peter Senna Tschudin | 495e2be | 2014-07-14 21:15:29 +0200 | [diff] [blame] | 440 | vnt_mac_reg_bits_on(priv, MAC_REG_SOFTPWRCTL2, |
| 441 | SOFTPWRCTL_RFLEOPT); |
Malcolm Priestley | 6242eca | 2014-07-19 12:30:07 +0100 | [diff] [blame] | 442 | } else if (priv->rf_type == RF_VT3342A0) { |
Malcolm Priestley | cd5856a | 2014-07-19 12:30:08 +0100 | [diff] [blame] | 443 | priv->bb_rx_conf = vnt_vt3184_vt3226d0[10]; |
Malcolm Priestley | 0a16b63 | 2014-07-12 20:12:45 +0100 | [diff] [blame] | 444 | length = sizeof(vnt_vt3184_vt3226d0); |
| 445 | addr = vnt_vt3184_vt3226d0; |
Malcolm Priestley | 170ce6d | 2014-07-12 20:12:43 +0100 | [diff] [blame] | 446 | agc = vnt_vt3184_agc; |
| 447 | length_agc = sizeof(vnt_vt3184_agc); |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 448 | |
Malcolm Priestley | c37cbd3 | 2014-07-20 15:33:25 +0100 | [diff] [blame] | 449 | priv->bb_vga[0] = 0x20; |
| 450 | priv->bb_vga[1] = 0x10; |
| 451 | priv->bb_vga[2] = 0x0; |
| 452 | priv->bb_vga[3] = 0x0; |
Malcolm Priestley | 975c89f | 2014-07-20 15:33:26 +0100 | [diff] [blame] | 453 | |
Malcolm Priestley | 9b89b04 | 2013-12-07 11:40:28 +0000 | [diff] [blame] | 454 | /* Fix VT3226 DFC system timing issue */ |
Peter Senna Tschudin | 42b138d | 2014-07-15 23:23:26 +0200 | [diff] [blame] | 455 | vnt_mac_reg_bits_on(priv, MAC_REG_SOFTPWRCTL2, |
| 456 | SOFTPWRCTL_RFLEOPT); |
Malcolm Priestley | 9b89b04 | 2013-12-07 11:40:28 +0000 | [diff] [blame] | 457 | } else { |
| 458 | return true; |
| 459 | } |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 460 | |
Malcolm Priestley | 4237fe4 | 2014-05-25 21:36:26 +0100 | [diff] [blame] | 461 | memcpy(array, addr, length); |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 462 | |
Malcolm Priestley | 1390b02 | 2014-05-26 13:59:01 +0100 | [diff] [blame] | 463 | vnt_control_out(priv, MESSAGE_TYPE_WRITE, 0, |
Malcolm Priestley | 4237fe4 | 2014-05-25 21:36:26 +0100 | [diff] [blame] | 464 | MESSAGE_REQUEST_BBREG, length, array); |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 465 | |
Malcolm Priestley | 4237fe4 | 2014-05-25 21:36:26 +0100 | [diff] [blame] | 466 | memcpy(array, agc, length_agc); |
Malcolm Priestley | 9b89b04 | 2013-12-07 11:40:28 +0000 | [diff] [blame] | 467 | |
Malcolm Priestley | 1390b02 | 2014-05-26 13:59:01 +0100 | [diff] [blame] | 468 | vnt_control_out(priv, MESSAGE_TYPE_WRITE, 0, |
Malcolm Priestley | 4237fe4 | 2014-05-25 21:36:26 +0100 | [diff] [blame] | 469 | MESSAGE_REQUEST_BBAGC, length_agc, array); |
Malcolm Priestley | 9b89b04 | 2013-12-07 11:40:28 +0000 | [diff] [blame] | 470 | |
Malcolm Priestley | 6242eca | 2014-07-19 12:30:07 +0100 | [diff] [blame] | 471 | if ((priv->rf_type == RF_VT3226) || |
| 472 | (priv->rf_type == RF_VT3342A0)) { |
Malcolm Priestley | 285d58c | 2014-05-26 13:59:03 +0100 | [diff] [blame] | 473 | vnt_control_out_u8(priv, MESSAGE_REQUEST_MACREG, |
Malcolm Priestley | 9b89b04 | 2013-12-07 11:40:28 +0000 | [diff] [blame] | 474 | MAC_REG_ITRTMSET, 0x23); |
Malcolm Priestley | 3695753 | 2014-05-31 11:50:42 +0100 | [diff] [blame] | 475 | vnt_mac_reg_bits_on(priv, MAC_REG_PAPEDELAY, 0x01); |
Malcolm Priestley | 6242eca | 2014-07-19 12:30:07 +0100 | [diff] [blame] | 476 | } else if (priv->rf_type == RF_VT3226D0) { |
Malcolm Priestley | 285d58c | 2014-05-26 13:59:03 +0100 | [diff] [blame] | 477 | vnt_control_out_u8(priv, MESSAGE_REQUEST_MACREG, |
Malcolm Priestley | 9b89b04 | 2013-12-07 11:40:28 +0000 | [diff] [blame] | 478 | MAC_REG_ITRTMSET, 0x11); |
Malcolm Priestley | 3695753 | 2014-05-31 11:50:42 +0100 | [diff] [blame] | 479 | vnt_mac_reg_bits_on(priv, MAC_REG_PAPEDELAY, 0x01); |
Malcolm Priestley | 9b89b04 | 2013-12-07 11:40:28 +0000 | [diff] [blame] | 480 | } |
| 481 | |
Malcolm Priestley | 285d58c | 2014-05-26 13:59:03 +0100 | [diff] [blame] | 482 | vnt_control_out_u8(priv, MESSAGE_REQUEST_BBREG, 0x04, 0x7f); |
| 483 | vnt_control_out_u8(priv, MESSAGE_REQUEST_BBREG, 0x0d, 0x01); |
Malcolm Priestley | 9b89b04 | 2013-12-07 11:40:28 +0000 | [diff] [blame] | 484 | |
Malcolm Priestley | c49d755 | 2014-05-27 21:05:24 +0100 | [diff] [blame] | 485 | vnt_rf_table_download(priv); |
Malcolm Priestley | 9df6829 | 2013-11-07 21:49:04 +0000 | [diff] [blame] | 486 | |
| 487 | /* Fix for TX USB resets from vendors driver */ |
Malcolm Priestley | 441c21c | 2014-05-26 13:59:02 +0100 | [diff] [blame] | 488 | vnt_control_in(priv, MESSAGE_TYPE_READ, USB_REG4, |
Malcolm Priestley | 9df6829 | 2013-11-07 21:49:04 +0000 | [diff] [blame] | 489 | MESSAGE_REQUEST_MEM, sizeof(data), &data); |
| 490 | |
| 491 | data |= 0x2; |
| 492 | |
Malcolm Priestley | 1390b02 | 2014-05-26 13:59:01 +0100 | [diff] [blame] | 493 | vnt_control_out(priv, MESSAGE_TYPE_WRITE, USB_REG4, |
Malcolm Priestley | 9df6829 | 2013-11-07 21:49:04 +0000 | [diff] [blame] | 494 | MESSAGE_REQUEST_MEM, sizeof(data), &data); |
| 495 | |
Malcolm Priestley | 9b89b04 | 2013-12-07 11:40:28 +0000 | [diff] [blame] | 496 | return true; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 497 | } |
| 498 | |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 499 | /* |
| 500 | * Description: Set ShortSlotTime mode |
| 501 | * |
| 502 | * Parameters: |
| 503 | * In: |
Malcolm Priestley | 4bdb312 | 2014-05-19 20:33:05 +0100 | [diff] [blame] | 504 | * priv - Device Structure |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 505 | * Out: |
| 506 | * none |
| 507 | * |
| 508 | * Return Value: none |
| 509 | * |
| 510 | */ |
Malcolm Priestley | 3c956cc | 2014-07-16 22:21:54 +0100 | [diff] [blame] | 511 | void vnt_set_short_slot_time(struct vnt_private *priv) |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 512 | { |
Malcolm Priestley | 4bdb312 | 2014-05-19 20:33:05 +0100 | [diff] [blame] | 513 | u8 bb_vga = 0; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 514 | |
Malcolm Priestley | a641c9e | 2014-07-20 15:33:21 +0100 | [diff] [blame] | 515 | if (priv->short_slot_time) |
Malcolm Priestley | cd5856a | 2014-07-19 12:30:08 +0100 | [diff] [blame] | 516 | priv->bb_rx_conf &= 0xdf; |
Marcos Paulo de Souza | f001d7e | 2011-11-30 00:19:08 -0200 | [diff] [blame] | 517 | else |
Malcolm Priestley | cd5856a | 2014-07-19 12:30:08 +0100 | [diff] [blame] | 518 | priv->bb_rx_conf |= 0x20; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 519 | |
Malcolm Priestley | 5374290 | 2014-05-26 13:59:06 +0100 | [diff] [blame] | 520 | vnt_control_in_u8(priv, MESSAGE_REQUEST_BBREG, 0xe7, &bb_vga); |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 521 | |
Malcolm Priestley | c37cbd3 | 2014-07-20 15:33:25 +0100 | [diff] [blame] | 522 | if (bb_vga == priv->bb_vga[0]) |
Malcolm Priestley | cd5856a | 2014-07-19 12:30:08 +0100 | [diff] [blame] | 523 | priv->bb_rx_conf |= 0x20; |
Malcolm Priestley | 4bdb312 | 2014-05-19 20:33:05 +0100 | [diff] [blame] | 524 | |
Malcolm Priestley | cd5856a | 2014-07-19 12:30:08 +0100 | [diff] [blame] | 525 | vnt_control_out_u8(priv, MESSAGE_REQUEST_BBREG, 0x0a, priv->bb_rx_conf); |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 526 | } |
| 527 | |
Malcolm Priestley | de8690a | 2014-07-16 22:21:55 +0100 | [diff] [blame] | 528 | void vnt_set_vga_gain_offset(struct vnt_private *priv, u8 data) |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 529 | { |
Malcolm Priestley | 285d58c | 2014-05-26 13:59:03 +0100 | [diff] [blame] | 530 | vnt_control_out_u8(priv, MESSAGE_REQUEST_BBREG, 0xE7, data); |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 531 | |
Malcolm Priestley | 15897f6 | 2014-05-19 20:33:06 +0100 | [diff] [blame] | 532 | /* patch for 3253B0 Baseband with Cardbus module */ |
Malcolm Priestley | a641c9e | 2014-07-20 15:33:21 +0100 | [diff] [blame] | 533 | if (priv->short_slot_time) |
Malcolm Priestley | cd5856a | 2014-07-19 12:30:08 +0100 | [diff] [blame] | 534 | priv->bb_rx_conf &= 0xdf; /* 1101 1111 */ |
Marcos Paulo de Souza | f001d7e | 2011-11-30 00:19:08 -0200 | [diff] [blame] | 535 | else |
Malcolm Priestley | cd5856a | 2014-07-19 12:30:08 +0100 | [diff] [blame] | 536 | priv->bb_rx_conf |= 0x20; /* 0010 0000 */ |
Marcos Paulo de Souza | f001d7e | 2011-11-30 00:19:08 -0200 | [diff] [blame] | 537 | |
Malcolm Priestley | cd5856a | 2014-07-19 12:30:08 +0100 | [diff] [blame] | 538 | vnt_control_out_u8(priv, MESSAGE_REQUEST_BBREG, 0x0a, priv->bb_rx_conf); |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 539 | } |
| 540 | |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 541 | /* |
Malcolm Priestley | e8e072d | 2014-07-16 22:21:56 +0100 | [diff] [blame] | 542 | * Description: vnt_set_deep_sleep |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 543 | * |
| 544 | * Parameters: |
| 545 | * In: |
Malcolm Priestley | 07c116f2 | 2014-05-19 20:33:07 +0100 | [diff] [blame] | 546 | * priv - Device Structure |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 547 | * Out: |
| 548 | * none |
| 549 | * |
| 550 | * Return Value: none |
| 551 | * |
| 552 | */ |
Malcolm Priestley | e8e072d | 2014-07-16 22:21:56 +0100 | [diff] [blame] | 553 | void vnt_set_deep_sleep(struct vnt_private *priv) |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 554 | { |
Malcolm Priestley | 285d58c | 2014-05-26 13:59:03 +0100 | [diff] [blame] | 555 | vnt_control_out_u8(priv, MESSAGE_REQUEST_BBREG, 0x0c, 0x17);/* CR12 */ |
| 556 | vnt_control_out_u8(priv, MESSAGE_REQUEST_BBREG, 0x0d, 0xB9);/* CR13 */ |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 557 | } |
| 558 | |
Malcolm Priestley | 0e95175 | 2014-07-16 22:21:57 +0100 | [diff] [blame] | 559 | void vnt_exit_deep_sleep(struct vnt_private *priv) |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 560 | { |
Malcolm Priestley | 285d58c | 2014-05-26 13:59:03 +0100 | [diff] [blame] | 561 | vnt_control_out_u8(priv, MESSAGE_REQUEST_BBREG, 0x0c, 0x00);/* CR12 */ |
| 562 | vnt_control_out_u8(priv, MESSAGE_REQUEST_BBREG, 0x0d, 0x01);/* CR13 */ |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 563 | } |
| 564 | |
Malcolm Priestley | 80dcc0a | 2014-07-16 22:21:58 +0100 | [diff] [blame] | 565 | void vnt_update_pre_ed_threshold(struct vnt_private *priv, int scanning) |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 566 | { |
Malcolm Priestley | 7794dad | 2014-05-19 20:33:10 +0100 | [diff] [blame] | 567 | u8 cr_201 = 0x0, cr_206 = 0x0; |
Malcolm Priestley | 43fd192 | 2014-07-20 15:33:28 +0100 | [diff] [blame] | 568 | u8 ed_inx = priv->bb_pre_ed_index; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 569 | |
Malcolm Priestley | 6242eca | 2014-07-19 12:30:07 +0100 | [diff] [blame] | 570 | switch (priv->rf_type) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 571 | case RF_AL2230: |
| 572 | case RF_AL2230S: |
| 573 | case RF_AIROHA7230: |
| 574 | if (scanning) { /* Max sensitivity */ |
| 575 | ed_inx = 0; |
| 576 | cr_206 = 0x30; |
| 577 | break; |
| 578 | } |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 579 | |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 580 | if (priv->bb_pre_ed_rssi <= 45) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 581 | ed_inx = 20; |
| 582 | cr_201 = 0xff; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 583 | } else if (priv->bb_pre_ed_rssi <= 46) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 584 | ed_inx = 19; |
| 585 | cr_201 = 0x1a; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 586 | } else if (priv->bb_pre_ed_rssi <= 47) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 587 | ed_inx = 18; |
| 588 | cr_201 = 0x15; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 589 | } else if (priv->bb_pre_ed_rssi <= 49) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 590 | ed_inx = 17; |
| 591 | cr_201 = 0xe; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 592 | } else if (priv->bb_pre_ed_rssi <= 51) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 593 | ed_inx = 16; |
| 594 | cr_201 = 0x9; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 595 | } else if (priv->bb_pre_ed_rssi <= 53) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 596 | ed_inx = 15; |
| 597 | cr_201 = 0x6; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 598 | } else if (priv->bb_pre_ed_rssi <= 55) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 599 | ed_inx = 14; |
| 600 | cr_201 = 0x3; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 601 | } else if (priv->bb_pre_ed_rssi <= 56) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 602 | ed_inx = 13; |
| 603 | cr_201 = 0x2; |
| 604 | cr_206 = 0xa0; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 605 | } else if (priv->bb_pre_ed_rssi <= 57) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 606 | ed_inx = 12; |
| 607 | cr_201 = 0x2; |
| 608 | cr_206 = 0x20; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 609 | } else if (priv->bb_pre_ed_rssi <= 58) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 610 | ed_inx = 11; |
| 611 | cr_201 = 0x1; |
| 612 | cr_206 = 0xa0; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 613 | } else if (priv->bb_pre_ed_rssi <= 59) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 614 | ed_inx = 10; |
| 615 | cr_201 = 0x1; |
| 616 | cr_206 = 0x54; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 617 | } else if (priv->bb_pre_ed_rssi <= 60) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 618 | ed_inx = 9; |
| 619 | cr_201 = 0x1; |
| 620 | cr_206 = 0x18; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 621 | } else if (priv->bb_pre_ed_rssi <= 61) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 622 | ed_inx = 8; |
| 623 | cr_206 = 0xe3; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 624 | } else if (priv->bb_pre_ed_rssi <= 62) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 625 | ed_inx = 7; |
| 626 | cr_206 = 0xb9; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 627 | } else if (priv->bb_pre_ed_rssi <= 63) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 628 | ed_inx = 6; |
| 629 | cr_206 = 0x93; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 630 | } else if (priv->bb_pre_ed_rssi <= 64) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 631 | ed_inx = 5; |
| 632 | cr_206 = 0x79; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 633 | } else if (priv->bb_pre_ed_rssi <= 65) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 634 | ed_inx = 4; |
| 635 | cr_206 = 0x62; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 636 | } else if (priv->bb_pre_ed_rssi <= 66) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 637 | ed_inx = 3; |
| 638 | cr_206 = 0x51; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 639 | } else if (priv->bb_pre_ed_rssi <= 67) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 640 | ed_inx = 2; |
| 641 | cr_206 = 0x43; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 642 | } else if (priv->bb_pre_ed_rssi <= 68) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 643 | ed_inx = 1; |
| 644 | cr_206 = 0x36; |
| 645 | } else { |
| 646 | ed_inx = 0; |
| 647 | cr_206 = 0x30; |
| 648 | } |
| 649 | break; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 650 | |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 651 | case RF_VT3226: |
| 652 | case RF_VT3226D0: |
| 653 | if (scanning) { /* Max sensitivity */ |
| 654 | ed_inx = 0; |
| 655 | cr_206 = 0x24; |
| 656 | break; |
| 657 | } |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 658 | |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 659 | if (priv->bb_pre_ed_rssi <= 41) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 660 | ed_inx = 22; |
| 661 | cr_201 = 0xff; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 662 | } else if (priv->bb_pre_ed_rssi <= 42) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 663 | ed_inx = 21; |
| 664 | cr_201 = 0x36; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 665 | } else if (priv->bb_pre_ed_rssi <= 43) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 666 | ed_inx = 20; |
| 667 | cr_201 = 0x26; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 668 | } else if (priv->bb_pre_ed_rssi <= 45) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 669 | ed_inx = 19; |
| 670 | cr_201 = 0x18; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 671 | } else if (priv->bb_pre_ed_rssi <= 47) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 672 | ed_inx = 18; |
| 673 | cr_201 = 0x11; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 674 | } else if (priv->bb_pre_ed_rssi <= 49) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 675 | ed_inx = 17; |
| 676 | cr_201 = 0xa; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 677 | } else if (priv->bb_pre_ed_rssi <= 51) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 678 | ed_inx = 16; |
| 679 | cr_201 = 0x7; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 680 | } else if (priv->bb_pre_ed_rssi <= 53) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 681 | ed_inx = 15; |
| 682 | cr_201 = 0x4; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 683 | } else if (priv->bb_pre_ed_rssi <= 55) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 684 | ed_inx = 14; |
| 685 | cr_201 = 0x2; |
| 686 | cr_206 = 0xc0; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 687 | } else if (priv->bb_pre_ed_rssi <= 56) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 688 | ed_inx = 13; |
| 689 | cr_201 = 0x2; |
| 690 | cr_206 = 0x30; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 691 | } else if (priv->bb_pre_ed_rssi <= 57) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 692 | ed_inx = 12; |
| 693 | cr_201 = 0x1; |
| 694 | cr_206 = 0xb0; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 695 | } else if (priv->bb_pre_ed_rssi <= 58) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 696 | ed_inx = 11; |
| 697 | cr_201 = 0x1; |
| 698 | cr_206 = 0x70; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 699 | } else if (priv->bb_pre_ed_rssi <= 59) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 700 | ed_inx = 10; |
| 701 | cr_201 = 0x1; |
| 702 | cr_206 = 0x30; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 703 | } else if (priv->bb_pre_ed_rssi <= 60) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 704 | ed_inx = 9; |
| 705 | cr_206 = 0xea; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 706 | } else if (priv->bb_pre_ed_rssi <= 61) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 707 | ed_inx = 8; |
| 708 | cr_206 = 0xc0; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 709 | } else if (priv->bb_pre_ed_rssi <= 62) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 710 | ed_inx = 7; |
| 711 | cr_206 = 0x9c; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 712 | } else if (priv->bb_pre_ed_rssi <= 63) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 713 | ed_inx = 6; |
| 714 | cr_206 = 0x80; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 715 | } else if (priv->bb_pre_ed_rssi <= 64) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 716 | ed_inx = 5; |
| 717 | cr_206 = 0x68; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 718 | } else if (priv->bb_pre_ed_rssi <= 65) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 719 | ed_inx = 4; |
| 720 | cr_206 = 0x52; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 721 | } else if (priv->bb_pre_ed_rssi <= 66) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 722 | ed_inx = 3; |
| 723 | cr_206 = 0x43; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 724 | } else if (priv->bb_pre_ed_rssi <= 67) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 725 | ed_inx = 2; |
| 726 | cr_206 = 0x36; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 727 | } else if (priv->bb_pre_ed_rssi <= 68) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 728 | ed_inx = 1; |
| 729 | cr_206 = 0x2d; |
| 730 | } else { |
| 731 | ed_inx = 0; |
| 732 | cr_206 = 0x24; |
| 733 | } |
| 734 | break; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 735 | |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 736 | case RF_VT3342A0: |
| 737 | if (scanning) { /* need Max sensitivity */ |
| 738 | ed_inx = 0; |
| 739 | cr_206 = 0x38; |
| 740 | break; |
| 741 | } |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 742 | |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 743 | if (priv->bb_pre_ed_rssi <= 41) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 744 | ed_inx = 20; |
| 745 | cr_201 = 0xff; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 746 | } else if (priv->bb_pre_ed_rssi <= 42) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 747 | ed_inx = 19; |
| 748 | cr_201 = 0x36; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 749 | } else if (priv->bb_pre_ed_rssi <= 43) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 750 | ed_inx = 18; |
| 751 | cr_201 = 0x26; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 752 | } else if (priv->bb_pre_ed_rssi <= 45) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 753 | ed_inx = 17; |
| 754 | cr_201 = 0x18; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 755 | } else if (priv->bb_pre_ed_rssi <= 47) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 756 | ed_inx = 16; |
| 757 | cr_201 = 0x11; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 758 | } else if (priv->bb_pre_ed_rssi <= 49) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 759 | ed_inx = 15; |
| 760 | cr_201 = 0xa; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 761 | } else if (priv->bb_pre_ed_rssi <= 51) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 762 | ed_inx = 14; |
| 763 | cr_201 = 0x7; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 764 | } else if (priv->bb_pre_ed_rssi <= 53) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 765 | ed_inx = 13; |
| 766 | cr_201 = 0x4; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 767 | } else if (priv->bb_pre_ed_rssi <= 55) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 768 | ed_inx = 12; |
| 769 | cr_201 = 0x2; |
| 770 | cr_206 = 0xc0; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 771 | } else if (priv->bb_pre_ed_rssi <= 56) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 772 | ed_inx = 11; |
| 773 | cr_201 = 0x2; |
| 774 | cr_206 = 0x30; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 775 | } else if (priv->bb_pre_ed_rssi <= 57) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 776 | ed_inx = 10; |
| 777 | cr_201 = 0x1; |
| 778 | cr_206 = 0xb0; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 779 | } else if (priv->bb_pre_ed_rssi <= 58) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 780 | ed_inx = 9; |
| 781 | cr_201 = 0x1; |
| 782 | cr_206 = 0x70; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 783 | } else if (priv->bb_pre_ed_rssi <= 59) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 784 | ed_inx = 8; |
| 785 | cr_201 = 0x1; |
| 786 | cr_206 = 0x30; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 787 | } else if (priv->bb_pre_ed_rssi <= 60) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 788 | ed_inx = 7; |
| 789 | cr_206 = 0xea; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 790 | } else if (priv->bb_pre_ed_rssi <= 61) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 791 | ed_inx = 6; |
| 792 | cr_206 = 0xc0; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 793 | } else if (priv->bb_pre_ed_rssi <= 62) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 794 | ed_inx = 5; |
| 795 | cr_206 = 0x9c; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 796 | } else if (priv->bb_pre_ed_rssi <= 63) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 797 | ed_inx = 4; |
| 798 | cr_206 = 0x80; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 799 | } else if (priv->bb_pre_ed_rssi <= 64) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 800 | ed_inx = 3; |
| 801 | cr_206 = 0x68; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 802 | } else if (priv->bb_pre_ed_rssi <= 65) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 803 | ed_inx = 2; |
| 804 | cr_206 = 0x52; |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 805 | } else if (priv->bb_pre_ed_rssi <= 66) { |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 806 | ed_inx = 1; |
| 807 | cr_206 = 0x43; |
| 808 | } else { |
| 809 | ed_inx = 0; |
| 810 | cr_206 = 0x38; |
| 811 | } |
| 812 | break; |
Malcolm Priestley | 1944026 | 2014-05-19 20:33:12 +0100 | [diff] [blame] | 813 | } |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 814 | |
Malcolm Priestley | 43fd192 | 2014-07-20 15:33:28 +0100 | [diff] [blame] | 815 | if (ed_inx == priv->bb_pre_ed_index && !scanning) |
Malcolm Priestley | 6d5485a | 2014-05-19 20:33:11 +0100 | [diff] [blame] | 816 | return; |
| 817 | |
Malcolm Priestley | 43fd192 | 2014-07-20 15:33:28 +0100 | [diff] [blame] | 818 | priv->bb_pre_ed_index = ed_inx; |
Malcolm Priestley | 6d5485a | 2014-05-19 20:33:11 +0100 | [diff] [blame] | 819 | |
Malcolm Priestley | 1268722 | 2014-07-20 15:33:27 +0100 | [diff] [blame] | 820 | dev_dbg(&priv->usb->dev, "%s bb_pre_ed_rssi %d\n", |
| 821 | __func__, priv->bb_pre_ed_rssi); |
Malcolm Priestley | 0b7021f | 2014-05-19 20:33:09 +0100 | [diff] [blame] | 822 | |
Malcolm Priestley | 7794dad | 2014-05-19 20:33:10 +0100 | [diff] [blame] | 823 | if (!cr_201 && !cr_206) |
| 824 | return; |
| 825 | |
Malcolm Priestley | 285d58c | 2014-05-26 13:59:03 +0100 | [diff] [blame] | 826 | vnt_control_out_u8(priv, MESSAGE_REQUEST_BBREG, 0xc9, cr_201); |
| 827 | vnt_control_out_u8(priv, MESSAGE_REQUEST_BBREG, 0xce, cr_206); |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 828 | } |
| 829 | |