From 0662793ca0050e823cd1207cc4689a1cba5068bd Mon Sep 17 00:00:00 2001 From: Solomon Peachy Date: Thu, 28 Jun 2018 06:24:26 -0400 Subject: Add cleaned-up xDuoo X3 support Cleaned up, rebased, and forward-ported from the xvortex fork. (original credit to vsoftster@gmail.com) Change-Id: Ibcc023a0271ea81e901450a88317708c2683236d Signed-off-by: Solomon Peachy --- firmware/target/mips/ingenic_jz47xx/timer-jz4760.c | 101 +++++++++++++++++++++ 1 file changed, 101 insertions(+) create mode 100644 firmware/target/mips/ingenic_jz47xx/timer-jz4760.c (limited to 'firmware/target/mips/ingenic_jz47xx/timer-jz4760.c') diff --git a/firmware/target/mips/ingenic_jz47xx/timer-jz4760.c b/firmware/target/mips/ingenic_jz47xx/timer-jz4760.c new file mode 100644 index 0000000000..0f16825b34 --- /dev/null +++ b/firmware/target/mips/ingenic_jz47xx/timer-jz4760.c @@ -0,0 +1,101 @@ +/*************************************************************************** + * __________ __ ___. + * Open \______ \ ____ ____ | | _\_ |__ _______ ___ + * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / + * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < + * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ + * \/ \/ \/ \/ \/ + * $Id$ + * + * Copyright (C) 2016 by Roman Stolyarov + * + * 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 "config.h" +#include "cpu.h" +#include "system.h" +#include "timer.h" + +/* Interrupt handler */ +void TCU1(void) +{ + __tcu_clear_full_match_flag(5); + + if (pfn_timer != NULL) + pfn_timer(); +} + +bool timer_set(long cycles, bool start) +{ + unsigned int divider = cycles, prescaler_bit = 0, prescaler = 1, old_irq; + + if(cycles < 1) + return false; + + if(start && pfn_unregister != NULL) + { + pfn_unregister(); + pfn_unregister = NULL; + } + + /* Increase prescale values starting from 0 to make the cycle count fit */ + while(divider > 65535 && prescaler <= 1024) + { + prescaler <<= 2; /* 1, 4, 16, 64, 256, 1024 */ + prescaler_bit++; + divider = cycles / prescaler; + } + + old_irq = disable_irq_save(); + + __tcu_stop_counter(5); + if(start) + { + __tcu_disable_pwm_output(5); + + __tcu_mask_half_match_irq(5); + __tcu_unmask_full_match_irq(5); + + /* EXTAL clock = CFG_EXTAL (12Mhz in most targets) */ + __tcu_select_extalclk(5); + } + + REG_TCU_TCSR(5) = (REG_TCU_TCSR(5) & ~TCSR_PRESCALE_MASK) | (prescaler_bit << TCSR_PRESCALE_LSB); + REG_TCU_TCNT(5) = 0; + REG_TCU_TDHR(5) = 0; + REG_TCU_TDFR(5) = divider; + + __tcu_clear_full_match_flag(5); + + if(start) + { + system_enable_irq(IRQ_TCU1); + __tcu_start_counter(5); + } + + restore_irq(old_irq); + + return true; +} + +bool timer_start(void) +{ + __tcu_start_counter(5); + + return true; +} + +void timer_stop(void) +{ + unsigned int old_irq = disable_irq_save(); + __tcu_stop_counter(5); + restore_irq(old_irq); +} -- cgit v1.2.3