From b3ed33d04aec20568b8bb9616349e6d7e4c71882 Mon Sep 17 00:00:00 2001 From: Rafaël Carré Date: Mon, 29 Jun 2009 14:29:14 +0000 Subject: Move SH7034 timer code in the target tree Add an argument int_prio to TIMER_START() macro because SH7034 needs it Leaves a target specific code in timer_register (could be given to target code through timer_set and __timer_set() ) git-svn-id: svn://svn.rockbox.org/rockbox/trunk@21556 a1c6a512-1295-4272-9138-f99709370657 --- firmware/target/sh/archos/timer-archos.c | 85 ++++++++++++++++++++++++++++++++ firmware/target/sh/archos/timer-target.h | 41 +++++++++++++++ 2 files changed, 126 insertions(+) create mode 100644 firmware/target/sh/archos/timer-archos.c create mode 100644 firmware/target/sh/archos/timer-target.h (limited to 'firmware/target/sh') diff --git a/firmware/target/sh/archos/timer-archos.c b/firmware/target/sh/archos/timer-archos.c new file mode 100644 index 0000000000..e7526a8409 --- /dev/null +++ b/firmware/target/sh/archos/timer-archos.c @@ -0,0 +1,85 @@ +/*************************************************************************** +* __________ __ ___. +* Open \______ \ ____ ____ | | _\_ |__ _______ ___ +* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / +* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < +* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ +* \/ \/ \/ \/ \/ +* $Id$ +* +* Copyright (C) 2005 Jens Arnold +* +* This program is free software; you can redistribute it and/or +* modify it under the terms of the GNU General Public License +* as published by the Free Software Foundation; either version 2 +* of the License, or (at your option) any later version. +* +* This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY +* KIND, either express or implied. +* +****************************************************************************/ + +#include "cpu.h" +#include "system.h" +#include "timer.h" +#include "timer-target.h" + +void IMIA4(void) __attribute__((interrupt_handler)); +void IMIA4(void) +{ + if (pfn_timer != NULL) + pfn_timer(); + and_b(~0x01, &TSR4); /* clear the interrupt */ +} + +bool __timer_set(long cycles, bool start) +{ + int phi = 0; /* bits for the prescaler */ + int prescale = 1; + + while (cycles > 0x10000) + { /* work out the smallest prescaler that makes it fit */ + phi++; + prescale <<= 1; + cycles >>= 1; + } + + if (prescale > 8) + return false; + + if (start) + { + if (pfn_unregister != NULL) + { + pfn_unregister(); + pfn_unregister = NULL; + } + + and_b(~0x10, &TSTR); /* Stop the timer 4 */ + and_b(~0x10, &TSNC); /* No synchronization */ + and_b(~0x10, &TMDR); /* Operate normally */ + + TIER4 = 0xF9; /* Enable GRA match interrupt */ + } + + TCR4 = 0x20 | phi; /* clear at GRA match, set prescaler */ + GRA4 = (unsigned short)(cycles - 1); + if (start || (TCNT4 >= GRA4)) + TCNT4 = 0; + and_b(~0x01, &TSR4); /* clear an eventual interrupt */ + + return true; +} + +bool __timer_start(int int_prio) +{ + IPRD = (IPRD & 0xFF0F) | int_prio << 4; /* interrupt priority */ + or_b(0x10, &TSTR); /* start timer 4 */ + return true; +} + +void __timer_stop(void) +{ + and_b(~0x10, &TSTR); /* stop the timer 4 */ + IPRD = (IPRD & 0xFF0F); /* disable interrupt */ +} diff --git a/firmware/target/sh/archos/timer-target.h b/firmware/target/sh/archos/timer-target.h new file mode 100644 index 0000000000..08fcae1156 --- /dev/null +++ b/firmware/target/sh/archos/timer-target.h @@ -0,0 +1,41 @@ +/*************************************************************************** +* __________ __ ___. +* Open \______ \ ____ ____ | | _\_ |__ _______ ___ +* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / +* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < +* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ +* \/ \/ \/ \/ \/ +* $Id$ +* +* Copyright (C) 2005 Jens Arnold +* +* This program is free software; you can redistribute it and/or +* modify it under the terms of the GNU General Public License +* as published by the Free Software Foundation; either version 2 +* of the License, or (at your option) any later version. +* +* This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY +* KIND, either express or implied. +* +****************************************************************************/ +#ifndef TIMER_TARGET_H +#define TIMER_TARGET_H + +#include "config.h" + +bool __timer_set(long cycles, bool start); +bool __timer_start(int int_prio); +void __timer_stop(void); + +#define TIMER_FREQ CPU_FREQ + +#define __TIMER_SET(cycles, set) \ + __timer_set(cycles, set) + +#define __TIMER_START(int_prio) \ + __timer_start(int_prio) + +#define __TIMER_STOP(...) \ + __timer_stop() + +#endif /* TIMER_TARGET_H */ -- cgit v1.2.3