1 | /* |
2 | * Copyright (c) 2002-2008 Sam Leffler, Errno Consulting |
3 | * Copyright (c) 2002-2008 Atheros Communications, Inc. |
4 | * |
5 | * Permission to use, copy, modify, and/or distribute this software for any |
6 | * purpose with or without fee is hereby granted, provided that the above |
7 | * copyright notice and this permission notice appear in all copies. |
8 | * |
9 | * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES |
10 | * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF |
11 | * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR |
12 | * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES |
13 | * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN |
14 | * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF |
15 | * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. |
16 | * |
17 | * $Id: ar5416_cal_iq.c,v 1.2 2011/03/07 11:25:44 cegger Exp $ |
18 | */ |
19 | #include "opt_ah.h" |
20 | |
21 | #include "ah.h" |
22 | #include "ah_internal.h" |
23 | #include "ah_devid.h" |
24 | |
25 | #include "ar5416/ar5416.h" |
26 | #include "ar5416/ar5416reg.h" |
27 | #include "ar5416/ar5416phy.h" |
28 | |
29 | /* IQ Cal aliases */ |
30 | #define totalPowerMeasI(i) caldata[0][i].u |
31 | #define totalPowerMeasQ(i) caldata[1][i].u |
32 | #define totalIqCorrMeas(i) caldata[2][i].s |
33 | |
34 | /* |
35 | * Collect data from HW to later perform IQ Mismatch Calibration |
36 | */ |
37 | void |
38 | ar5416IQCalCollect(struct ath_hal *ah) |
39 | { |
40 | struct ar5416PerCal *cal = &AH5416(ah)->ah_cal; |
41 | int i; |
42 | |
43 | /* |
44 | * Accumulate IQ cal measures for active chains |
45 | */ |
46 | for (i = 0; i < AR5416_MAX_CHAINS; i++) { |
47 | cal->totalPowerMeasI(i) += |
48 | OS_REG_READ(ah, AR_PHY_CAL_MEAS_0(i)); |
49 | cal->totalPowerMeasQ(i) += |
50 | OS_REG_READ(ah, AR_PHY_CAL_MEAS_1(i)); |
51 | cal->totalIqCorrMeas(i) += (int32_t) |
52 | OS_REG_READ(ah, AR_PHY_CAL_MEAS_2(i)); |
53 | HALDEBUG(ah, HAL_DEBUG_PERCAL, |
54 | "%d: Chn %d pmi=0x%08x;pmq=0x%08x;iqcm=0x%08x;\n" , |
55 | cal->calSamples, i, cal->totalPowerMeasI(i), |
56 | cal->totalPowerMeasQ(i), cal->totalIqCorrMeas(i)); |
57 | } |
58 | } |
59 | |
60 | /* |
61 | * Use HW data to do IQ Mismatch Calibration |
62 | */ |
63 | void |
64 | ar5416IQCalibration(struct ath_hal *ah, uint8_t numChains) |
65 | { |
66 | struct ar5416PerCal *cal = &AH5416(ah)->ah_cal; |
67 | int i; |
68 | |
69 | for (i = 0; i < numChains; i++) { |
70 | uint32_t powerMeasI = cal->totalPowerMeasI(i); |
71 | uint32_t powerMeasQ = cal->totalPowerMeasQ(i); |
72 | uint32_t iqCorrMeas = cal->totalIqCorrMeas(i); |
73 | uint32_t qCoffDenom, iCoffDenom; |
74 | int iqCorrNeg; |
75 | |
76 | HALDEBUG(ah, HAL_DEBUG_PERCAL, |
77 | "Start IQ Cal and Correction for Chain %d\n" , i); |
78 | HALDEBUG(ah, HAL_DEBUG_PERCAL, |
79 | "Orignal: iq_corr_meas = 0x%08x\n" , iqCorrMeas); |
80 | |
81 | iqCorrNeg = 0; |
82 | /* iqCorrMeas is always negative. */ |
83 | if (iqCorrMeas > 0x80000000) { |
84 | iqCorrMeas = (0xffffffff - iqCorrMeas) + 1; |
85 | iqCorrNeg = 1; |
86 | } |
87 | |
88 | HALDEBUG(ah, HAL_DEBUG_PERCAL, " pwr_meas_i = 0x%08x\n" , |
89 | powerMeasI); |
90 | HALDEBUG(ah, HAL_DEBUG_PERCAL, " pwr_meas_q = 0x%08x\n" , |
91 | powerMeasQ); |
92 | HALDEBUG(ah, HAL_DEBUG_PERCAL, " iqCorrNeg is 0x%08x\n" , |
93 | iqCorrNeg); |
94 | |
95 | iCoffDenom = (powerMeasI/2 + powerMeasQ/2)/ 128; |
96 | qCoffDenom = powerMeasQ / 64; |
97 | /* Protect against divide-by-0 */ |
98 | if (powerMeasQ != 0) { |
99 | /* IQ corr_meas is already negated if iqcorr_neg == 1 */ |
100 | int32_t iCoff = iqCorrMeas/iCoffDenom; |
101 | int32_t qCoff = powerMeasI/qCoffDenom - 64; |
102 | |
103 | HALDEBUG(ah, HAL_DEBUG_PERCAL, " iCoff = 0x%08x\n" , |
104 | iCoff); |
105 | HALDEBUG(ah, HAL_DEBUG_PERCAL, " qCoff = 0x%08x\n" , |
106 | qCoff); |
107 | |
108 | /* Negate iCoff if iqCorrNeg == 0 */ |
109 | iCoff = iCoff & 0x3f; |
110 | HALDEBUG(ah, HAL_DEBUG_PERCAL, |
111 | "New: iCoff = 0x%08x\n" , iCoff); |
112 | |
113 | if (iqCorrNeg == 0x0) |
114 | iCoff = 0x40 - iCoff; |
115 | if (qCoff > 15) |
116 | qCoff = 15; |
117 | else if (qCoff <= -16) |
118 | qCoff = -16; |
119 | HALDEBUG(ah, HAL_DEBUG_PERCAL, |
120 | " : iCoff = 0x%x qCoff = 0x%x\n" , iCoff, qCoff); |
121 | |
122 | OS_REG_RMW_FIELD(ah, AR_PHY_TIMING_CTRL4_CHAIN(i), |
123 | AR_PHY_TIMING_CTRL4_IQCORR_Q_I_COFF, iCoff); |
124 | OS_REG_RMW_FIELD(ah, AR_PHY_TIMING_CTRL4_CHAIN(i), |
125 | AR_PHY_TIMING_CTRL4_IQCORR_Q_Q_COFF, qCoff); |
126 | HALDEBUG(ah, HAL_DEBUG_PERCAL, |
127 | "IQ Cal and Correction done for Chain %d\n" , i); |
128 | } |
129 | } |
130 | OS_REG_SET_BIT(ah, AR_PHY_TIMING_CTRL4, |
131 | AR_PHY_TIMING_CTRL4_IQCORR_ENABLE); |
132 | } |
133 | |