538 lines
		
	
	
		
			15 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			538 lines
		
	
	
		
			15 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /* ZD1211 USB-WLAN driver for Linux
 | |
|  *
 | |
|  * Copyright (C) 2005-2007 Ulrich Kunitz <kune@deine-taler.de>
 | |
|  * Copyright (C) 2006-2007 Daniel Drake <dsd@gentoo.org>
 | |
|  *
 | |
|  * This program is free software; you can redistribute it and/or modify
 | |
|  * it under the terms of the GNU General Public License as published by
 | |
|  * the Free Software Foundation; either version 2 of the License, or
 | |
|  * (at your option) any later version.
 | |
|  *
 | |
|  * This program is distributed in the hope that it will be useful,
 | |
|  * but WITHOUT ANY WARRANTY; without even the implied warranty of
 | |
|  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 | |
|  * GNU General Public License for more details.
 | |
|  *
 | |
|  * You should have received a copy of the GNU General Public License
 | |
|  * along with this program; if not, write to the Free Software
 | |
|  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
 | |
|  */
 | |
| 
 | |
| #include <linux/kernel.h>
 | |
| 
 | |
| #include "zd_rf.h"
 | |
| #include "zd_usb.h"
 | |
| #include "zd_chip.h"
 | |
| 
 | |
| /* This RF programming code is based upon the code found in v2.16.0.0 of the
 | |
|  * ZyDAS vendor driver. Unlike other RF's, Ubec publish full technical specs
 | |
|  * for this RF on their website, so we're able to understand more than
 | |
|  * usual as to what is going on. Thumbs up for Ubec for doing that. */
 | |
| 
 | |
| /* The 3-wire serial interface provides access to 8 write-only registers.
 | |
|  * The data format is a 4 bit register address followed by a 20 bit value. */
 | |
| #define UW2453_REGWRITE(reg, val) ((((reg) & 0xf) << 20) | ((val) & 0xfffff))
 | |
| 
 | |
| /* For channel tuning, we have to configure registers 1 (synthesizer), 2 (synth
 | |
|  * fractional divide ratio) and 3 (VCO config).
 | |
|  *
 | |
|  * We configure the RF to produce an interrupt when the PLL is locked onto
 | |
|  * the configured frequency. During initialization, we run through a variety
 | |
|  * of different VCO configurations on channel 1 until we detect a PLL lock.
 | |
|  * When this happens, we remember which VCO configuration produced the lock
 | |
|  * and use it later. Actually, we use the configuration *after* the one that
 | |
|  * produced the lock, which seems odd, but it works.
 | |
|  *
 | |
|  * If we do not see a PLL lock on any standard VCO config, we fall back on an
 | |
|  * autocal configuration, which has a fixed (as opposed to per-channel) VCO
 | |
|  * config and different synth values from the standard set (divide ratio
 | |
|  * is still shared with the standard set). */
 | |
| 
 | |
| /* The per-channel synth values for all standard VCO configurations. These get
 | |
|  * written to register 1. */
 | |
| static const u8 uw2453_std_synth[] = {
 | |
| 	RF_CHANNEL( 1) = 0x47,
 | |
| 	RF_CHANNEL( 2) = 0x47,
 | |
| 	RF_CHANNEL( 3) = 0x67,
 | |
| 	RF_CHANNEL( 4) = 0x67,
 | |
| 	RF_CHANNEL( 5) = 0x67,
 | |
| 	RF_CHANNEL( 6) = 0x67,
 | |
| 	RF_CHANNEL( 7) = 0x57,
 | |
| 	RF_CHANNEL( 8) = 0x57,
 | |
| 	RF_CHANNEL( 9) = 0x57,
 | |
| 	RF_CHANNEL(10) = 0x57,
 | |
| 	RF_CHANNEL(11) = 0x77,
 | |
| 	RF_CHANNEL(12) = 0x77,
 | |
| 	RF_CHANNEL(13) = 0x77,
 | |
| 	RF_CHANNEL(14) = 0x4f,
 | |
| };
 | |
