timer_sp804.cc revision 7733
17584SAli.Saidi@arm.com/* 27584SAli.Saidi@arm.com * Copyright (c) 2010 ARM Limited 37584SAli.Saidi@arm.com * All rights reserved 47584SAli.Saidi@arm.com * 57584SAli.Saidi@arm.com * The license below extends only to copyright in the software and shall 67584SAli.Saidi@arm.com * not be construed as granting a license to any other intellectual 77584SAli.Saidi@arm.com * property including but not limited to intellectual property relating 87584SAli.Saidi@arm.com * to a hardware implementation of the functionality of the software 97584SAli.Saidi@arm.com * licensed hereunder. You may use the software subject to the license 107584SAli.Saidi@arm.com * terms below provided that you ensure that this notice is replicated 117584SAli.Saidi@arm.com * unmodified and in its entirety in all distributions of the software, 127584SAli.Saidi@arm.com * modified or unmodified, in source code or in binary form. 137584SAli.Saidi@arm.com * 147584SAli.Saidi@arm.com * Redistribution and use in source and binary forms, with or without 157584SAli.Saidi@arm.com * modification, are permitted provided that the following conditions are 167584SAli.Saidi@arm.com * met: redistributions of source code must retain the above copyright 177584SAli.Saidi@arm.com * notice, this list of conditions and the following disclaimer; 187584SAli.Saidi@arm.com * redistributions in binary form must reproduce the above copyright 197584SAli.Saidi@arm.com * notice, this list of conditions and the following disclaimer in the 207584SAli.Saidi@arm.com * documentation and/or other materials provided with the distribution; 217584SAli.Saidi@arm.com * neither the name of the copyright holders nor the names of its 227584SAli.Saidi@arm.com * contributors may be used to endorse or promote products derived from 237584SAli.Saidi@arm.com * this software without specific prior written permission. 247584SAli.Saidi@arm.com * 257584SAli.Saidi@arm.com * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 267584SAli.Saidi@arm.com * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 277584SAli.Saidi@arm.com * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 287584SAli.Saidi@arm.com * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT 297584SAli.Saidi@arm.com * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 307584SAli.Saidi@arm.com * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 317584SAli.Saidi@arm.com * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 327584SAli.Saidi@arm.com * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 337584SAli.Saidi@arm.com * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 347584SAli.Saidi@arm.com * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE 357584SAli.Saidi@arm.com * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 367584SAli.Saidi@arm.com * 377584SAli.Saidi@arm.com * Authors: Ali Saidi 387584SAli.Saidi@arm.com */ 397584SAli.Saidi@arm.com 407584SAli.Saidi@arm.com#include "base/intmath.hh" 417584SAli.Saidi@arm.com#include "base/trace.hh" 427584SAli.Saidi@arm.com#include "dev/arm/gic.hh" 437584SAli.Saidi@arm.com#include "dev/arm/timer_sp804.hh" 447584SAli.Saidi@arm.com#include "mem/packet.hh" 457584SAli.Saidi@arm.com#include "mem/packet_access.hh" 467584SAli.Saidi@arm.com 477587SAli.Saidi@arm.comusing namespace AmbaDev; 487587SAli.Saidi@arm.com 497584SAli.Saidi@arm.comSp804::Sp804(Params *p) 507584SAli.Saidi@arm.com : AmbaDevice(p), gic(p->gic), timer0(name() + ".timer0", this, p->int_num0, p->clock0), 517584SAli.Saidi@arm.com timer1(name() + ".timer1", this, p->int_num1, p->clock1) 527584SAli.Saidi@arm.com{ 537584SAli.Saidi@arm.com pioSize = 0xfff; 547584SAli.Saidi@arm.com} 557584SAli.Saidi@arm.com 567584SAli.Saidi@arm.comSp804::Timer::Timer(std::string __name, Sp804 *_parent, int int_num, Tick _clock) 577584SAli.Saidi@arm.com : _name(__name), parent(_parent), intNum(int_num), clock(_clock), control(0x20), 587584SAli.Saidi@arm.com rawInt(false), pendingInt(false), loadValue(0xffffffff), zeroEvent(this) 597584SAli.Saidi@arm.com{ 607584SAli.Saidi@arm.com} 617584SAli.Saidi@arm.com 627584SAli.Saidi@arm.com 637584SAli.Saidi@arm.comTick 647584SAli.Saidi@arm.comSp804::read(PacketPtr pkt) 657584SAli.Saidi@arm.com{ 667584SAli.Saidi@arm.com assert(pkt->getAddr() >= pioAddr && pkt->getAddr() < pioAddr + pioSize); 677584SAli.Saidi@arm.com assert(pkt->getSize() == 4); 687584SAli.Saidi@arm.com Addr daddr = pkt->getAddr() - pioAddr; 697584SAli.Saidi@arm.com pkt->allocate(); 707584SAli.Saidi@arm.com DPRINTF(Timer, "Reading from DualTimer at offset: %#x\n", daddr); 717584SAli.Saidi@arm.com 727584SAli.Saidi@arm.com if (daddr < Timer::Size) 737584SAli.Saidi@arm.com timer0.read(pkt, daddr); 747584SAli.Saidi@arm.com else if ((daddr - Timer::Size) < Timer::Size) 757584SAli.Saidi@arm.com timer1.read(pkt, daddr - Timer::Size); 767587SAli.Saidi@arm.com else if (!readId(pkt, ambaId, pioAddr)) 777584SAli.Saidi@arm.com panic("Tried to read SP804 at offset %#x that doesn't exist\n", daddr); 787584SAli.Saidi@arm.com pkt->makeAtomicResponse(); 797584SAli.Saidi@arm.com return pioDelay; 807584SAli.Saidi@arm.com} 817584SAli.Saidi@arm.com 827584SAli.Saidi@arm.com 837584SAli.Saidi@arm.comvoid 847584SAli.Saidi@arm.comSp804::Timer::read(PacketPtr pkt, Addr daddr) 857584SAli.Saidi@arm.com{ 867584SAli.Saidi@arm.com DPRINTF(Timer, "Reading from Timer at offset: %#x\n", daddr); 877584SAli.Saidi@arm.com 887584SAli.Saidi@arm.com switch(daddr) { 897584SAli.Saidi@arm.com case LoadReg: 907584SAli.Saidi@arm.com pkt->set<uint32_t>(loadValue); 917584SAli.Saidi@arm.com break; 927584SAli.Saidi@arm.com case CurrentReg: 937584SAli.Saidi@arm.com DPRINTF(Timer, "Event schedule for %d, clock=%d, prescale=%d\n", 947584SAli.Saidi@arm.com zeroEvent.when(), clock, control.timerPrescale); 957584SAli.Saidi@arm.com Tick time; 967584SAli.Saidi@arm.com time = zeroEvent.when() - curTick; 977584SAli.Saidi@arm.com time = time / clock / power(16, control.timerPrescale); 987584SAli.Saidi@arm.com DPRINTF(Timer, "-- returning counter at %d\n", time); 997584SAli.Saidi@arm.com pkt->set<uint32_t>(time); 1007584SAli.Saidi@arm.com break; 1017584SAli.Saidi@arm.com case ControlReg: 1027584SAli.Saidi@arm.com pkt->set<uint32_t>(control); 1037584SAli.Saidi@arm.com break; 1047584SAli.Saidi@arm.com case RawISR: 1057584SAli.Saidi@arm.com pkt->set<uint32_t>(rawInt); 1067584SAli.Saidi@arm.com break; 1077584SAli.Saidi@arm.com case MaskedISR: 1087584SAli.Saidi@arm.com pkt->set<uint32_t>(pendingInt); 1097584SAli.Saidi@arm.com break; 1107584SAli.Saidi@arm.com case BGLoad: 1117584SAli.Saidi@arm.com pkt->set<uint32_t>(loadValue); 1127584SAli.Saidi@arm.com break; 1137584SAli.Saidi@arm.com default: 1147584SAli.Saidi@arm.com panic("Tried to read SP804 timer at offset %#x\n", daddr); 1157584SAli.Saidi@arm.com break; 1167584SAli.Saidi@arm.com } 1177584SAli.Saidi@arm.com} 1187584SAli.Saidi@arm.com 1197584SAli.Saidi@arm.comTick 1207584SAli.Saidi@arm.comSp804::write(PacketPtr pkt) 1217584SAli.Saidi@arm.com{ 1227584SAli.Saidi@arm.com assert(pkt->getAddr() >= pioAddr && pkt->getAddr() < pioAddr + pioSize); 1237584SAli.Saidi@arm.com assert(pkt->getSize() == 4); 1247584SAli.Saidi@arm.com Addr daddr = pkt->getAddr() - pioAddr; 1257584SAli.Saidi@arm.com pkt->allocate(); 1267584SAli.Saidi@arm.com DPRINTF(Timer, "Writing to DualTimer at offset: %#x\n", daddr); 1277584SAli.Saidi@arm.com 1287584SAli.Saidi@arm.com if (daddr < Timer::Size) 1297584SAli.Saidi@arm.com timer0.write(pkt, daddr); 1307584SAli.Saidi@arm.com else if ((daddr - Timer::Size) < Timer::Size) 1317584SAli.Saidi@arm.com timer1.write(pkt, daddr - Timer::Size); 1327587SAli.Saidi@arm.com else if (!readId(pkt, ambaId, pioAddr)) 1337584SAli.Saidi@arm.com panic("Tried to write SP804 at offset %#x that doesn't exist\n", daddr); 1347584SAli.Saidi@arm.com pkt->makeAtomicResponse(); 1357584SAli.Saidi@arm.com return pioDelay; 1367584SAli.Saidi@arm.com} 1377584SAli.Saidi@arm.com 1387584SAli.Saidi@arm.comvoid 1397584SAli.Saidi@arm.comSp804::Timer::write(PacketPtr pkt, Addr daddr) 1407584SAli.Saidi@arm.com{ 1417584SAli.Saidi@arm.com DPRINTF(Timer, "Writing to Timer at offset: %#x\n", daddr); 1427584SAli.Saidi@arm.com switch (daddr) { 1437584SAli.Saidi@arm.com case LoadReg: 1447584SAli.Saidi@arm.com loadValue = pkt->get<uint32_t>(); 1457584SAli.Saidi@arm.com restartCounter(loadValue); 1467584SAli.Saidi@arm.com break; 1477584SAli.Saidi@arm.com case CurrentReg: 1487584SAli.Saidi@arm.com // Spec says this value can't be written, but linux writes it anyway 1497584SAli.Saidi@arm.com break; 1507584SAli.Saidi@arm.com case ControlReg: 1517584SAli.Saidi@arm.com bool old_enable; 1527584SAli.Saidi@arm.com old_enable = control.timerEnable; 1537584SAli.Saidi@arm.com control = pkt->get<uint32_t>(); 1547584SAli.Saidi@arm.com if ((old_enable == 0) && control.timerEnable) 1557584SAli.Saidi@arm.com restartCounter(loadValue); 1567584SAli.Saidi@arm.com break; 1577584SAli.Saidi@arm.com case IntClear: 1587584SAli.Saidi@arm.com rawInt = false; 1597584SAli.Saidi@arm.com if (pendingInt) { 1607584SAli.Saidi@arm.com pendingInt = false; 1617584SAli.Saidi@arm.com DPRINTF(Timer, "Clearing interrupt\n"); 1627584SAli.Saidi@arm.com parent->gic->clearInt(intNum); 1637584SAli.Saidi@arm.com } 1647584SAli.Saidi@arm.com break; 1657584SAli.Saidi@arm.com case BGLoad: 1667584SAli.Saidi@arm.com loadValue = pkt->get<uint32_t>(); 1677584SAli.Saidi@arm.com break; 1687584SAli.Saidi@arm.com default: 1697584SAli.Saidi@arm.com panic("Tried to write SP804 timer at offset %#x\n", daddr); 1707584SAli.Saidi@arm.com break; 1717584SAli.Saidi@arm.com } 1727584SAli.Saidi@arm.com} 1737584SAli.Saidi@arm.com 1747584SAli.Saidi@arm.comvoid 1757584SAli.Saidi@arm.comSp804::Timer::restartCounter(uint32_t val) 1767584SAli.Saidi@arm.com{ 1777584SAli.Saidi@arm.com DPRINTF(Timer, "Resetting counter with value %#x\n", val); 1787584SAli.Saidi@arm.com if (!control.timerEnable) 1797584SAli.Saidi@arm.com return; 1807584SAli.Saidi@arm.com 1817584SAli.Saidi@arm.com Tick time = clock << power(16, control.timerPrescale); 1827584SAli.Saidi@arm.com if (control.timerSize) 1837584SAli.Saidi@arm.com time *= bits(val,15,0); 1847584SAli.Saidi@arm.com else 1857584SAli.Saidi@arm.com time *= val; 1867584SAli.Saidi@arm.com 1877584SAli.Saidi@arm.com if (zeroEvent.scheduled()) { 1887584SAli.Saidi@arm.com DPRINTF(Timer, "-- Event was already schedule, de-scheduling\n"); 1897584SAli.Saidi@arm.com parent->deschedule(zeroEvent); 1907584SAli.Saidi@arm.com } 1917584SAli.Saidi@arm.com parent->schedule(zeroEvent, curTick + time); 1927584SAli.Saidi@arm.com DPRINTF(Timer, "-- Scheduling new event for: %d\n", curTick + time); 1937584SAli.Saidi@arm.com} 1947584SAli.Saidi@arm.com 1957584SAli.Saidi@arm.comvoid 1967584SAli.Saidi@arm.comSp804::Timer::counterAtZero() 1977584SAli.Saidi@arm.com{ 1987584SAli.Saidi@arm.com if (!control.timerEnable) 1997584SAli.Saidi@arm.com return; 2007584SAli.Saidi@arm.com 2017584SAli.Saidi@arm.com DPRINTF(Timer, "Counter reached zero\n"); 2027584SAli.Saidi@arm.com 2037584SAli.Saidi@arm.com rawInt = true; 2047584SAli.Saidi@arm.com bool old_pending = pendingInt; 2057584SAli.Saidi@arm.com if (control.intEnable) 2067584SAli.Saidi@arm.com pendingInt = true; 2077584SAli.Saidi@arm.com if (pendingInt && ~old_pending) { 2087584SAli.Saidi@arm.com DPRINTF(Timer, "-- Causing interrupt\n"); 2097584SAli.Saidi@arm.com parent->gic->sendInt(intNum); 2107584SAli.Saidi@arm.com } 2117584SAli.Saidi@arm.com 2127584SAli.Saidi@arm.com if (control.oneShot) 2137584SAli.Saidi@arm.com return; 2147584SAli.Saidi@arm.com 2157584SAli.Saidi@arm.com // Free-running 2167584SAli.Saidi@arm.com if (control.timerMode == 0) 2177584SAli.Saidi@arm.com restartCounter(0xffffffff); 2187584SAli.Saidi@arm.com else 2197584SAli.Saidi@arm.com restartCounter(loadValue); 2207584SAli.Saidi@arm.com} 2217584SAli.Saidi@arm.com 2227733SAli.Saidi@ARM.comvoid 2237733SAli.Saidi@ARM.comSp804::Timer::serialize(std::ostream &os) 2247733SAli.Saidi@ARM.com{ 2257733SAli.Saidi@ARM.com DPRINTF(Checkpoint, "Serializing Arm Sp804\n"); 2267733SAli.Saidi@ARM.com SERIALIZE_SCALAR(intNum); 2277733SAli.Saidi@ARM.com SERIALIZE_SCALAR(clock); 2287733SAli.Saidi@ARM.com 2297733SAli.Saidi@ARM.com uint32_t control_serial = control; 2307733SAli.Saidi@ARM.com SERIALIZE_SCALAR(control_serial); 2317733SAli.Saidi@ARM.com 2327733SAli.Saidi@ARM.com SERIALIZE_SCALAR(rawInt); 2337733SAli.Saidi@ARM.com SERIALIZE_SCALAR(pendingInt); 2347733SAli.Saidi@ARM.com SERIALIZE_SCALAR(loadValue); 2357733SAli.Saidi@ARM.com 2367733SAli.Saidi@ARM.com bool is_in_event = zeroEvent.scheduled(); 2377733SAli.Saidi@ARM.com SERIALIZE_SCALAR(is_in_event); 2387733SAli.Saidi@ARM.com 2397733SAli.Saidi@ARM.com Tick event_time; 2407733SAli.Saidi@ARM.com if (is_in_event){ 2417733SAli.Saidi@ARM.com event_time = zeroEvent.when(); 2427733SAli.Saidi@ARM.com SERIALIZE_SCALAR(event_time); 2437733SAli.Saidi@ARM.com } 2447733SAli.Saidi@ARM.com} 2457733SAli.Saidi@ARM.com 2467733SAli.Saidi@ARM.comvoid 2477733SAli.Saidi@ARM.comSp804::Timer::unserialize(Checkpoint *cp, const std::string §ion) 2487733SAli.Saidi@ARM.com{ 2497733SAli.Saidi@ARM.com DPRINTF(Checkpoint, "Unserializing Arm Sp804\n"); 2507733SAli.Saidi@ARM.com 2517733SAli.Saidi@ARM.com UNSERIALIZE_SCALAR(intNum); 2527733SAli.Saidi@ARM.com UNSERIALIZE_SCALAR(clock); 2537733SAli.Saidi@ARM.com 2547733SAli.Saidi@ARM.com uint32_t control_serial; 2557733SAli.Saidi@ARM.com UNSERIALIZE_SCALAR(control_serial); 2567733SAli.Saidi@ARM.com control = control_serial; 2577733SAli.Saidi@ARM.com 2587733SAli.Saidi@ARM.com UNSERIALIZE_SCALAR(rawInt); 2597733SAli.Saidi@ARM.com UNSERIALIZE_SCALAR(pendingInt); 2607733SAli.Saidi@ARM.com UNSERIALIZE_SCALAR(loadValue); 2617733SAli.Saidi@ARM.com 2627733SAli.Saidi@ARM.com bool is_in_event; 2637733SAli.Saidi@ARM.com UNSERIALIZE_SCALAR(is_in_event); 2647733SAli.Saidi@ARM.com 2657733SAli.Saidi@ARM.com Tick event_time; 2667733SAli.Saidi@ARM.com if (is_in_event){ 2677733SAli.Saidi@ARM.com UNSERIALIZE_SCALAR(event_time); 2687733SAli.Saidi@ARM.com parent->schedule(zeroEvent, event_time); 2697733SAli.Saidi@ARM.com } 2707733SAli.Saidi@ARM.com} 2717733SAli.Saidi@ARM.com 2727733SAli.Saidi@ARM.com 2737584SAli.Saidi@arm.com 2747584SAli.Saidi@arm.comvoid 2757584SAli.Saidi@arm.comSp804::serialize(std::ostream &os) 2767584SAli.Saidi@arm.com{ 2777733SAli.Saidi@ARM.com nameOut(os, csprintf("%s.timer0", name())); 2787733SAli.Saidi@ARM.com timer0.serialize(os); 2797733SAli.Saidi@ARM.com nameOut(os, csprintf("%s.timer1", name())); 2807733SAli.Saidi@ARM.com timer1.serialize(os); 2817584SAli.Saidi@arm.com} 2827584SAli.Saidi@arm.com 2837584SAli.Saidi@arm.comvoid 2847584SAli.Saidi@arm.comSp804::unserialize(Checkpoint *cp, const std::string §ion) 2857584SAli.Saidi@arm.com{ 2867733SAli.Saidi@ARM.com timer0.unserialize(cp, csprintf("%s.timer0", section)); 2877733SAli.Saidi@ARM.com timer1.unserialize(cp, csprintf("%s.timer1", section)); 2887584SAli.Saidi@arm.com} 2897584SAli.Saidi@arm.com 2907584SAli.Saidi@arm.comSp804 * 2917584SAli.Saidi@arm.comSp804Params::create() 2927584SAli.Saidi@arm.com{ 2937584SAli.Saidi@arm.com return new Sp804(this); 2947584SAli.Saidi@arm.com} 295