Commit 78bc2463 authored by Rafał Miłecki's avatar Rafał Miłecki Committed by John W. Linville
Browse files

b43: LCN-PHY: basic PHY init 



Signed-off-by: default avatarRafał Miłecki <zajec5@gmail.com>
Signed-off-by: default avatarJohn W. Linville <linville@tuxdriver.com>
parent 00044f17

drivers/net/wireless/b43/phy_lcn.c

+72 −2
Original line number Diff line number Diff line
@@ -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,