mirror of
				git://git.openwrt.org/openwrt/openwrt.git
				synced 2025-10-31 14:04:26 -04:00 
			
		
		
		
	
		
			
				
	
	
		
			243 lines
		
	
	
		
			4.0 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			243 lines
		
	
	
		
			4.0 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * This file is subject to the terms and conditions of the GNU General Public
 | |
|  * License.  See the file "COPYING" in the main directory of this archive
 | |
|  * for more details.
 | |
|  *
 | |
|  * Copyright (C) 2008 Maxime Bizon <mbizon@freebox.fr>
 | |
|  */
 | |
| 
 | |
| #include <linux/module.h>
 | |
| #include <linux/mutex.h>
 | |
| #include <linux/err.h>
 | |
| #include <linux/clk.h>
 | |
| #include <bcm63xx_cpu.h>
 | |
| #include <bcm63xx_io.h>
 | |
| #include <bcm63xx_regs.h>
 | |
| #include <bcm63xx_clk.h>
 | |
| 
 | |
| DEFINE_MUTEX(clocks_mutex);
 | |
| 
 | |
| 
 | |
| static void clk_enable_unlocked(struct clk *clk)
 | |
| {
 | |
| 	if (clk->set && (clk->usage++) == 0)
 | |
| 		clk->set(clk, 1);
 | |
| }
 | |
| 
 | |
| static void clk_disable_unlocked(struct clk *clk)
 | |
| {
 | |
| 	if (clk->set && (--clk->usage) == 0)
 | |
| 		clk->set(clk, 0);
 | |
| }
 | |
| 
 | |
| static void bcm_hwclock_set(u32 mask, int enable)
 | |