| 
 | |
| /* This table stores the synthesizer fractional divide ratio for *all* VCO
 | |
|  * configurations (both standard and autocal). These get written to register 2.
 | |
|  */
 | |
| static const u16 uw2453_synth_divide[] = {
 | |
| 	RF_CHANNEL( 1) = 0x999,
 | |
| 	RF_CHANNEL( 2) = 0x99b,
 | |
| 	RF_CHANNEL( 3) = 0x998,
 | |
| 	RF_CHANNEL( 4) = 0x99a,
 | |
| 	RF_CHANNEL( 5) = 0x999,
 | |
| 	RF_CHANNEL( 6) = 0x99b,
 | |
| 	RF_CHANNEL( 7) = 0x998,
 | |
| 	RF_CHANNEL( 8) = 0x99a,
 | |
| 	RF_CHANNEL( 9) = 0x999,
 | |
| 	RF_CHANNEL(10) = 0x99b,
 | |
| 	RF_CHANNEL(11) = 0x998,
 | |
| 	RF_CHANNEL(12) = 0x99a,
 | |
| 	RF_CHANNEL(13) = 0x999,
 | |
| 	RF_CHANNEL(14) = 0xccc,
 | |
| };
 | |
| 
 | |
| /* Here is the data for all the standard VCO configurations. We shrink our
 | |
|  * table a little by observing that both channels in a consecutive pair share
 | |
|  * the same value. We also observe that the high 4 bits ([0:3] in the specs)
 | |
|  * are all 'Reserved' and are always set to 0x4 - we chop them off in the data
 | |
|  * below. */
 | |
| #define CHAN_TO_PAIRIDX(a) ((a - 1) / 2)
 | |
| #define RF_CHANPAIR(a,b) [CHAN_TO_PAIRIDX(a)]
 | |
