#include <sys/types.h>
#include <sys/sysmacros.h>
#include "rtwreg.h"
#include "rtwvar.h"
#include "max2820reg.h"
#include "sa2400reg.h"
#include "rtwphyio.h"
#include "rtwphy.h"
static int rtw_max2820_pwrstate(struct rtw_rf *, enum rtw_pwrstate);
static int rtw_sa2400_pwrstate(struct rtw_rf *, enum rtw_pwrstate);
static int
rtw_rf_init(struct rtw_rf *rf, uint_t freq, uint8_t opaque_txpower,
enum rtw_pwrstate power)
{
return (*rf->rf_init)(rf, freq, opaque_txpower, power);
}
static int
rtw_rf_tune(struct rtw_rf *rf, uint_t freq)
{
return (*rf->rf_tune)(rf, freq);
}
static int
rtw_rf_txpower(struct rtw_rf *rf, uint8_t opaque_txpower)
{
return (*rf->rf_txpower)(rf, opaque_txpower);
}
static int
rtw_rfbus_write(struct rtw_rfbus *bus, enum rtw_rfchipid rfchipid, uint_t addr,
uint32_t val)
{
return (*bus->b_write)(bus->b_regs, rfchipid, addr, val);
}
static int
rtw_bbp_preinit(struct rtw_regs *regs, uint_t antatten0, int dflantb,
uint_t freq)
{
uint_t antatten = antatten0;
if (dflantb)
antatten |= RTW_BBP_ANTATTEN_DFLANTB;
if (freq == 2484)
antatten |= RTW_BBP_ANTATTEN_CHAN14;
return (rtw_bbp_write(regs, RTW_BBP_ANTATTEN, antatten));
}
static int
rtw_bbp_init(struct rtw_regs *regs, struct rtw_bbpset *bb, int antdiv,
int dflantb, uint8_t cs_threshold, uint_t freq)
{
int rc;
uint32_t sys2, sys3;
sys2 = bb->bb_sys2;
if (antdiv)
sys2 |= RTW_BBP_SYS2_ANTDIV;
sys3 = bb->bb_sys3 |
LSHIFT(cs_threshold, RTW_BBP_SYS3_CSTHRESH_MASK);
#define RTW_BBP_WRITE_OR_RETURN(reg, val) \
if ((rc = rtw_bbp_write(regs, reg, val)) != 0) \
return (rc);
RTW_BBP_WRITE_OR_RETURN(RTW_BBP_SYS1, bb->bb_sys1);
RTW_BBP_WRITE_OR_RETURN(RTW_BBP_TXAGC, bb->bb_txagc);
RTW_BBP_WRITE_OR_RETURN(RTW_BBP_LNADET, bb->bb_lnadet);
RTW_BBP_WRITE_OR_RETURN(RTW_BBP_IFAGCINI, bb->bb_ifagcini);
RTW_BBP_WRITE_OR_RETURN(RTW_BBP_IFAGCLIMIT, bb->bb_ifagclimit);
RTW_BBP_WRITE_OR_RETURN(RTW_BBP_IFAGCDET, bb->bb_ifagcdet);
if ((rc = rtw_bbp_preinit(regs, bb->bb_antatten, dflantb, freq)) != 0)
return (rc);
RTW_BBP_WRITE_OR_RETURN(RTW_BBP_TRL, bb->bb_trl);
RTW_BBP_WRITE_OR_RETURN(RTW_BBP_SYS2, sys2);
RTW_BBP_WRITE_OR_RETURN(RTW_BBP_SYS3, sys3);
RTW_BBP_WRITE_OR_RETURN(RTW_BBP_CHESTLIM, bb->bb_chestlim);
RTW_BBP_WRITE_OR_RETURN(RTW_BBP_CHSQLIM, bb->bb_chsqlim);
return (0);
}
static int
rtw_sa2400_txpower(struct rtw_rf *rf, uint8_t opaque_txpower)
{
struct rtw_sa2400 *sa = (struct rtw_sa2400 *)rf;
struct rtw_rfbus *bus = &sa->sa_bus;
return (rtw_rfbus_write(bus, RTW_RFCHIPID_PHILIPS, SA2400_TX,
opaque_txpower));
}
#ifdef _RTW_FUTURE_DEBUG_
static void
verify_syna(uint_t freq, uint32_t val)
{
uint32_t expected_val = ~val;
switch (freq) {
case 2412:
expected_val = 0x0000096c;
break;
case 2417:
expected_val = 0x00080970;
break;
case 2422:
expected_val = 0x00100974;
break;
case 2427:
expected_val = 0x00180978;
break;
case 2432:
expected_val = 0x00000980;
break;
case 2437:
expected_val = 0x00080984;
break;
case 2442:
expected_val = 0x00100988;
break;
case 2447:
expected_val = 0x0018098c;
break;
case 2452:
expected_val = 0x00000994;
break;
case 2457:
expected_val = 0x00080998;
break;
case 2462:
expected_val = 0x0010099c;
break;
case 2467:
expected_val = 0x001809a0;
break;
case 2472:
expected_val = 0x000009a8;
break;
case 2484:
expected_val = 0x000009b4;
break;
}
}
#endif
static int
rtw_sa2400_tune(struct rtw_rf *rf, uint_t freq)
{
struct rtw_sa2400 *sa = (struct rtw_sa2400 *)rf;
struct rtw_rfbus *bus = &sa->sa_bus;
int rc;
uint32_t syna, synb, sync;
int n = freq / 4, nf = (freq % 4) * 2;
syna = LSHIFT(nf, SA2400_SYNA_NF_MASK) | LSHIFT(n, SA2400_SYNA_N_MASK);
synb = LSHIFT(11, SA2400_SYNB_R_MASK) | SA2400_SYNB_L_NORMAL |
SA2400_SYNB_ON | SA2400_SYNB_ONE |
LSHIFT(80, SA2400_SYNB_FC_MASK);
sync = SA2400_SYNC_CP_NORMAL;
if ((rc = rtw_rfbus_write(bus, RTW_RFCHIPID_PHILIPS, SA2400_SYNA,
syna)) != 0)
return (rc);
if ((rc = rtw_rfbus_write(bus, RTW_RFCHIPID_PHILIPS, SA2400_SYNB,
synb)) != 0)
return (rc);
if ((rc = rtw_rfbus_write(bus, RTW_RFCHIPID_PHILIPS, SA2400_SYNC,
sync)) != 0)
return (rc);
return (rtw_rfbus_write(bus, RTW_RFCHIPID_PHILIPS, SA2400_SYND, 0x0));
}
static int
rtw_sa2400_pwrstate(struct rtw_rf *rf, enum rtw_pwrstate power)
{
struct rtw_sa2400 *sa = (struct rtw_sa2400 *)rf;
struct rtw_rfbus *bus = &sa->sa_bus;
uint32_t opmode;
opmode = SA2400_OPMODE_DEFAULTS;
switch (power) {
case RTW_ON:
opmode |= SA2400_OPMODE_MODE_TXRX;
break;
case RTW_SLEEP:
opmode |= SA2400_OPMODE_MODE_WAIT;
break;
case RTW_OFF:
opmode |= SA2400_OPMODE_MODE_SLEEP;
break;
}
if (sa->sa_digphy)
opmode |= SA2400_OPMODE_DIGIN;
return (rtw_rfbus_write(bus, RTW_RFCHIPID_PHILIPS, SA2400_OPMODE,
opmode));
}
static int
rtw_sa2400_manrx_init(struct rtw_sa2400 *sa)
{
uint32_t manrx;
manrx = SA2400_MANRX_AHSN;
manrx |= SA2400_MANRX_TEN;
manrx |= LSHIFT(1023, SA2400_MANRX_RXGAIN_MASK);
return (rtw_rfbus_write(&sa->sa_bus, RTW_RFCHIPID_PHILIPS, SA2400_MANRX,
manrx));
}
static int
rtw_sa2400_vcocal_start(struct rtw_sa2400 *sa, int start)
{
uint32_t opmode;
opmode = SA2400_OPMODE_DEFAULTS;
if (start)
opmode |= SA2400_OPMODE_MODE_VCOCALIB;
else
opmode |= SA2400_OPMODE_MODE_SLEEP;
if (sa->sa_digphy)
opmode |= SA2400_OPMODE_DIGIN;
return (rtw_rfbus_write(&sa->sa_bus, RTW_RFCHIPID_PHILIPS,
SA2400_OPMODE, opmode));
}
static int
rtw_sa2400_vco_calibration(struct rtw_sa2400 *sa)
{
int rc;
if ((rc = rtw_sa2400_vcocal_start(sa, 1)) != 0)
return (rc);
DELAY(2200);
return (rtw_sa2400_vcocal_start(sa, 0));
}
static int
rtw_sa2400_filter_calibration(struct rtw_sa2400 *sa)
{
uint32_t opmode;
opmode = SA2400_OPMODE_DEFAULTS | SA2400_OPMODE_MODE_FCALIB;
if (sa->sa_digphy)
opmode |= SA2400_OPMODE_DIGIN;
return (rtw_rfbus_write(&sa->sa_bus, RTW_RFCHIPID_PHILIPS,
SA2400_OPMODE, opmode));
}
static int
rtw_sa2400_dc_calibration(struct rtw_sa2400 *sa)
{
struct rtw_rf *rf = &sa->sa_rf;
int rc;
uint32_t dccal;
(*rf->rf_continuous_tx_cb)(rf->rf_continuous_tx_arg, 1);
dccal = SA2400_OPMODE_DEFAULTS | SA2400_OPMODE_MODE_TXRX;
rc = rtw_rfbus_write(&sa->sa_bus, RTW_RFCHIPID_PHILIPS, SA2400_OPMODE,
dccal);
if (rc != 0)
return (rc);
DELAY(5);
dccal &= ~SA2400_OPMODE_MODE_MASK;
dccal |= SA2400_OPMODE_MODE_DCALIB;
rc = rtw_rfbus_write(&sa->sa_bus, RTW_RFCHIPID_PHILIPS, SA2400_OPMODE,
dccal);
if (rc != 0)
return (rc);
DELAY(20);
(*rf->rf_continuous_tx_cb)(rf->rf_continuous_tx_arg, 0);
return (0);
}
static int
rtw_sa2400_agc_init(struct rtw_sa2400 *sa)
{
uint32_t agc;
agc = LSHIFT(25, SA2400_AGC_MAXGAIN_MASK);
agc |= LSHIFT(7, SA2400_AGC_BBPDELAY_MASK);
agc |= LSHIFT(15, SA2400_AGC_LNADELAY_MASK);
agc |= LSHIFT(27, SA2400_AGC_RXONDELAY_MASK);
return (rtw_rfbus_write(&sa->sa_bus, RTW_RFCHIPID_PHILIPS, SA2400_AGC,
agc));
}
static void
rtw_sa2400_destroy(struct rtw_rf *rf)
{
struct rtw_sa2400 *sa = (struct rtw_sa2400 *)rf;
kmem_free(sa, sizeof (*sa));
}
static int
rtw_sa2400_calibrate(struct rtw_rf *rf, uint_t freq)
{
struct rtw_sa2400 *sa = (struct rtw_sa2400 *)rf;
int i, rc;
for (i = 0; i < 2; i++) {
if ((rc = rtw_sa2400_vco_calibration(sa)) != 0)
return (rc);
}
if ((rc = rtw_sa2400_tune(rf, freq)) != 0)
return (rc);
if ((rc = rtw_sa2400_filter_calibration(sa)) != 0)
return (rc);
if (!sa->sa_digphy)
return (rtw_sa2400_dc_calibration(sa));
return (0);
}
static int
rtw_sa2400_init(struct rtw_rf *rf, uint_t freq, uint8_t opaque_txpower,
enum rtw_pwrstate power)
{
struct rtw_sa2400 *sa = (struct rtw_sa2400 *)rf;
int rc;
if ((rc = rtw_sa2400_txpower(rf, opaque_txpower)) != 0)
return (rc);
if (power == RTW_SLEEP || power == RTW_OFF)
return (rtw_sa2400_pwrstate(rf, power));
if ((rc = rtw_sa2400_pwrstate(rf, RTW_SLEEP)) != 0)
return (rc);
if ((rc = rtw_sa2400_tune(rf, freq)) != 0)
return (rc);
if ((rc = rtw_sa2400_agc_init(sa)) != 0)
return (rc);
if ((rc = rtw_sa2400_manrx_init(sa)) != 0)
return (rc);
if ((rc = rtw_sa2400_calibrate(rf, freq)) != 0)
return (rc);
return (rtw_sa2400_pwrstate(rf, power));
}
struct rtw_rf *
rtw_sa2400_create(struct rtw_regs *regs, rtw_rf_write_t rf_write, int digphy)
{
struct rtw_sa2400 *sa;
struct rtw_rfbus *bus;
struct rtw_rf *rf;
struct rtw_bbpset *bb;
sa = (struct rtw_sa2400 *)kmem_zalloc(sizeof (*sa), KM_SLEEP);
if (sa == NULL)
return (NULL);
sa->sa_digphy = digphy;
rf = &sa->sa_rf;
bus = &sa->sa_bus;
rf->rf_init = rtw_sa2400_init;
rf->rf_destroy = rtw_sa2400_destroy;
rf->rf_txpower = rtw_sa2400_txpower;
rf->rf_tune = rtw_sa2400_tune;
rf->rf_pwrstate = rtw_sa2400_pwrstate;
bb = &rf->rf_bbpset;
bb->bb_antatten = RTW_BBP_ANTATTEN_PHILIPS_MAGIC;
bb->bb_chestlim = 0x00;
bb->bb_chsqlim = 0xa0;
bb->bb_ifagcdet = 0x64;
bb->bb_ifagcini = 0x90;
bb->bb_ifagclimit = 0x1a;
bb->bb_lnadet = 0xe0;
bb->bb_sys1 = 0x98;
bb->bb_sys2 = 0x47;
bb->bb_sys3 = 0x90;
bb->bb_trl = 0x88;
bb->bb_txagc = 0x38;
bus->b_regs = regs;
bus->b_write = rf_write;
return (&sa->sa_rf);
}
static int
rtw_max2820_tune(struct rtw_rf *rf, uint_t freq)
{
struct rtw_max2820 *mx = (struct rtw_max2820 *)rf;
struct rtw_rfbus *bus = &mx->mx_bus;
if (freq < 2400 || freq > 2499)
return (-1);
return (rtw_rfbus_write(bus, RTW_RFCHIPID_MAXIM, MAX2820_CHANNEL,
LSHIFT(freq - 2400, MAX2820_CHANNEL_CF_MASK)));
}
static void
rtw_max2820_destroy(struct rtw_rf *rf)
{
struct rtw_max2820 *mx = (struct rtw_max2820 *)rf;
kmem_free(mx, sizeof (*mx));
}
static int
rtw_max2820_init(struct rtw_rf *rf, uint_t freq, uint8_t opaque_txpower,
enum rtw_pwrstate power)
{
struct rtw_max2820 *mx = (struct rtw_max2820 *)rf;
struct rtw_rfbus *bus = &mx->mx_bus;
int rc;
if ((rc = rtw_rfbus_write(bus, RTW_RFCHIPID_MAXIM, MAX2820_TEST,
MAX2820_TEST_DEFAULT)) != 0)
return (rc);
if ((rc = rtw_rfbus_write(bus, RTW_RFCHIPID_MAXIM, MAX2820_ENABLE,
MAX2820_ENABLE_DEFAULT)) != 0)
return (rc);
if ((rc = rtw_max2820_pwrstate(rf, power)) != 0)
return (rc);
else if (power == RTW_OFF || power == RTW_SLEEP)
return (0);
if ((rc = rtw_rfbus_write(bus, RTW_RFCHIPID_MAXIM, MAX2820_SYNTH,
MAX2820_SYNTH_R_44MHZ)) != 0)
return (rc);
if ((rc = rtw_max2820_tune(rf, freq)) != 0)
return (rc);
if ((rc = rtw_rfbus_write(bus, RTW_RFCHIPID_MAXIM, MAX2820_RECEIVE,
MAX2820_RECEIVE_DL_DEFAULT |
LSHIFT(4, MAX2820A_RECEIVE_1C_MASK) |
LSHIFT(1, MAX2820A_RECEIVE_2C_MASK))) != 0)
return (rc);
return (rtw_rfbus_write(bus, RTW_RFCHIPID_MAXIM, MAX2820_TRANSMIT,
MAX2820_TRANSMIT_PA_DEFAULT));
}
static int
rtw_max2820_txpower(struct rtw_rf *rf, uint8_t opaque_txpower)
{
return (0);
}
static int
rtw_max2820_pwrstate(struct rtw_rf *rf, enum rtw_pwrstate power)
{
uint32_t enable;
struct rtw_max2820 *mx;
struct rtw_rfbus *bus;
mx = (struct rtw_max2820 *)rf;
bus = &mx->mx_bus;
switch (power) {
case RTW_OFF:
case RTW_SLEEP:
default:
enable = 0x0;
break;
case RTW_ON:
enable = MAX2820_ENABLE_DEFAULT;
break;
}
return (rtw_rfbus_write(bus, RTW_RFCHIPID_MAXIM,
MAX2820_ENABLE, enable));
}
struct rtw_rf *
rtw_max2820_create(struct rtw_regs *regs, rtw_rf_write_t rf_write, int is_a)
{
struct rtw_max2820 *mx;
struct rtw_rfbus *bus;
struct rtw_rf *rf;
struct rtw_bbpset *bb;
mx = (struct rtw_max2820 *)kmem_zalloc(sizeof (*mx), KM_SLEEP);
if (mx == NULL)
return (NULL);
mx->mx_is_a = is_a;
rf = &mx->mx_rf;
bus = &mx->mx_bus;
rf->rf_init = rtw_max2820_init;
rf->rf_destroy = rtw_max2820_destroy;
rf->rf_txpower = rtw_max2820_txpower;
rf->rf_tune = rtw_max2820_tune;
rf->rf_pwrstate = rtw_max2820_pwrstate;
bb = &rf->rf_bbpset;
bb->bb_antatten = RTW_BBP_ANTATTEN_MAXIM_MAGIC;
bb->bb_chestlim = 0;
bb->bb_chsqlim = 159;
bb->bb_ifagcdet = 100;
bb->bb_ifagcini = 144;
bb->bb_ifagclimit = 26;
bb->bb_lnadet = 248;
bb->bb_sys1 = 136;
bb->bb_sys2 = 71;
bb->bb_sys3 = 155;
bb->bb_trl = 136;
bb->bb_txagc = 8;
bus->b_regs = regs;
bus->b_write = rf_write;
return (&mx->mx_rf);
}
int
rtw_phy_init(struct rtw_regs *regs, struct rtw_rf *rf, uint8_t opaque_txpower,
uint8_t cs_threshold, uint_t freq, int antdiv, int dflantb,
enum rtw_pwrstate power)
{
int rc;
if ((rc = rtw_rf_txpower(rf, opaque_txpower)) != 0)
return (rc);
if ((rc = rtw_bbp_preinit(regs, rf->rf_bbpset.bb_antatten, dflantb,
freq)) != 0)
return (rc);
if ((rc = rtw_rf_tune(rf, freq)) != 0)
return (rc);
if ((rc = rtw_rf_init(rf, freq, opaque_txpower, power)) != 0)
return (rc);
#ifdef _RTW_FUTURE_DEBUG_
if ((rc = rtw_rf_txpower(rf, opaque_txpower)) != 0)
return (rc);
#endif
return (rtw_bbp_init(regs, &rf->rf_bbpset, antdiv, dflantb,
cs_threshold, freq));
}