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

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

bcma: allow setting FAST clockmode for a core 



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

drivers/bcma/core.c

+31 −0
Original line number Diff line number Diff line
@@ -50,3 +50,34 @@ int bcma_core_enable(struct bcma_device *core, u32 flags) 
	return 0;

}

EXPORT_SYMBOL_GPL(bcma_core_enable);



void bcma_core_set_clockmode(struct bcma_device *core,

			     enum bcma_clkmode clkmode)

{

	u16 i;



	WARN_ON(core->id.id != BCMA_CORE_CHIPCOMMON &&

		core->id.id != BCMA_CORE_PCIE &&

		core->id.id != BCMA_CORE_80211);



	switch (clkmode) {

	case BCMA_CLKMODE_FAST:

		bcma_set32(core, BCMA_CLKCTLST, BCMA_CLKCTLST_FORCEHT);

		udelay(64);

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

			if (bcma_read32(core, BCMA_CLKCTLST) &

			    BCMA_CLKCTLST_HAVEHT) {

				i = 0;

				break;

			}

			udelay(10);

		}

		if (i)

			pr_err("HT force timeout\n");

		break;

	case BCMA_CLKMODE_DYNAMIC:

		pr_warn("Dynamic clockmode not supported yet!\n");

		break;

	}

}

EXPORT_SYMBOL_GPL(bcma_core_set_clockmode);

include/linux/bcma/bcma.h

+7 −1
Original line number Diff line number Diff line
@@ -25,6 +25,11 @@ struct bcma_chipinfo { 
	u8 pkg;

};



enum bcma_clkmode {

	BCMA_CLKMODE_FAST,

	BCMA_CLKMODE_DYNAMIC,

};



struct bcma_host_ops {

	u8 (*read8)(struct bcma_device *core, u16 offset);

	u16 (*read16)(struct bcma_device *core, u16 offset);
@@ -253,6 +258,7 @@ void bcma_awrite32(struct bcma_device *core, u16 offset, u32 value) 
extern bool bcma_core_is_enabled(struct bcma_device *core);

extern void bcma_core_disable(struct bcma_device *core, u32 flags);

extern int bcma_core_enable(struct bcma_device *core, u32 flags);



extern void bcma_core_set_clockmode(struct bcma_device *core,

				    enum bcma_clkmode clkmode);



#endif /* LINUX_BCMA_H_ */