| static const u16 uw2453_std_vco_cfg[][7] = {
 | |
| 	{ /* table 1 */
 | |
| 		RF_CHANPAIR( 1,  2) = 0x664d,
 | |
| 		RF_CHANPAIR( 3,  4) = 0x604d,
 | |
| 		RF_CHANPAIR( 5,  6) = 0x6675,
 | |
| 		RF_CHANPAIR( 7,  8) = 0x6475,
 | |
| 		RF_CHANPAIR( 9, 10) = 0x6655,
 | |
| 		RF_CHANPAIR(11, 12) = 0x6455,
 | |
| 		RF_CHANPAIR(13, 14) = 0x6665,
 | |
| 	},
 | |
| 	{ /* table 2 */
 | |
| 		RF_CHANPAIR( 1,  2) = 0x666d,
 | |
| 		RF_CHANPAIR( 3,  4) = 0x606d,
 | |
| 		RF_CHANPAIR( 5,  6) = 0x664d,
 | |
| 		RF_CHANPAIR( 7,  8) = 0x644d,
 | |
| 		RF_CHANPAIR( 9, 10) = 0x6675,
 | |
| 		RF_CHANPAIR(11, 12) = 0x6475,
 | |
| 		RF_CHANPAIR(13, 14) = 0x6655,
 | |
| 	},
 | |
| 	{ /* table 3 */
 | |
| 		RF_CHANPAIR( 1,  2) = 0x665d,
 | |
| 		RF_CHANPAIR( 3,  4) = 0x605d,
 | |
| 		RF_CHANPAIR( 5,  6) = 0x666d,
 | |
| 		RF_CHANPAIR( 7,  8) = 0x646d,
 | |
| 		RF_CHANPAIR( 9, 10) = 0x664d,
 | |
| 		RF_CHANPAIR(11, 12) = 0x644d,
 | |
| 		RF_CHANPAIR(13, 14) = 0x6675,
 | |
| 	},
 | |
| 	{ /* table 4 */
 | |
| 		RF_CHANPAIR( 1,  2) = 0x667d,
 | |
| 		RF_CHANPAIR( 3,  4) = 0x607d,
 | |
| 		RF_CHANPAIR( 5,  6) = 0x665d,
 | |
| 		RF_CHANPAIR( 7,  8) = 0x645d,
 | |
| 		RF_CHANPAIR( 9, 10) = 0x666d,
 | |
| 		RF_CHANPAIR(11, 12) = 0x646d,
 | |
| 		RF_CHANPAIR(13, 14) = 0x664d,
 | |
| 	},
 | |
| 	{ /* table 5 */
 | |
| 		RF_CHANPAIR( 1,  2) = 0x6643,
 | |
| 		RF_CHANPAIR( 3,  4) = 0x6043,
 | |
| 		RF_CHANPAIR( 5,  6) = 0x667d,
 | |
| 		RF_CHANPAIR( 7,  8) = 0x647d,
 | |
| 		RF_CHANPAIR( 9, 10) = 0x665d,
 | |
| 		RF_CHANPAIR(11, 12) = 0x645d,
 | |
| 		RF_CHANPAIR(13, 14) = 0x666d,
 | |
| 	},
 | |
| 	{ /* table 6 */
 | |
| 		RF_CHANPAIR( 1,  2) = 0x6663,
 | |
| 		RF_CHANPAIR( 3,  4) = 0x6063,
 | |
| 		RF_CHANPAIR( 5,  6) = 0x6643,
 | |
| 		RF_CHANPAIR( 7,  8) = 0x6443,
 | |
| 		RF_CHANPAIR( 9, 10) = 0x667d,
 | |
| 		RF_CHANPAIR(11, 12) = 0x647d,
 | |
| 		RF_CHANPAIR(13, 14) = 0x665d,
 | |
| 	},
 | |
| 	{ /* table 7 */
 | |
| 		RF_CHANPAIR( 1,  2) = 0x6653,
 | |
| 		RF_CHANPAIR( 3,  4) = 0x6053,
 | |
| 		RF_CHANPAIR( 5,  6) = 0x6663,
 | |
| 		RF_CHANPAIR( 7,  8) = 0x6463,
 | |
| 		RF_CHANPAIR( 9, 10) = 0x6643,
 | |
| 		RF_CHANPAIR(11, 12) = 0x6443,
 | |
| 		RF_CHANPAIR(13, 14) = 0x667d,
 | |
| 	},
 | |
| 	{ /* table 8 */
 | |
| 		RF_CHANPAIR( 1,  2) = 0x6673,
 | |
| 		RF_CHANPAIR( 3,  4) = 0x6073,
 | |
| 		RF_CHANPAIR( 5,  6) = 0x6653,
 | |
| 		RF_CHANPAIR( 7,  8) = 0x6453,
 | |
| 		RF_CHANPAIR( 9, 10) = 0x6663,
 | |
| 		RF_CHANPAIR(11, 12) = 0x6463,
 | |
| 		RF_CHANPAIR(13, 14) = 0x6643,
 | |
| 	},
 | |
| 	{ /* table 9 */
 | |
| 		RF_CHANPAIR( 1,  2) = 0x664b,
 | |
| 		RF_CHANPAIR( 3,  4) = 0x604b,
 | |
| 		RF_CHANPAIR( 5,  6) = 0x6673,
 | |
| 		RF_CHANPAIR( 7,  8) = 0x6473,
 | |
| 		RF_CHANPAIR( 9, 10) = 0x6653,
 | |
| 		RF_CHANPAIR(11, 12) = 0x6453,
 | |
| 		RF_CHANPAIR(13, 14) = 0x6663,
 | |
| 	},
 | |
| 	{ /* table 10 */
 | |
| 		RF_CHANPAIR( 1,  2) = 0x666b,
 | |
| 		RF_CHANPAIR( 3,  4) = 0x606b,
 | |
| 		RF_CHANPAIR( 5,  6) = 0x664b,
 | |
| 		RF_CHANPAIR( 7,  8) = 0x644b,
 | |
| 		RF_CHANPAIR( 9, 10) = 0x6673,
 | |
| 		RF_CHANPAIR(11, 12) = 0x6473,
 | |
| 		RF_CHANPAIR(13, 14) = 0x6653,
 | |
| 	},
 | |
| 	{ /* table 11 */
 | |
| 		RF_CHANPAIR( 1,  2) = 0x665b,
 | |
| 		RF_CHANPAIR( 3,  4) = 0x605b,
 | |
| 		RF_CHANPAIR( 5,  6) = 0x666b,
 | |
| 		RF_CHANPAIR( 7,  8) = 0x646b,
 | |
| 		RF_CHANPAIR( 9, 10) = 0x664b,
 | |
| 		RF_CHANPAIR(11, 12) = 0x644b,
 | |
| 		RF_CHANPAIR(13, 14) = 0x6673,
 | |
| 	},
 | |
| 
 | |
| };
 | |
