clocksource: sh_cmt 16-bit fixes

This patch contains various fixes for 16-bit cmt hardware.
With this applied periodic clockevents work fine on sh7203.

Signed-off-by: Magnus Damm <damm@igel.co.jp>
Signed-off-by: Paul Mundt <lethal@linux-sh.org>
This commit is contained in:
Magnus Damm 2009-04-29 14:50:37 +00:00 committed by Paul Mundt
parent e6be3a2586
commit 3014f47460

View file

@ -158,16 +158,18 @@ static int sh_cmt_enable(struct sh_cmt_priv *p, unsigned long *rate)
pr_err("sh_cmt: cannot enable clock \"%s\"\n", cfg->clk); pr_err("sh_cmt: cannot enable clock \"%s\"\n", cfg->clk);
return ret; return ret;
} }
*rate = clk_get_rate(p->clk) / 8;
/* make sure channel is disabled */ /* make sure channel is disabled */
sh_cmt_start_stop_ch(p, 0); sh_cmt_start_stop_ch(p, 0);
/* configure channel, periodic mode and maximum timeout */ /* configure channel, periodic mode and maximum timeout */
if (p->width == 16) if (p->width == 16) {
sh_cmt_write(p, CMCSR, 0); *rate = clk_get_rate(p->clk) / 512;
else sh_cmt_write(p, CMCSR, 0x43);
} else {
*rate = clk_get_rate(p->clk) / 8;
sh_cmt_write(p, CMCSR, 0x01a4); sh_cmt_write(p, CMCSR, 0x01a4);
}
sh_cmt_write(p, CMCOR, 0xffffffff); sh_cmt_write(p, CMCOR, 0xffffffff);
sh_cmt_write(p, CMCNT, 0); sh_cmt_write(p, CMCNT, 0);
@ -615,7 +617,7 @@ static int sh_cmt_setup(struct sh_cmt_priv *p, struct platform_device *pdev)
if (resource_size(res) == 6) { if (resource_size(res) == 6) {
p->width = 16; p->width = 16;
p->overflow_bit = 0x80; p->overflow_bit = 0x80;
p->clear_bits = ~0xc0; p->clear_bits = ~0x80;
} else { } else {
p->width = 32; p->width = 32;
p->overflow_bit = 0x8000; p->overflow_bit = 0x8000;