Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

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

b43: N-PHY: add RSSI polling and setting 2055 (radio) VCM 



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

drivers/net/wireless/b43/phy_n.c

+96 −0
Original line number Diff line number Diff line
@@ -586,6 +586,102 @@ static void b43_nphy_rssi_select(struct b43_wldev *dev, u8 code, u8 type) 
	}

}



/* http://bcm-v4.sipsolutions.net/802.11/PHY/N/SetRssi2055Vcm */

static void b43_nphy_set_rssi_2055_vcm(struct b43_wldev *dev, u8 type, u8 *buf)

{

	int i;

	for (i = 0; i < 2; i++) {

		if (type == 2) {

			if (i == 0) {

				b43_radio_maskset(dev, B2055_C1_B0NB_RSSIVCM,

						  0xFC, buf[0]);

				b43_radio_maskset(dev, B2055_C1_RX_BB_RSSICTL5,

						  0xFC, buf[1]);

			} else {

				b43_radio_maskset(dev, B2055_C2_B0NB_RSSIVCM,

						  0xFC, buf[2 * i]);

				b43_radio_maskset(dev, B2055_C2_RX_BB_RSSICTL5,

						  0xFC, buf[2 * i + 1]);

			}

		} else {

			if (i == 0)

				b43_radio_maskset(dev, B2055_C1_RX_BB_RSSICTL5,

						  0xF3, buf[0] << 2);

			else

				b43_radio_maskset(dev, B2055_C2_RX_BB_RSSICTL5,

						  0xF3, buf[2 * i + 1] << 2);

		}

	}

}



/* http://bcm-v4.sipsolutions.net/802.11/PHY/N/PollRssi */

static int b43_nphy_poll_rssi(struct b43_wldev *dev, u8 type, s32 *buf,

				u8 nsamp)

{

	int i;

	int out;

	u16 save_regs_phy[9];

	u16 s[2];



	if (dev->phy.rev >= 3) {

		save_regs_phy[0] = b43_phy_read(dev,

						B43_NPHY_RFCTL_LUT_TRSW_UP1);

		save_regs_phy[1] = b43_phy_read(dev,

						B43_NPHY_RFCTL_LUT_TRSW_UP2);

		save_regs_phy[2] = b43_phy_read(dev, B43_NPHY_AFECTL_C1);

		save_regs_phy[3] = b43_phy_read(dev, B43_NPHY_AFECTL_C2);

		save_regs_phy[4] = b43_phy_read(dev, B43_NPHY_AFECTL_OVER1);

		save_regs_phy[5] = b43_phy_read(dev, B43_NPHY_AFECTL_OVER);

		save_regs_phy[6] = b43_phy_read(dev, B43_NPHY_TXF_40CO_B1S0);

		save_regs_phy[7] = b43_phy_read(dev, B43_NPHY_TXF_40CO_B32S1);

	}



	b43_nphy_rssi_select(dev, 5, type);



	if (dev->phy.rev < 2) {

		save_regs_phy[8] = b43_phy_read(dev, B43_NPHY_GPIO_SEL);

		b43_phy_write(dev, B43_NPHY_GPIO_SEL, 5);

	}



	for (i = 0; i < 4; i++)

		buf[i] = 0;



	for (i = 0; i < nsamp; i++) {

		if (dev->phy.rev < 2) {

			s[0] = b43_phy_read(dev, B43_NPHY_GPIO_LOOUT);

			s[1] = b43_phy_read(dev, B43_NPHY_GPIO_HIOUT);

		} else {

			s[0] = b43_phy_read(dev, B43_NPHY_RSSI1);

			s[1] = b43_phy_read(dev, B43_NPHY_RSSI2);

		}



		buf[0] += ((s8)((s[0] & 0x3F) << 2)) >> 2;

		buf[1] += ((s8)(((s[0] >> 8) & 0x3F) << 2)) >> 2;

		buf[2] += ((s8)((s[1] & 0x3F) << 2)) >> 2;

		buf[3] += ((s8)(((s[1] >> 8) & 0x3F) << 2)) >> 2;

	}

	out = (buf[0] & 0xFF) << 24 | (buf[1] & 0xFF) << 16 |

		(buf[2] & 0xFF) << 8 | (buf[3] & 0xFF);



	if (dev->phy.rev < 2)

		b43_phy_write(dev, B43_NPHY_GPIO_SEL, save_regs_phy[8]);



	if (dev->phy.rev >= 3) {

		b43_phy_write(dev, B43_NPHY_RFCTL_LUT_TRSW_UP1,

				save_regs_phy[0]);

		b43_phy_write(dev, B43_NPHY_RFCTL_LUT_TRSW_UP2,

				save_regs_phy[1]);

		b43_phy_write(dev, B43_NPHY_AFECTL_C1, save_regs_phy[2]);

		b43_phy_write(dev, B43_NPHY_AFECTL_C2, save_regs_phy[3]);

		b43_phy_write(dev, B43_NPHY_AFECTL_OVER1, save_regs_phy[4]);

		b43_phy_write(dev, B43_NPHY_AFECTL_OVER, save_regs_phy[5]);

		b43_phy_write(dev, B43_NPHY_TXF_40CO_B1S0, save_regs_phy[6]);

		b43_phy_write(dev, B43_NPHY_TXF_40CO_B32S1, save_regs_phy[7]);

	}



	return out;

}



/* http://bcm-v4.sipsolutions.net/802.11/PHY/N/RSSICal */

static void b43_nphy_rev2_rssi_cal(struct b43_wldev *dev, u8 type)

{