| 
 | |
| /* The per-channel synth values for autocal. These get written to register 1. */
 | |
| static const u16 uw2453_autocal_synth[] = {
 | |
| 	RF_CHANNEL( 1) = 0x6847,
 | |
| 	RF_CHANNEL( 2) = 0x6847,
 | |
| 	RF_CHANNEL( 3) = 0x6867,
 | |
| 	RF_CHANNEL( 4) = 0x6867,
 | |
| 	RF_CHANNEL( 5) = 0x6867,
 | |
| 	RF_CHANNEL( 6) = 0x6867,
 | |
| 	RF_CHANNEL( 7) = 0x6857,
 | |
| 	RF_CHANNEL( 8) = 0x6857,
 | |
| 	RF_CHANNEL( 9) = 0x6857,
 | |
| 	RF_CHANNEL(10) = 0x6857,
 | |
| 	RF_CHANNEL(11) = 0x6877,
 | |
| 	RF_CHANNEL(12) = 0x6877,
 | |
| 	RF_CHANNEL(13) = 0x6877,
 | |
| 	RF_CHANNEL(14) = 0x684f,
 | |
| };
 | |
| 
 | |
| /* The VCO configuration for autocal (all channels) */
 | |
| static const u16 UW2453_AUTOCAL_VCO_CFG = 0x6662;
 | |
| 
 | |
| /* TX gain settings. The array index corresponds to the TX power integration
 | |
|  * values found in the EEPROM. The values get written to register 7. */
 | |
| static u32 uw2453_txgain[] = {
 | |
| 	[0x00] = 0x0e313,
 | |
| 	[0x01] = 0x0fb13,
 | |
| 	[0x02] = 0x0e093,
 | |
| 	[0x03] = 0x0f893,
 | |
| 	[0x04] = 0x0ea93,
 | |
| 	[0x05] = 0x1f093,
 | |
| 	[0x06] = 0x1f493,
 | |
| 	[0x07] = 0x1f693,
 | |
| 	[0x08] = 0x1f393,
 | |
| 	[0x09] = 0x1f35b,
 | |
| 	[0x0a] = 0x1e6db,
 | |
| 	[0x0b] = 0x1ff3f,
 | |
| 	[0x0c] = 0x1ffff,
 | |
| 	[0x0d] = 0x361d7,
 | |
| 	[0x0e] = 0x37fbf,
 | |
| 	[0x0f] = 0x3ff8b,
 | |
| 	[0x10] = 0x3ff33,
 | |
| 	[0x11] = 0x3fb3f,
 | |
| 	[0x12] = 0x3ffff,
 | |
| };
 | |
| 
 | |
| /* RF-specific structure */
 | |
| struct uw2453_priv {
 | |
| 	/* index into synth/VCO config tables where PLL lock was found
 | |
| 	 * -1 means autocal */
 | |
| 	int config;
 | |
| };
 | |
| 
 | |
