kmi.cc revision 11793
1/* 2 * Copyright (c) 2010 ARM Limited 3 * All rights reserved 4 * 5 * The license below extends only to copyright in the software and shall 6 * not be construed as granting a license to any other intellectual 7 * property including but not limited to intellectual property relating 8 * to a hardware implementation of the functionality of the software 9 * licensed hereunder. You may use the software subject to the license 10 * terms below provided that you ensure that this notice is replicated 11 * unmodified and in its entirety in all distributions of the software, 12 * modified or unmodified, in source code or in binary form. 13 * 14 * Copyright (c) 2005 The Regents of The University of Michigan 15 * All rights reserved. 16 * 17 * Redistribution and use in source and binary forms, with or without 18 * modification, are permitted provided that the following conditions are 19 * met: redistributions of source code must retain the above copyright 20 * notice, this list of conditions and the following disclaimer; 21 * redistributions in binary form must reproduce the above copyright 22 * notice, this list of conditions and the following disclaimer in the 23 * documentation and/or other materials provided with the distribution; 24 * neither the name of the copyright holders nor the names of its 25 * contributors may be used to endorse or promote products derived from 26 * this software without specific prior written permission. 27 * 28 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 29 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 30 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 31 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT 32 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 33 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 34 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 35 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 36 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 37 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE 38 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 39 * 40 * Authors: Ali Saidi 41 * William Wang 42 */ 43 44#include "dev/arm/kmi.hh" 45 46#include "base/trace.hh" 47#include "base/vnc/vncinput.hh" 48#include "debug/Pl050.hh" 49#include "dev/arm/amba_device.hh" 50#include "dev/ps2.hh" 51#include "mem/packet.hh" 52#include "mem/packet_access.hh" 53 54Pl050::Pl050(const Params *p) 55 : AmbaIntDevice(p, 0xfff), control(0), status(0x43), clkdiv(0), 56 interrupts(0), rawInterrupts(0), ackNext(false), shiftDown(false), 57 vnc(p->vnc), driverInitialized(false), intEvent(this) 58{ 59 if (vnc) { 60 if (!p->is_mouse) 61 vnc->setKeyboard(this); 62 else 63 vnc->setMouse(this); 64 } 65} 66 67Tick 68Pl050::read(PacketPtr pkt) 69{ 70 assert(pkt->getAddr() >= pioAddr && pkt->getAddr() < pioAddr + pioSize); 71 72 Addr daddr = pkt->getAddr() - pioAddr; 73 74 uint32_t data = 0; 75 76 switch (daddr) { 77 case kmiCr: 78 DPRINTF(Pl050, "Read Commmand: %#x\n", (uint32_t)control); 79 data = control; 80 break; 81 case kmiStat: 82 if (rxQueue.empty()) 83 status.rxfull = 0; 84 else 85 status.rxfull = 1; 86 87 DPRINTF(Pl050, "Read Status: %#x\n", (uint32_t)status); 88 data = status; 89 break; 90 case kmiData: 91 if (rxQueue.empty()) { 92 data = 0; 93 } else { 94 data = rxQueue.front(); 95 rxQueue.pop_front(); 96 } 97 DPRINTF(Pl050, "Read Data: %#x\n", (uint32_t)data); 98 updateIntStatus(); 99 break; 100 case kmiClkDiv: 101 data = clkdiv; 102 break; 103 case kmiISR: 104 data = interrupts; 105 DPRINTF(Pl050, "Read Interrupts: %#x\n", (uint32_t)interrupts); 106 break; 107 default: 108 if (readId(pkt, ambaId, pioAddr)) { 109 // Hack for variable size accesses 110 data = pkt->get<uint32_t>(); 111 break; 112 } 113 114 warn("Tried to read PL050 at offset %#x that doesn't exist\n", daddr); 115 break; 116 } 117 118 switch(pkt->getSize()) { 119 case 1: 120 pkt->set<uint8_t>(data); 121 break; 122 case 2: 123 pkt->set<uint16_t>(data); 124 break; 125 case 4: 126 pkt->set<uint32_t>(data); 127 break; 128 default: 129 panic("KMI read size too big?\n"); 130 break; 131 } 132 133 pkt->makeAtomicResponse(); 134 return pioDelay; 135} 136 137Tick 138Pl050::write(PacketPtr pkt) 139{ 140 141 assert(pkt->getAddr() >= pioAddr && pkt->getAddr() < pioAddr + pioSize); 142 143 Addr daddr = pkt->getAddr() - pioAddr; 144 145 assert(pkt->getSize() == sizeof(uint8_t)); 146 147 148 switch (daddr) { 149 case kmiCr: 150 DPRINTF(Pl050, "Write Commmand: %#x\n", (uint32_t)pkt->get<uint8_t>()); 151 control = pkt->get<uint8_t>(); 152 updateIntStatus(); 153 break; 154 case kmiData: 155 DPRINTF(Pl050, "Write Data: %#x\n", (uint32_t)pkt->get<uint8_t>()); 156 processCommand(pkt->get<uint8_t>()); 157 updateIntStatus(); 158 break; 159 case kmiClkDiv: 160 clkdiv = pkt->get<uint8_t>(); 161 break; 162 default: 163 warn("Tried to write PL050 at offset %#x that doesn't exist\n", daddr); 164 break; 165 } 166 pkt->makeAtomicResponse(); 167 return pioDelay; 168} 169 170void 171Pl050::processCommand(uint8_t byte) 172{ 173 using namespace Ps2; 174 175 if (ackNext) { 176 ackNext--; 177 rxQueue.push_back(Ack); 178 updateIntStatus(); 179 return; 180 } 181 182 switch (byte) { 183 case Ps2Reset: 184 rxQueue.push_back(Ack); 185 rxQueue.push_back(SelfTestPass); 186 break; 187 case SetResolution: 188 case SetRate: 189 case SetStatusLed: 190 case SetScaling1_1: 191 case SetScaling1_2: 192 rxQueue.push_back(Ack); 193 ackNext = 1; 194 break; 195 case ReadId: 196 rxQueue.push_back(Ack); 197 if (params()->is_mouse) 198 rxQueue.push_back(MouseId); 199 else 200 rxQueue.push_back(KeyboardId); 201 break; 202 case TpReadId: 203 if (!params()->is_mouse) 204 break; 205 // We're not a trackpoint device, this should make the probe go away 206 rxQueue.push_back(Ack); 207 rxQueue.push_back(0); 208 rxQueue.push_back(0); 209 // fall through 210 case Disable: 211 case Enable: 212 case SetDefaults: 213 rxQueue.push_back(Ack); 214 break; 215 case StatusRequest: 216 rxQueue.push_back(Ack); 217 rxQueue.push_back(0); 218 rxQueue.push_back(2); // default resolution 219 rxQueue.push_back(100); // default sample rate 220 break; 221 case TouchKitId: 222 ackNext = 2; 223 rxQueue.push_back(Ack); 224 rxQueue.push_back(TouchKitId); 225 rxQueue.push_back(1); 226 rxQueue.push_back('A'); 227 228 driverInitialized = true; 229 break; 230 default: 231 panic("Unknown byte received: %d\n", byte); 232 } 233 234 updateIntStatus(); 235} 236 237 238void 239Pl050::updateIntStatus() 240{ 241 if (!rxQueue.empty()) 242 rawInterrupts.rx = 1; 243 else 244 rawInterrupts.rx = 0; 245 246 interrupts.tx = rawInterrupts.tx & control.txint_enable; 247 interrupts.rx = rawInterrupts.rx & control.rxint_enable; 248 249 DPRINTF(Pl050, "rawInterupts=%#x control=%#x interrupts=%#x\n", 250 (uint32_t)rawInterrupts, (uint32_t)control, (uint32_t)interrupts); 251 252 if (interrupts && !intEvent.scheduled()) 253 schedule(intEvent, curTick() + intDelay); 254} 255 256void 257Pl050::generateInterrupt() 258{ 259 260 if (interrupts) { 261 gic->sendInt(intNum); 262 DPRINTF(Pl050, "Generated interrupt\n"); 263 } 264} 265 266void 267Pl050::mouseAt(uint16_t x, uint16_t y, uint8_t buttons) 268{ 269 using namespace Ps2; 270 271 // If the driver hasn't initialized the device yet, no need to try and send 272 // it anything. Similarly we can get vnc mouse events orders of maginture 273 // faster than m5 can process them. Only queue up two sets mouse movements 274 // and don't add more until those are processed. 275 if (!driverInitialized || rxQueue.size() > 10) 276 return; 277 278 // We shouldn't be here unless a vnc server called us in which case 279 // we should have a pointer to it 280 assert(vnc); 281 282 // Convert screen coordinates to touchpad coordinates 283 uint16_t _x = (2047.0/vnc->videoWidth()) * x; 284 uint16_t _y = (2047.0/vnc->videoHeight()) * y; 285 286 rxQueue.push_back(buttons); 287 rxQueue.push_back(_x >> 7); 288 rxQueue.push_back(_x & 0x7f); 289 rxQueue.push_back(_y >> 7); 290 rxQueue.push_back(_y & 0x7f); 291 292 updateIntStatus(); 293} 294 295 296void 297Pl050::keyPress(uint32_t key, bool down) 298{ 299 using namespace Ps2; 300 301 std::list<uint8_t> keys; 302 303 // convert the X11 keysym into ps2 codes 304 keySymToPs2(key, down, shiftDown, keys); 305 306 // Insert into our queue of charecters 307 rxQueue.splice(rxQueue.end(), keys); 308 updateIntStatus(); 309} 310 311void 312Pl050::serialize(CheckpointOut &cp) const 313{ 314 uint8_t ctrlreg = control; 315 SERIALIZE_SCALAR(ctrlreg); 316 317 uint8_t stsreg = status; 318 SERIALIZE_SCALAR(stsreg); 319 SERIALIZE_SCALAR(clkdiv); 320 321 uint8_t ints = interrupts; 322 SERIALIZE_SCALAR(ints); 323 324 uint8_t raw_ints = rawInterrupts; 325 SERIALIZE_SCALAR(raw_ints); 326 327 SERIALIZE_SCALAR(ackNext); 328 SERIALIZE_SCALAR(shiftDown); 329 SERIALIZE_SCALAR(driverInitialized); 330 331 SERIALIZE_CONTAINER(rxQueue); 332} 333 334void 335Pl050::unserialize(CheckpointIn &cp) 336{ 337 uint8_t ctrlreg; 338 UNSERIALIZE_SCALAR(ctrlreg); 339 control = ctrlreg; 340 341 uint8_t stsreg; 342 UNSERIALIZE_SCALAR(stsreg); 343 status = stsreg; 344 345 UNSERIALIZE_SCALAR(clkdiv); 346 347 uint8_t ints; 348 UNSERIALIZE_SCALAR(ints); 349 interrupts = ints; 350 351 uint8_t raw_ints; 352 UNSERIALIZE_SCALAR(raw_ints); 353 rawInterrupts = raw_ints; 354 355 UNSERIALIZE_SCALAR(ackNext); 356 UNSERIALIZE_SCALAR(shiftDown); 357 UNSERIALIZE_SCALAR(driverInitialized); 358 359 UNSERIALIZE_CONTAINER(rxQueue); 360} 361 362 363 364Pl050 * 365Pl050Params::create() 366{ 367 return new Pl050(this); 368} 369