![Hartley Sweeten](/assets/img/avatar_default.png)
Add core functions to handle writes to the ep93xx software locked registers. There are a number of registers in the EP93xx System Controller that require a write to the software lock register before they can be updated. This patch adds a number of exported functions to the ep93xx core that handle this access. The software locked clock divider registers, VidClkDiv, MIRClkDiv, I2SClkDiv and KeyTchClkDiv would typically involve writing a specific value to the register. To support this the ep93xx_syscon_swlocked_write() function is provided. For the DeviceCfg register it's more typical to only need to set or clear a single bit. A generic ep93xx_devcfg_set_clear() function is provided to handle both operations. Two inline functions, ep93xx_devcfg_set_bits() and ep93xx_devcfg_clear_bits() are also provided to improve code readability. In addition, the remaining bits in the System Controller Device Config Register have been documented and the previously defined names shortened. All code paths that use this functionality have been updated except for arch/arm/kernel/crunch.c. That code is in a context switch path, which is not reentrant, so it is safe against itself. Cc: Lennert Buytenhek <buytenh@wantstofly.org> Cc: Matthias Kaehlcke <matthias@kaehlcke.net> Signed-off-by: H Hartley Sweeten <hsweeten@visionengravers.com> Acked-by: Ryan Mallon <ryan@bluewatersys.com> Signed-off-by: Russell King <rmk+kernel@arm.linux.org.uk>
89 lines
2.1 KiB
C
89 lines
2.1 KiB
C
/*
|
|
* arch/arm/kernel/crunch.c
|
|
* Cirrus MaverickCrunch context switching and handling
|
|
*
|
|
* Copyright (C) 2006 Lennert Buytenhek <buytenh@wantstofly.org>
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
* published by the Free Software Foundation.
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/types.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/signal.h>
|
|
#include <linux/sched.h>
|
|
#include <linux/init.h>
|
|
#include <linux/io.h>
|
|
#include <mach/ep93xx-regs.h>
|
|
#include <asm/thread_notify.h>
|
|
|
|
struct crunch_state *crunch_owner;
|
|
|
|
void crunch_task_release(struct thread_info *thread)
|
|
{
|
|
local_irq_disable();
|
|
if (crunch_owner == &thread->crunchstate)
|
|
crunch_owner = NULL;
|
|
local_irq_enable();
|
|
}
|
|
|
|
static int crunch_enabled(u32 devcfg)
|
|
{
|
|
return !!(devcfg & EP93XX_SYSCON_DEVCFG_CPENA);
|
|
}
|
|
|
|
static int crunch_do(struct notifier_block *self, unsigned long cmd, void *t)
|
|
{
|
|
struct thread_info *thread = (struct thread_info *)t;
|
|
struct crunch_state *crunch_state;
|
|
u32 devcfg;
|
|
|
|
crunch_state = &thread->crunchstate;
|
|
|
|
switch (cmd) {
|
|
case THREAD_NOTIFY_FLUSH:
|
|
memset(crunch_state, 0, sizeof(*crunch_state));
|
|
|
|
/*
|
|
* FALLTHROUGH: Ensure we don't try to overwrite our newly
|
|
* initialised state information on the first fault.
|
|
*/
|
|
|
|
case THREAD_NOTIFY_RELEASE:
|
|
crunch_task_release(thread);
|
|
break;
|
|
|
|
case THREAD_NOTIFY_SWITCH:
|
|
devcfg = __raw_readl(EP93XX_SYSCON_DEVCFG);
|
|
if (crunch_enabled(devcfg) || crunch_owner == crunch_state) {
|
|
/*
|
|
* We don't use ep93xx_syscon_swlocked_write() here
|
|
* because we are on the context switch path and
|
|
* preemption is already disabled.
|
|
*/
|
|
devcfg ^= EP93XX_SYSCON_DEVCFG_CPENA;
|
|
__raw_writel(0xaa, EP93XX_SYSCON_SWLOCK);
|
|
__raw_writel(devcfg, EP93XX_SYSCON_DEVCFG);
|
|
}
|
|
break;
|
|
}
|
|
|
|
return NOTIFY_DONE;
|
|
}
|
|
|
|
static struct notifier_block crunch_notifier_block = {
|
|
.notifier_call = crunch_do,
|
|
};
|
|
|
|
static int __init crunch_init(void)
|
|
{
|
|
thread_register_notifier(&crunch_notifier_block);
|
|
elf_hwcap |= HWCAP_CRUNCH;
|
|
|
|
return 0;
|
|
}
|
|
|
|
late_initcall(crunch_init);
|