| #define UW2453_PRIV(rf) ((struct uw2453_priv *) (rf)->priv)
 | |
| 
 | |
| static int uw2453_synth_set_channel(struct zd_chip *chip, int channel,
 | |
| 	bool autocal)
 | |
| {
 | |
| 	int r;
 | |
| 	int idx = channel - 1;
 | |
| 	u32 val;
 | |
| 
 | |
| 	if (autocal)
 | |
| 		val = UW2453_REGWRITE(1, uw2453_autocal_synth[idx]);
 | |
| 	else
 | |
| 		val = UW2453_REGWRITE(1, uw2453_std_synth[idx]);
 | |
| 
 | |
| 	r = zd_rfwrite_locked(chip, val, RF_RV_BITS);
 | |
| 	if (r)
 | |
| 		return r;
 | |
| 
 | |
| 	return zd_rfwrite_locked(chip,
 | |
| 		UW2453_REGWRITE(2, uw2453_synth_divide[idx]), RF_RV_BITS);
 | |
| }
 | |
| 
 | |
| static int uw2453_write_vco_cfg(struct zd_chip *chip, u16 value)
 | |
| {
 | |
| 	/* vendor driver always sets these upper bits even though the specs say
 | |
| 	 * they are reserved */
 | |
| 	u32 val = 0x40000 | value;
 | |
| 	return zd_rfwrite_locked(chip, UW2453_REGWRITE(3, val), RF_RV_BITS);
 | |
| }
 | |
| 
 | |
| static int uw2453_init_mode(struct zd_chip *chip)
 | |
| {
 | |
| 	static const u32 rv[] = {
 | |
| 		UW2453_REGWRITE(0, 0x25f98), /* enter IDLE mode */
 | |
| 		UW2453_REGWRITE(0, 0x25f9a), /* enter CAL_VCO mode */
 | |
| 		UW2453_REGWRITE(0, 0x25f94), /* enter RX/TX mode */
 | |
| 		UW2453_REGWRITE(0, 0x27fd4), /* power down RSSI circuit */
 | |
| 	};
 | |
| 
 | |
| 	return zd_rfwritev_locked(chip, rv, ARRAY_SIZE(rv), RF_RV_BITS);
 | |
| }
 | |
| 
 | |
| static int uw2453_set_tx_gain_level(struct zd_chip *chip, int channel)
 | |
| {
 | |
| 	u8 int_value = chip->pwr_int_values[channel - 1];
 | |
| 
 | |
| 	if (int_value >= ARRAY_SIZE(uw2453_txgain)) {
 | |
| 		dev_dbg_f(zd_chip_dev(chip), "can't configure TX gain for "
 | |
| 			  "int value %x on channel %d\n", int_value, channel);
 | |
| 		return 0;
 | |
| 	}
 | |
| 
 | |
| 	return zd_rfwrite_locked(chip,
 | |
| 		UW2453_REGWRITE(7, uw2453_txgain[int_value]), RF_RV_BITS);
 | |
| }
 | |
| 
 | |
| static int uw2453_init_hw(struct zd_rf *rf)
 | |
