mirror of https://gitee.com/openkylin/linux.git
b43: LCN-PHY: basic PHY init
Signed-off-by: Rafał Miłecki <zajec5@gmail.com> Signed-off-by: John W. Linville <linville@tuxdriver.com>
This commit is contained in:
parent
00044f17af
commit
78bc2463af
|
@ -27,6 +27,50 @@
|
|||
#include "tables_phy_lcn.h"
|
||||
#include "main.h"
|
||||
|
||||
/**************************************************
|
||||
* Various PHY ops
|
||||
**************************************************/
|
||||
|
||||
static void b43_phy_lcn_afe_set_unset(struct b43_wldev *dev)
|
||||
{
|
||||
u16 afe_ctl2 = b43_phy_read(dev, B43_PHY_LCN_AFE_CTL2);
|
||||
u16 afe_ctl1 = b43_phy_read(dev, B43_PHY_LCN_AFE_CTL1);
|
||||
|
||||
b43_phy_write(dev, B43_PHY_LCN_AFE_CTL2, afe_ctl2 | 0x1);
|
||||
b43_phy_write(dev, B43_PHY_LCN_AFE_CTL1, afe_ctl1 | 0x1);
|
||||
|
||||
b43_phy_write(dev, B43_PHY_LCN_AFE_CTL2, afe_ctl2 & ~0x1);
|
||||
b43_phy_write(dev, B43_PHY_LCN_AFE_CTL1, afe_ctl1 & ~0x1);
|
||||
|
||||
b43_phy_write(dev, B43_PHY_LCN_AFE_CTL2, afe_ctl2);
|
||||
b43_phy_write(dev, B43_PHY_LCN_AFE_CTL1, afe_ctl1);
|
||||
}
|
||||
|
||||
static void b43_phy_lcn_clean_0x18_table(struct b43_wldev *dev)
|
||||
{
|
||||
u8 i;
|
||||
|
||||
for (i = 0; i < 0x80; i++)
|
||||
b43_lcntab_write(dev, B43_LCNTAB32(0x18, i), 0x80000);
|
||||
}
|
||||
|
||||
static void b43_phy_lcn_clear_0x07_table(struct b43_wldev *dev)
|
||||
{
|
||||
u8 i;
|
||||
|
||||
b43_phy_write(dev, B43_PHY_LCN_TABLE_ADDR, (0x7 << 10) | 0x340);
|
||||
for (i = 0; i < 30; i++) {
|
||||
b43_phy_write(dev, B43_PHY_LCN_TABLE_DATAHI, 0);
|
||||
b43_phy_write(dev, B43_PHY_LCN_TABLE_DATALO, 0);
|
||||
}
|
||||
|
||||
b43_phy_write(dev, B43_PHY_LCN_TABLE_ADDR, (0x7 << 10) | 0x80);
|
||||
for (i = 0; i < 64; i++) {
|
||||
b43_phy_write(dev, B43_PHY_LCN_TABLE_DATAHI, 0);
|
||||
b43_phy_write(dev, B43_PHY_LCN_TABLE_DATALO, 0);
|
||||
}
|
||||
}
|
||||
|
||||
/**************************************************
|
||||
* Basic PHY ops.
|
||||
**************************************************/
|
||||
|
@ -60,6 +104,30 @@ static void b43_phy_lcn_op_prepare_structs(struct b43_wldev *dev)
|
|||
memset(phy_lcn, 0, sizeof(*phy_lcn));
|
||||
}
|
||||
|
||||
static int b43_phy_lcn_op_init(struct b43_wldev *dev)
|
||||
{
|
||||
b43_phy_set(dev, 0x44a, 0x80);
|
||||
b43_phy_mask(dev, 0x44a, 0x7f);
|
||||
b43_phy_set(dev, 0x6d1, 0x80);
|
||||
b43_phy_write(dev, 0x6d0, 0x7);
|
||||
|
||||
b43_phy_lcn_afe_set_unset(dev);
|
||||
|
||||
b43_phy_write(dev, 0x60a, 0xa0);
|
||||
b43_phy_write(dev, 0x46a, 0x19);
|
||||
b43_phy_maskset(dev, 0x663, 0xFF00, 0x64);
|
||||
|
||||
b43_phy_lcn_tables_init(dev);
|
||||
/* TODO: various tables ops here */
|
||||
b43_phy_lcn_clean_0x18_table(dev);
|
||||
|
||||
/* TODO: some ops here */
|
||||
|
||||
b43_phy_lcn_clear_0x07_table(dev);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void b43_phy_lcn_op_software_rfkill(struct b43_wldev *dev,
|
||||
bool blocked)
|
||||
{
|
||||
|
@ -77,7 +145,9 @@ static void b43_phy_lcn_op_software_rfkill(struct b43_wldev *dev,
|
|||
b43_phy_mask(dev, B43_PHY_LCN_RF_CTL7, ~0x8);
|
||||
b43_phy_set(dev, B43_PHY_LCN_RF_CTL6, 0x8);
|
||||
} else {
|
||||
/* TODO */
|
||||
b43_phy_mask(dev, B43_PHY_LCN_RF_CTL1, ~0x1f00);
|
||||
b43_phy_mask(dev, B43_PHY_LCN_RF_CTL3, ~0x808);
|
||||
b43_phy_mask(dev, B43_PHY_LCN_RF_CTL6, ~0x8);
|
||||
}
|
||||
}
|
||||
|
||||
|
@ -116,8 +186,8 @@ const struct b43_phy_operations b43_phyops_lcn = {
|
|||
.allocate = b43_phy_lcn_op_allocate,
|
||||
.free = b43_phy_lcn_op_free,
|
||||
.prepare_structs = b43_phy_lcn_op_prepare_structs,
|
||||
/*
|
||||
.init = b43_phy_lcn_op_init,
|
||||
/*
|
||||
.phy_read = b43_phy_lcn_op_read,
|
||||
.phy_write = b43_phy_lcn_op_write,
|
||||
.phy_maskset = b43_phy_lcn_op_maskset,
|
||||
|
|
Loading…
Reference in New Issue