kmi.cc revision 12659
17754SWilliam.Wang@arm.com/* 212659Sandreas.sandberg@arm.com * Copyright (c) 2010, 2017-2018 ARM Limited 37754SWilliam.Wang@arm.com * All rights reserved 47754SWilliam.Wang@arm.com * 57754SWilliam.Wang@arm.com * The license below extends only to copyright in the software and shall 67754SWilliam.Wang@arm.com * not be construed as granting a license to any other intellectual 77754SWilliam.Wang@arm.com * property including but not limited to intellectual property relating 87754SWilliam.Wang@arm.com * to a hardware implementation of the functionality of the software 97754SWilliam.Wang@arm.com * licensed hereunder. You may use the software subject to the license 107754SWilliam.Wang@arm.com * terms below provided that you ensure that this notice is replicated 117754SWilliam.Wang@arm.com * unmodified and in its entirety in all distributions of the software, 127754SWilliam.Wang@arm.com * modified or unmodified, in source code or in binary form. 137754SWilliam.Wang@arm.com * 147754SWilliam.Wang@arm.com * Copyright (c) 2005 The Regents of The University of Michigan 157754SWilliam.Wang@arm.com * All rights reserved. 167754SWilliam.Wang@arm.com * 177754SWilliam.Wang@arm.com * Redistribution and use in source and binary forms, with or without 187754SWilliam.Wang@arm.com * modification, are permitted provided that the following conditions are 197754SWilliam.Wang@arm.com * met: redistributions of source code must retain the above copyright 207754SWilliam.Wang@arm.com * notice, this list of conditions and the following disclaimer; 217754SWilliam.Wang@arm.com * redistributions in binary form must reproduce the above copyright 227754SWilliam.Wang@arm.com * notice, this list of conditions and the following disclaimer in the 237754SWilliam.Wang@arm.com * documentation and/or other materials provided with the distribution; 247754SWilliam.Wang@arm.com * neither the name of the copyright holders nor the names of its 257754SWilliam.Wang@arm.com * contributors may be used to endorse or promote products derived from 267754SWilliam.Wang@arm.com * this software without specific prior written permission. 277754SWilliam.Wang@arm.com * 287754SWilliam.Wang@arm.com * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 297754SWilliam.Wang@arm.com * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 307754SWilliam.Wang@arm.com * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 317754SWilliam.Wang@arm.com * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT 327754SWilliam.Wang@arm.com * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 337754SWilliam.Wang@arm.com * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 347754SWilliam.Wang@arm.com * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 357754SWilliam.Wang@arm.com * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 367754SWilliam.Wang@arm.com * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 377754SWilliam.Wang@arm.com * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE 387754SWilliam.Wang@arm.com * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 397754SWilliam.Wang@arm.com * 407950SAli.Saidi@ARM.com * Authors: Ali Saidi 417950SAli.Saidi@ARM.com * William Wang 427754SWilliam.Wang@arm.com */ 437754SWilliam.Wang@arm.com 4411793Sbrandon.potter@amd.com#include "dev/arm/kmi.hh" 4511793Sbrandon.potter@amd.com 4611793Sbrandon.potter@amd.com#include "base/trace.hh" 479330Schander.sudanthi@arm.com#include "base/vnc/vncinput.hh" 488245Snate@binkert.org#include "debug/Pl050.hh" 497754SWilliam.Wang@arm.com#include "dev/arm/amba_device.hh" 507950SAli.Saidi@ARM.com#include "dev/ps2.hh" 5112659Sandreas.sandberg@arm.com#include "dev/ps2/device.hh" 527754SWilliam.Wang@arm.com#include "mem/packet.hh" 537754SWilliam.Wang@arm.com#include "mem/packet_access.hh" 547754SWilliam.Wang@arm.com 5512659Sandreas.sandberg@arm.comPl050::Pl050(const Pl050Params *p) 569808Sstever@gmail.com : AmbaIntDevice(p, 0xfff), control(0), status(0x43), clkdiv(0), 5712659Sandreas.sandberg@arm.com rawInterrupts(0), 5812659Sandreas.sandberg@arm.com intEvent([this]{ generateInterrupt(); }, name()), 5912659Sandreas.sandberg@arm.com ps2(p->ps2) 607754SWilliam.Wang@arm.com{ 6112659Sandreas.sandberg@arm.com ps2->hostRegDataAvailable([this]() { this->updateIntStatus(); }); 627754SWilliam.Wang@arm.com} 637754SWilliam.Wang@arm.com 647754SWilliam.Wang@arm.comTick 657754SWilliam.Wang@arm.comPl050::read(PacketPtr pkt) 667754SWilliam.Wang@arm.com{ 677754SWilliam.Wang@arm.com assert(pkt->getAddr() >= pioAddr && pkt->getAddr() < pioAddr + pioSize); 687754SWilliam.Wang@arm.com 697754SWilliam.Wang@arm.com Addr daddr = pkt->getAddr() - pioAddr; 707754SWilliam.Wang@arm.com 717754SWilliam.Wang@arm.com uint32_t data = 0; 727754SWilliam.Wang@arm.com 737754SWilliam.Wang@arm.com switch (daddr) { 747754SWilliam.Wang@arm.com case kmiCr: 757950SAli.Saidi@ARM.com DPRINTF(Pl050, "Read Commmand: %#x\n", (uint32_t)control); 767754SWilliam.Wang@arm.com data = control; 777754SWilliam.Wang@arm.com break; 7812659Sandreas.sandberg@arm.com 797754SWilliam.Wang@arm.com case kmiStat: 8012659Sandreas.sandberg@arm.com status.rxfull = ps2->hostDataAvailable() ? 1 : 0; 817950SAli.Saidi@ARM.com DPRINTF(Pl050, "Read Status: %#x\n", (uint32_t)status); 827754SWilliam.Wang@arm.com data = status; 837754SWilliam.Wang@arm.com break; 8412659Sandreas.sandberg@arm.com 857754SWilliam.Wang@arm.com case kmiData: 8612659Sandreas.sandberg@arm.com data = ps2->hostDataAvailable() ? ps2->hostRead() : 0; 877950SAli.Saidi@ARM.com DPRINTF(Pl050, "Read Data: %#x\n", (uint32_t)data); 887950SAli.Saidi@ARM.com updateIntStatus(); 897754SWilliam.Wang@arm.com break; 9012659Sandreas.sandberg@arm.com 917754SWilliam.Wang@arm.com case kmiClkDiv: 927754SWilliam.Wang@arm.com data = clkdiv; 937754SWilliam.Wang@arm.com break; 9412659Sandreas.sandberg@arm.com 957754SWilliam.Wang@arm.com case kmiISR: 9611895Ssudhanshu.jha@arm.com data = getInterrupt(); 9711895Ssudhanshu.jha@arm.com DPRINTF(Pl050, "Read Interrupts: %#x\n", getInterrupt()); 987754SWilliam.Wang@arm.com break; 9912659Sandreas.sandberg@arm.com 1007754SWilliam.Wang@arm.com default: 1019806Sstever@gmail.com if (readId(pkt, ambaId, pioAddr)) { 1027754SWilliam.Wang@arm.com // Hack for variable size accesses 1037754SWilliam.Wang@arm.com data = pkt->get<uint32_t>(); 1047754SWilliam.Wang@arm.com break; 1057754SWilliam.Wang@arm.com } 1067754SWilliam.Wang@arm.com 1077754SWilliam.Wang@arm.com warn("Tried to read PL050 at offset %#x that doesn't exist\n", daddr); 1087754SWilliam.Wang@arm.com break; 1097754SWilliam.Wang@arm.com } 1107754SWilliam.Wang@arm.com 1117754SWilliam.Wang@arm.com switch(pkt->getSize()) { 1127754SWilliam.Wang@arm.com case 1: 1137754SWilliam.Wang@arm.com pkt->set<uint8_t>(data); 1147754SWilliam.Wang@arm.com break; 1157754SWilliam.Wang@arm.com case 2: 1167754SWilliam.Wang@arm.com pkt->set<uint16_t>(data); 1177754SWilliam.Wang@arm.com break; 1187754SWilliam.Wang@arm.com case 4: 1197754SWilliam.Wang@arm.com pkt->set<uint32_t>(data); 1207754SWilliam.Wang@arm.com break; 1217754SWilliam.Wang@arm.com default: 1227754SWilliam.Wang@arm.com panic("KMI read size too big?\n"); 1237754SWilliam.Wang@arm.com break; 1247754SWilliam.Wang@arm.com } 1257754SWilliam.Wang@arm.com 1267754SWilliam.Wang@arm.com pkt->makeAtomicResponse(); 1277754SWilliam.Wang@arm.com return pioDelay; 1287754SWilliam.Wang@arm.com} 1297754SWilliam.Wang@arm.com 1307754SWilliam.Wang@arm.comTick 1317754SWilliam.Wang@arm.comPl050::write(PacketPtr pkt) 1327754SWilliam.Wang@arm.com{ 1337754SWilliam.Wang@arm.com 1347754SWilliam.Wang@arm.com assert(pkt->getAddr() >= pioAddr && pkt->getAddr() < pioAddr + pioSize); 1357754SWilliam.Wang@arm.com 1367754SWilliam.Wang@arm.com Addr daddr = pkt->getAddr() - pioAddr; 1377754SWilliam.Wang@arm.com 1387950SAli.Saidi@ARM.com assert(pkt->getSize() == sizeof(uint8_t)); 1397754SWilliam.Wang@arm.com 1407754SWilliam.Wang@arm.com 1417754SWilliam.Wang@arm.com switch (daddr) { 1427754SWilliam.Wang@arm.com case kmiCr: 1437950SAli.Saidi@ARM.com DPRINTF(Pl050, "Write Commmand: %#x\n", (uint32_t)pkt->get<uint8_t>()); 1447950SAli.Saidi@ARM.com control = pkt->get<uint8_t>(); 1457950SAli.Saidi@ARM.com updateIntStatus(); 1467754SWilliam.Wang@arm.com break; 14712659Sandreas.sandberg@arm.com 1487754SWilliam.Wang@arm.com case kmiData: 1497950SAli.Saidi@ARM.com DPRINTF(Pl050, "Write Data: %#x\n", (uint32_t)pkt->get<uint8_t>()); 15012659Sandreas.sandberg@arm.com ps2->hostWrite(pkt->get<uint8_t>()); 1517950SAli.Saidi@ARM.com updateIntStatus(); 1527754SWilliam.Wang@arm.com break; 15312659Sandreas.sandberg@arm.com 1547754SWilliam.Wang@arm.com case kmiClkDiv: 1557950SAli.Saidi@ARM.com clkdiv = pkt->get<uint8_t>(); 1567754SWilliam.Wang@arm.com break; 15712659Sandreas.sandberg@arm.com 1587754SWilliam.Wang@arm.com default: 1597754SWilliam.Wang@arm.com warn("Tried to write PL050 at offset %#x that doesn't exist\n", daddr); 1607754SWilliam.Wang@arm.com break; 1617754SWilliam.Wang@arm.com } 16212659Sandreas.sandberg@arm.com 1637754SWilliam.Wang@arm.com pkt->makeAtomicResponse(); 1647754SWilliam.Wang@arm.com return pioDelay; 1657754SWilliam.Wang@arm.com} 1667754SWilliam.Wang@arm.com 1677950SAli.Saidi@ARM.com 1687950SAli.Saidi@ARM.comvoid 1697950SAli.Saidi@ARM.comPl050::updateIntStatus() 1707950SAli.Saidi@ARM.com{ 17111895Ssudhanshu.jha@arm.com const bool old_interrupt(getInterrupt()); 17211895Ssudhanshu.jha@arm.com 17312659Sandreas.sandberg@arm.com rawInterrupts.rx = ps2->hostDataAvailable() ? 1 : 0; 1747950SAli.Saidi@ARM.com 17511895Ssudhanshu.jha@arm.com if ((!old_interrupt && getInterrupt()) && !intEvent.scheduled()) { 1767950SAli.Saidi@ARM.com schedule(intEvent, curTick() + intDelay); 17711895Ssudhanshu.jha@arm.com } else if (old_interrupt && !(getInterrupt())) { 17811895Ssudhanshu.jha@arm.com gic->clearInt(intNum); 17911895Ssudhanshu.jha@arm.com } 1807950SAli.Saidi@ARM.com} 1817950SAli.Saidi@ARM.com 18212659Sandreas.sandberg@arm.comPl050::InterruptReg 18312659Sandreas.sandberg@arm.comPl050::getInterrupt() const 18412659Sandreas.sandberg@arm.com{ 18512659Sandreas.sandberg@arm.com InterruptReg tmp_interrupt(0); 18612659Sandreas.sandberg@arm.com 18712659Sandreas.sandberg@arm.com tmp_interrupt.tx = rawInterrupts.tx & control.txint_enable; 18812659Sandreas.sandberg@arm.com tmp_interrupt.rx = rawInterrupts.rx & control.rxint_enable; 18912659Sandreas.sandberg@arm.com 19012659Sandreas.sandberg@arm.com return tmp_interrupt; 19112659Sandreas.sandberg@arm.com} 19212659Sandreas.sandberg@arm.com 1937950SAli.Saidi@ARM.comvoid 1947754SWilliam.Wang@arm.comPl050::generateInterrupt() 1957754SWilliam.Wang@arm.com{ 19611895Ssudhanshu.jha@arm.com DPRINTF(Pl050, "Generate Interrupt: rawInt=%#x ctrl=%#x int=%#x\n", 19711895Ssudhanshu.jha@arm.com rawInterrupts, control, getInterrupt()); 1987950SAli.Saidi@ARM.com 19911895Ssudhanshu.jha@arm.com if (getInterrupt()) { 2007754SWilliam.Wang@arm.com gic->sendInt(intNum); 20111895Ssudhanshu.jha@arm.com DPRINTF(Pl050, " -- Generated\n"); 2027754SWilliam.Wang@arm.com } 2037754SWilliam.Wang@arm.com} 2047754SWilliam.Wang@arm.com 2057950SAli.Saidi@ARM.comvoid 20610905Sandreas.sandberg@arm.comPl050::serialize(CheckpointOut &cp) const 2077950SAli.Saidi@ARM.com{ 2087950SAli.Saidi@ARM.com uint8_t ctrlreg = control; 2097950SAli.Saidi@ARM.com SERIALIZE_SCALAR(ctrlreg); 2107950SAli.Saidi@ARM.com 2117950SAli.Saidi@ARM.com uint8_t stsreg = status; 2127950SAli.Saidi@ARM.com SERIALIZE_SCALAR(stsreg); 2137950SAli.Saidi@ARM.com SERIALIZE_SCALAR(clkdiv); 2147950SAli.Saidi@ARM.com 2157950SAli.Saidi@ARM.com uint8_t raw_ints = rawInterrupts; 2167950SAli.Saidi@ARM.com SERIALIZE_SCALAR(raw_ints); 2177950SAli.Saidi@ARM.com} 2187950SAli.Saidi@ARM.com 2197950SAli.Saidi@ARM.comvoid 22010905Sandreas.sandberg@arm.comPl050::unserialize(CheckpointIn &cp) 2217950SAli.Saidi@ARM.com{ 2227950SAli.Saidi@ARM.com uint8_t ctrlreg; 2237950SAli.Saidi@ARM.com UNSERIALIZE_SCALAR(ctrlreg); 2247950SAli.Saidi@ARM.com control = ctrlreg; 2257950SAli.Saidi@ARM.com 2267950SAli.Saidi@ARM.com uint8_t stsreg; 2277950SAli.Saidi@ARM.com UNSERIALIZE_SCALAR(stsreg); 2287950SAli.Saidi@ARM.com status = stsreg; 2297950SAli.Saidi@ARM.com 2307950SAli.Saidi@ARM.com UNSERIALIZE_SCALAR(clkdiv); 2317950SAli.Saidi@ARM.com 2327950SAli.Saidi@ARM.com uint8_t raw_ints; 2337950SAli.Saidi@ARM.com UNSERIALIZE_SCALAR(raw_ints); 2347950SAli.Saidi@ARM.com rawInterrupts = raw_ints; 2357950SAli.Saidi@ARM.com} 2367950SAli.Saidi@ARM.com 2377754SWilliam.Wang@arm.comPl050 * 2387754SWilliam.Wang@arm.comPl050Params::create() 2397754SWilliam.Wang@arm.com{ 2407754SWilliam.Wang@arm.com return new Pl050(this); 2417754SWilliam.Wang@arm.com} 242