| {
 | |
| 	int i, r;
 | |
| 	int found_config = -1;
 | |
| 	u16 intr_status;
 | |
| 	struct zd_chip *chip = zd_rf_to_chip(rf);
 | |
| 
 | |
| 	static const struct zd_ioreq16 ioreqs[] = {
 | |
| 		{ CR10,  0x89 }, { CR15,  0x20 },
 | |
| 		{ CR17,  0x28 }, /* 6112 no change */
 | |
| 		{ CR23,  0x38 }, { CR24,  0x20 }, { CR26,  0x93 },
 | |
| 		{ CR27,  0x15 }, { CR28,  0x3e }, { CR29,  0x00 },
 | |
| 		{ CR33,  0x28 }, { CR34,  0x30 },
 | |
| 		{ CR35,  0x43 }, /* 6112 3e->43 */
 | |
| 		{ CR41,  0x24 }, { CR44,  0x32 },
 | |
| 		{ CR46,  0x92 }, /* 6112 96->92 */
 | |
| 		{ CR47,  0x1e },
 | |
| 		{ CR48,  0x04 }, /* 5602 Roger */
 | |
| 		{ CR49,  0xfa }, { CR79,  0x58 }, { CR80,  0x30 },
 | |
| 		{ CR81,  0x30 }, { CR87,  0x0a }, { CR89,  0x04 },
 | |
| 		{ CR91,  0x00 }, { CR92,  0x0a }, { CR98,  0x8d },
 | |
| 		{ CR99,  0x28 }, { CR100, 0x02 },
 | |
| 		{ CR101, 0x09 }, /* 6112 13->1f 6220 1f->13 6407 13->9 */
 | |
| 		{ CR102, 0x27 },
 | |
| 		{ CR106, 0x1c }, /* 5d07 5112 1f->1c 6220 1c->1f 6221 1f->1c */
 | |
| 		{ CR107, 0x1c }, /* 6220 1c->1a 5221 1a->1c */
 | |
| 		{ CR109, 0x13 },
 | |
| 		{ CR110, 0x1f }, /* 6112 13->1f 6221 1f->13 6407 13->0x09 */
 | |
| 		{ CR111, 0x13 }, { CR112, 0x1f }, { CR113, 0x27 },
 | |
| 		{ CR114, 0x23 }, /* 6221 27->23 */
 | |
| 		{ CR115, 0x24 }, /* 6112 24->1c 6220 1c->24 */
 | |
| 		{ CR116, 0x24 }, /* 6220 1c->24 */
 | |
| 		{ CR117, 0xfa }, /* 6112 fa->f8 6220 f8->f4 6220 f4->fa */
 | |
| 		{ CR118, 0xf0 }, /* 5d07 6112 f0->f2 6220 f2->f0 */
 | |
| 		{ CR119, 0x1a }, /* 6112 1a->10 6220 10->14 6220 14->1a */
 | |
| 		{ CR120, 0x4f },
 | |
| 		{ CR121, 0x1f }, /* 6220 4f->1f */
 | |
| 		{ CR122, 0xf0 }, { CR123, 0x57 }, { CR125, 0xad },
 | |
| 		{ CR126, 0x6c }, { CR127, 0x03 },
 | |
| 		{ CR128, 0x14 }, /* 6302 12->11 */
 | |
| 		{ CR129, 0x12 }, /* 6301 10->0f */
 | |
| 		{ CR130, 0x10 }, { CR137, 0x50 }, { CR138, 0xa8 },
 | |
| 		{ CR144, 0xac }, { CR146, 0x20 }, { CR252, 0xff },
 | |
| 		{ CR253, 0xff },
 | |
| 	};
 | |
| 
 | |
| 	static const u32 rv[] = {
 | |
| 		UW2453_REGWRITE(4, 0x2b),    /* configure reciever gain */
 | |
| 		UW2453_REGWRITE(5, 0x19e4f), /* configure transmitter gain */
 | |
| 		UW2453_REGWRITE(6, 0xf81ad), /* enable RX/TX filter tuning */
 | |
| 		UW2453_REGWRITE(7, 0x3fffe), /* disable TX gain in test mode */
 | |
| 
 | |
| 		/* enter CAL_FIL mode, TX gain set by registers, RX gain set by pins,
 | |
| 		 * RSSI circuit powered down, reduced RSSI range */
 | |
| 		UW2453_REGWRITE(0, 0x25f9c), /* 5d01 cal_fil */
 | |
| 
 | |
| 		/* synthesizer configuration for channel 1 */
 | |
| 		UW2453_REGWRITE(1, 0x47),
 | |
| 		UW2453_REGWRITE(2, 0x999),
 | |
| 
 | |
| 		/* disable manual VCO band selection */
 | |
| 		UW2453_REGWRITE(3, 0x7602),
 | |
| 
 | |
| 		/* enable manual VCO band selection, configure current level */
 | |
| 		UW2453_REGWRITE(3, 0x46063),
 | |
| 	};
 | |
| 
 | |
| 	r = zd_iowrite16a_locked(chip, ioreqs, ARRAY_SIZE(ioreqs));
 | |
| 	if (r)
 | |
| 		return r;
 | |
| 
 | |
| 	r = zd_rfwritev_locked(chip, rv, ARRAY_SIZE(rv), RF_RV_BITS);
 | |
| 	if (r)
 | |
| 		return r;
 | |
| 
 | |
| 	r = uw2453_init_mode(chip);
 | |
| 	if (r)
 | |
| 		return r;
 | |
| 
 | |
| 	/* Try all standard VCO configuration settings on channel 1 */
 | |
| 	for (i = 0; i < ARRAY_SIZE(uw2453_std_vco_cfg) - 1; i++) {
 | |
| 		/* Configure synthesizer for channel 1 */
 | |
| 		r = uw2453_synth_set_channel(chip, 1, false);
 | |
| 		if (r)
 | |
| 			return r;
 | |
| 
 | |
| 		/* Write VCO config */
 | |
| 		r = uw2453_write_vco_cfg(chip, uw2453_std_vco_cfg[i][0]);
 | |
| 		if (r)
 | |
| 			return r;
 | |
| 
 | |
| 		/* ack interrupt event */
 | |
| 		r = zd_iowrite16_locked(chip, 0x0f, UW2453_INTR_REG);
 | |
| 		if (r)
 | |
| 			return r;
 | |
| 
 | |
| 		/* check interrupt status */
 | |
| 		r = zd_ioread16_locked(chip, &intr_status, UW2453_INTR_REG);
 | |
| 		if (r)
 | |
| 			return r;
 | |
| 
 | |
| 		if (!(intr_status & 0xf)) {
 | |
| 			dev_dbg_f(zd_chip_dev(chip),
 | |
| 				"PLL locked on configuration %d\n", i);
 | |
| 			found_config = i;
 | |
| 			break;
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	if (found_config == -1) {
 | |
| 		/* autocal */
 | |
| 		dev_dbg_f(zd_chip_dev(chip),
 | |
| 			"PLL did not lock, using autocal\n");
 | |
| 
 | |
| 		r = uw2453_synth_set_channel(chip, 1, true);
 | |
| 		if (r)
 | |
| 			return r;
 | |
| 
 | |
| 		r = uw2453_write_vco_cfg(chip, UW2453_AUTOCAL_VCO_CFG);
 | |
| 		if (r)
 | |
| 			return r;
 | |
| 	}
 | |
| 
 | |
| 	/* To match the vendor driver behaviour, we use the configuration after
 | |
| 	 * the one that produced a lock. */
 | |
| 	UW2453_PRIV(rf)->config = found_config + 1;
 | |
| 
 | |
| 	return zd_iowrite16_locked(chip, 0x06, CR203);
 | |
| }
 | |
| 
 | |
| static int uw2453_set_channel(struct zd_rf *rf, u8 channel)
 | |
| {
 | |
| 	int r;
 | |
| 	u16 vco_cfg;
 | |
| 	int config = UW2453_PRIV(rf)->config;
 | |
| 	bool autocal = (config == -1);
 | |
| 	struct zd_chip *chip = zd_rf_to_chip(rf);
 | |
| 
 | |
| 	static const struct zd_ioreq16 ioreqs[] = {
 | |
| 		{ CR80,  0x30 }, { CR81,  0x30 }, { CR79,  0x58 },
 | |
| 		{ CR12,  0xf0 }, { CR77,  0x1b }, { CR78,  0x58 },
 | |
| 	};
 | |
| 
 | |
| 	r = uw2453_synth_set_channel(chip, channel, autocal);
 | |
| 	if (r)
 | |
| 		return r;
 | |
| 
 | |
| 	if (autocal)
 | |
| 		vco_cfg = UW2453_AUTOCAL_VCO_CFG;
 | |
| 	else
 | |
| 		vco_cfg = uw2453_std_vco_cfg[config][CHAN_TO_PAIRIDX(channel)];
 | |
| 
 | |
| 	r = uw2453_write_vco_cfg(chip, vco_cfg);
 | |
| 	if (r)
 | |
| 		return r;
 | |
| 
 | |
| 	r = uw2453_init_mode(chip);
 | |
| 	if (r)
 | |
| 		return r;
 | |
| 
 | |
| 	r = zd_iowrite16a_locked(chip, ioreqs, ARRAY_SIZE(ioreqs));
 | |
| 	if (r)
 | |
| 		return r;
 | |
| 
 | |
| 	r = uw2453_set_tx_gain_level(chip, channel);
 | |
| 	if (r)
 | |
| 		return r;
 | |
| 
 | |
| 	return zd_iowrite16_locked(chip, 0x06, CR203);
 | |
| }
 | |
| 
 | |
| static int uw2453_switch_radio_on(struct zd_rf *rf)
 | |
| {
 | |
| 	int r;
 | |
| 	struct zd_chip *chip = zd_rf_to_chip(rf);
 | |
| 	struct zd_ioreq16 ioreqs[] = {
 | |
| 		{ CR11,  0x00 }, { CR251, 0x3f },
 | |
| 	};
 | |
| 
 | |
| 	/* enter RXTX mode */
 | |
| 	r = zd_rfwrite_locked(chip, UW2453_REGWRITE(0, 0x25f94), RF_RV_BITS);
 | |
| 	if (r)
 | |
| 		return r;
 | |
| 
 | |
| 	if (zd_chip_is_zd1211b(chip))
 | |
| 		ioreqs[1].value = 0x7f;
 | |
| 
 | |
| 	return zd_iowrite16a_locked(chip, ioreqs, ARRAY_SIZE(ioreqs));
 | |
| }
 | |
| 
 | |
| static int uw2453_switch_radio_off(struct zd_rf *rf)
 | |
| {
 | |
| 	int r;
 | |
| 	struct zd_chip *chip = zd_rf_to_chip(rf);
 | |
| 	static const struct zd_ioreq16 ioreqs[] = {
 | |
| 		{ CR11,  0x04 }, { CR251, 0x2f },
 | |
| 	};
 | |
| 
 | |
| 	/* enter IDLE mode */
 | |
| 	/* FIXME: shouldn't we go to SLEEP? sent email to zydas */
 | |
| 	r = zd_rfwrite_locked(chip, UW2453_REGWRITE(0, 0x25f90), RF_RV_BITS);
 | |
| 	if (r)
 | |
| 		return r;
 | |
| 
 | |
| 	return zd_iowrite16a_locked(chip, ioreqs, ARRAY_SIZE(ioreqs));
 | |
| }
 | |
| 
 | |
| static void uw2453_clear(struct zd_rf *rf)
 | |
| {
 | |
| 	kfree(rf->priv);
 | |
| }
 | |
| 
 | |
| int zd_rf_init_uw2453(struct zd_rf *rf)
 | |
| {
 | |
| 	rf->init_hw = uw2453_init_hw;
 | |
| 	rf->set_channel = uw2453_set_channel;
 | |
| 	rf->switch_radio_on = uw2453_switch_radio_on;
 | |
| 	rf->switch_radio_off = uw2453_switch_radio_off;
 | |
| 	rf->patch_6m_band_edge = zd_rf_generic_patch_6m;
 | |
| 	rf->clear = uw2453_clear;
 | |
| 	/* we have our own TX integration code */
 | |
| 	rf->update_channel_int = 0;
 | |
| 
 | |
| 	rf->priv = kmalloc(sizeof(struct uw2453_priv), GFP_KERNEL);
 | |
| 	if (rf->priv == NULL)
 | |
| 		return -ENOMEM;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 |