| {
 | |
| 	u32 reg;
 | |
| 
 | |
| 	reg = bcm_perf_readl(PERF_CKCTL_REG);
 | |
| 	if (enable)
 | |
| 		reg |= mask;
 | |
| 	else
 | |
| 		reg &= ~mask;
 | |
| 	bcm_perf_writel(reg, PERF_CKCTL_REG);
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * Ethernet MAC "misc" clock: dma clocks and main clock on 6348
 | |
|  */
 | |
| static void enet_misc_set(struct clk *clk, int enable)
 | |
| {
 | |
| 	u32 mask;
 | |
| 
 | |
| 	if (BCMCPU_IS_6348())
 | |
| 		mask = CKCTL_6348_ENET_EN;
 | |
| 	else
 | |
| 		/* BCMCPU_IS_6358 */
 | |
| 		mask = CKCTL_6358_EMUSB_EN;
 | |
| 	bcm_hwclock_set(mask, enable);
 | |
| }
 | |
| 
 | |
| static struct clk clk_enet_misc = {
 | |
| 	.set	= enet_misc_set,
 | |
| };
 | |
| 
 | |
| /*
 | |
|  * Ethernet MAC clocks: only revelant on 6358, silently enable misc
 | |
|  * clocks
 | |
|  */
 | |
| static void enetx_set(struct clk *clk, int enable)
 | |
| {
 | |
| 	if (enable)
 | |
| 		clk_enable_unlocked(&clk_enet_misc);
 | |
| 	else
 | |
| 		clk_disable_unlocked(&clk_enet_misc);
 | |
| 
 | |
| 	if (BCMCPU_IS_6358()) {
 | |
| 		u32 mask;
 | |
| 
 | |
| 		if (clk->id == 0)
 | |
| 			mask = CKCTL_6358_ENET0_EN;
 | |
| 		else
 | |
| 			mask = CKCTL_6358_ENET1_EN;
 | |
| 		bcm_hwclock_set(mask, enable);
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static struct clk clk_enet0 = {
 | |
| 	.id	= 0,
 | |
| 	.set	= enetx_set,
 | |
| };
 | |
| 
 | |
| static struct clk clk_enet1 = {
 | |
| 	.id	= 1,
 | |
| 	.set	= enetx_set,
 | |
| };
 | |
| 
 | |
| /*
 | |
|  * Ethernet PHY clock
 | |
|  */
 | |
| static void ephy_set(struct clk *clk, int enable)
 | |
| {
 | |
| 	if (!BCMCPU_IS_6358())
 | |
| 		return;
 | |
| 	bcm_hwclock_set(CKCTL_6358_EPHY_EN, enable);
 | |
| }
 | |
| 
 | |
| 
 | |
| static struct clk clk_ephy = {
 | |
| 	.set	= ephy_set,
 | |
| };
 | |
| 
 | |
| /*
 | |
|  * PCM clock
 | |
|  */
 | |
| static void pcm_set(struct clk *clk, int enable)
 | |
| {
 | |
| 	if (!BCMCPU_IS_6358())
 | |
| 		return;
 | |
| 	bcm_hwclock_set(CKCTL_6358_PCM_EN, enable);
 | |
| }
 | |
| 
 | |
| static struct clk clk_pcm = {
 | |
| 	.set	= pcm_set,
 | |
| };
 | |
| 
 | |
| /*
 | |
|  * USB host clock
 | |
|  */
 | |
| static void usbh_set(struct clk *clk, int enable)
 | |
| {
 | |
| 	if (!BCMCPU_IS_6348())
 | |
| 		return;
 | |
| 	bcm_hwclock_set(CKCTL_6348_USBH_EN, enable);
 | |
| }
 | |
| 
 | |
| static struct clk clk_usbh = {
 | |
| 	.set	= usbh_set,
 | |
| };
 | |
| 
 | |
| /*
 | |
|  * USB slave clock
 | |
|  */
 | |
| static void usbs_set(struct clk *clk, int enable)
 | |
| {
 | |
| 	u32 mask;
 | |
| 
 | |
| 	switch(bcm63xx_get_cpu_id()) {
 | |
| 	case BCM6338_CPU_ID: mask = CKCTL_6338_USBS_EN; break;
 | |
| 	case BCM6348_CPU_ID: mask = CKCTL_6348_USBS_EN; break;
 | |
| 	default:
 | |
| 		return;
 | |
| 	}
 | |
| 	bcm_hwclock_set(mask, enable);
 | |
| }
 | |
| 
 | |
| static struct clk clk_usbs = {
 | |
| 	.set	= usbs_set,
 | |
| };
 | |
| 
 | |
| /*
 | |
|  * SPI clock
 | |
|  */
 | |
| static void spi_set(struct clk *clk, int enable)
 | |
| {
 | |
| 	u32 mask;
 | |
| 
 | |
| 	if (BCMCPU_IS_6348())
 | |
| 		mask = CKCTL_6348_SPI_EN;
 | |
| 	else
 | |
| 		/* BCMCPU_IS_6358 */
 | |
| 		mask = CKCTL_6358_SPI_EN;
 | |
| 	bcm_hwclock_set(mask, enable);
 | |
| }
 | |
| 
 | |
| static struct clk clk_spi = {
 | |
| 	.set	= spi_set,
 | |
| };
 | |
| 
 | |
| /*
 | |
|  * Internal peripheral clock
 | |
|  */
 | |
| static struct clk clk_periph = {
 | |
| 	.rate	= (50 * 1000 * 1000),
 | |
| };
 | |
| 
 | |
| 
 | |
| /*
 | |
|  * Linux clock API implementation
 | |
|  */
 | |
| int clk_enable(struct clk *clk)
 | |
| {
 | |
| 	mutex_lock(&clocks_mutex);
 | |
| 	clk_enable_unlocked(clk);
 | |
| 	mutex_unlock(&clocks_mutex);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| EXPORT_SYMBOL(clk_enable);
 | |
| 
 | |
| void clk_disable(struct clk *clk)
 | |
| {
 | |
| 	mutex_lock(&clocks_mutex);
 | |
| 	clk_disable_unlocked(clk);
 | |
| 	mutex_unlock(&clocks_mutex);
 | |
| }
 | |
| 
 | |
| EXPORT_SYMBOL(clk_disable);
 | |
| 
 | |
| unsigned long clk_get_rate(struct clk *clk)
 | |
| {
 | |
| 	return clk->rate;
 | |
| }
 | |
| 
 | |
| EXPORT_SYMBOL(clk_get_rate);
 | |
| 
 | |
| struct clk *clk_get(struct device *dev, const char *id)
 | |
| {
 | |
| 	if (!strcmp(id, "enet0"))
 | |
| 		return &clk_enet0;
 | |
| 	if (!strcmp(id, "enet1"))
 | |
| 		return &clk_enet1;
 | |
| 	if (!strcmp(id, "ephy"))
 | |
| 		return &clk_ephy;
 | |
| 	if (!strcmp(id, "usbh"))
 | |
| 		return &clk_usbh;
 | |
| 	if (!strcmp(id, "usbs"))
 | |
| 		return &clk_usbs;
 | |
| 	if (!strcmp(id, "spi"))
 | |
| 		return &clk_spi;
 | |
| 	if (!strcmp(id, "periph"))
 | |
| 		return &clk_periph;
 | |
| 	if (BCMCPU_IS_6358() && !strcmp(id, "pcm"))
 | |
| 		return &clk_pcm;
 | |
| 	return ERR_PTR(-ENOENT);
 | |
| }
 | |
| 
 | |
| EXPORT_SYMBOL(clk_get);
 | |
| 
 | |
| void clk_put(struct clk *clk)
 | |
| {
 | |
| }
 | |
| 
 | |
| EXPORT_SYMBOL(clk_put);
 |