1/* 2 * Copyright (c) 2008 The Regents of The University of Michigan 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions are 7 * met: redistributions of source code must retain the above copyright 8 * notice, this list of conditions and the following disclaimer; 9 * redistributions in binary form must reproduce the above copyright 10 * notice, this list of conditions and the following disclaimer in the 11 * documentation and/or other materials provided with the distribution; 12 * neither the name of the copyright holders nor the names of its 13 * contributors may be used to endorse or promote products derived from 14 * this software without specific prior written permission. 15 * 16 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 17 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 18 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 19 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT 20 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 21 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 22 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 23 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 24 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 25 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE 26 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 27 * 28 * Authors: Gabe Black 29 */ 30 31#include "dev/x86/i8042.hh" 32 33#include "base/bitunion.hh" 34#include "debug/I8042.hh" 35#include "mem/packet.hh" 36#include "mem/packet_access.hh" 37
| 1/* 2 * Copyright (c) 2008 The Regents of The University of Michigan 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions are 7 * met: redistributions of source code must retain the above copyright 8 * notice, this list of conditions and the following disclaimer; 9 * redistributions in binary form must reproduce the above copyright 10 * notice, this list of conditions and the following disclaimer in the 11 * documentation and/or other materials provided with the distribution; 12 * neither the name of the copyright holders nor the names of its 13 * contributors may be used to endorse or promote products derived from 14 * this software without specific prior written permission. 15 * 16 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 17 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 18 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 19 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT 20 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 21 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 22 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 23 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 24 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 25 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE 26 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 27 * 28 * Authors: Gabe Black 29 */ 30 31#include "dev/x86/i8042.hh" 32 33#include "base/bitunion.hh" 34#include "debug/I8042.hh" 35#include "mem/packet.hh" 36#include "mem/packet_access.hh" 37
|
38// The 8042 has a whopping 32 bytes of internal RAM. 39const uint8_t RamSize = 32; 40const uint8_t NumOutputBits = 14; 41const uint8_t X86ISA::PS2Keyboard::ID[] = {0xab, 0x83}; 42const uint8_t X86ISA::PS2Mouse::ID[] = {0x00}; 43const uint8_t CommandAck = 0xfa; 44const uint8_t CommandNack = 0xfe; 45const uint8_t BatSuccessful = 0xaa; 46 47 48X86ISA::I8042::I8042(Params *p) 49 : BasicPioDevice(p, 0), // pioSize arg is dummy value... not used 50 latency(p->pio_latency), 51 dataPort(p->data_port), commandPort(p->command_port), 52 statusReg(0), commandByte(0), dataReg(0), lastCommand(NoCommand), 53 mouseIntPin(p->mouse_int_pin), keyboardIntPin(p->keyboard_int_pin) 54{ 55 statusReg.passedSelfTest = 1; 56 statusReg.commandLast = 1; 57 statusReg.keyboardUnlocked = 1; 58 59 commandByte.convertScanCodes = 1; 60 commandByte.passedSelfTest = 1; 61 commandByte.keyboardFullInt = 1; 62} 63 64 65AddrRangeList 66X86ISA::I8042::getAddrRanges() const 67{ 68 AddrRangeList ranges; 69 // TODO: Are these really supposed to be a single byte and not 4? 70 ranges.push_back(RangeSize(dataPort, 1)); 71 ranges.push_back(RangeSize(commandPort, 1)); 72 return ranges; 73} 74 75void 76X86ISA::I8042::writeData(uint8_t newData, bool mouse) 77{ 78 DPRINTF(I8042, "Set data %#02x.\n", newData); 79 dataReg = newData; 80 statusReg.outputFull = 1; 81 statusReg.mouseOutputFull = (mouse ? 1 : 0); 82 if (!mouse && commandByte.keyboardFullInt) { 83 DPRINTF(I8042, "Sending keyboard interrupt.\n"); 84 keyboardIntPin->raise(); 85 //This is a hack 86 keyboardIntPin->lower(); 87 } else if (mouse && commandByte.mouseFullInt) { 88 DPRINTF(I8042, "Sending mouse interrupt.\n"); 89 mouseIntPin->raise(); 90 //This is a hack 91 mouseIntPin->lower(); 92 } 93} 94 95void 96X86ISA::PS2Device::serialize(const std::string &base, CheckpointOut &cp) const 97{ 98 paramOut(cp, base + ".lastCommand", lastCommand); 99 100 std::vector<uint8_t> buffer(outBuffer.size()); 101 std::copy(outBuffer.begin(), outBuffer.end(), buffer.begin()); 102 arrayParamOut(cp, base + ".outBuffer.elts", buffer); 103} 104 105void 106X86ISA::PS2Device::unserialize(const std::string &base, CheckpointIn &cp) 107{ 108 paramIn(cp, base + ".lastCommand", lastCommand); 109 110 std::vector<uint8_t> buffer; 111 arrayParamIn(cp, base + ".outBuffer.elts", buffer); 112 assert(outBuffer.empty()); 113 for (auto c : buffer) 114 outBuffer.push_back(c); 115} 116 117 118void 119X86ISA::PS2Device::ack() 120{ 121 bufferData(&CommandAck, sizeof(CommandAck)); 122} 123 124void 125X86ISA::PS2Device::nack() 126{ 127 bufferData(&CommandNack, sizeof(CommandNack)); 128} 129 130void 131X86ISA::PS2Device::bufferData(const uint8_t *data, int size) 132{ 133 assert(data || size == 0); 134 while (size) { 135 outBuffer.push_back(*(data++)); 136 size--; 137 } 138} 139 140uint8_t 141X86ISA::I8042::readDataOut() 142{ 143 uint8_t data = dataReg; 144 statusReg.outputFull = 0; 145 statusReg.mouseOutputFull = 0; 146 if (keyboard.hasData()) { 147 writeData(keyboard.getData(), false); 148 } else if (mouse.hasData()) { 149 writeData(mouse.getData(), true); 150 } 151 return data; 152} 153 154bool 155X86ISA::PS2Keyboard::processData(uint8_t data) 156{ 157 if (lastCommand != NoCommand) { 158 switch (lastCommand) { 159 case LEDWrite: 160 DPRINTF(I8042, "Setting LEDs: " 161 "caps lock %s, num lock %s, scroll lock %s\n", 162 bits(data, 2) ? "on" : "off", 163 bits(data, 1) ? "on" : "off", 164 bits(data, 0) ? "on" : "off"); 165 ack(); 166 lastCommand = NoCommand; 167 break; 168 case TypematicInfo: 169 DPRINTF(I8042, "Setting typematic info to %#02x.\n", data); 170 ack(); 171 lastCommand = NoCommand; 172 break; 173 } 174 return hasData(); 175 } 176 switch (data) { 177 case LEDWrite: 178 DPRINTF(I8042, "Got LED write command.\n"); 179 ack(); 180 lastCommand = LEDWrite; 181 break; 182 case DiagnosticEcho: 183 panic("Keyboard diagnostic echo unimplemented.\n"); 184 case AlternateScanCodes: 185 panic("Accessing alternate scan codes unimplemented.\n"); 186 case ReadID: 187 DPRINTF(I8042, "Got keyboard read ID command.\n"); 188 ack(); 189 bufferData((uint8_t *)&ID, sizeof(ID)); 190 break; 191 case TypematicInfo: 192 DPRINTF(I8042, "Setting typematic info.\n"); 193 ack(); 194 lastCommand = TypematicInfo; 195 break; 196 case Enable: 197 DPRINTF(I8042, "Enabling the keyboard.\n"); 198 ack(); 199 break; 200 case Disable: 201 DPRINTF(I8042, "Disabling the keyboard.\n"); 202 ack(); 203 break; 204 case DefaultsAndDisable: 205 DPRINTF(I8042, "Disabling and resetting the keyboard.\n"); 206 ack(); 207 break; 208 case AllKeysToTypematic: 209 panic("Setting all keys to typemantic unimplemented.\n"); 210 case AllKeysToMakeRelease: 211 panic("Setting all keys to make/release unimplemented.\n"); 212 case AllKeysToMake: 213 panic("Setting all keys to make unimplemented.\n"); 214 case AllKeysToTypematicMakeRelease: 215 panic("Setting all keys to " 216 "typematic/make/release unimplemented.\n"); 217 case KeyToTypematic: 218 panic("Setting a key to typematic unimplemented.\n"); 219 case KeyToMakeRelease: 220 panic("Setting a key to make/release unimplemented.\n"); 221 case KeyToMakeOnly: 222 panic("Setting key to make only unimplemented.\n"); 223 case Resend: 224 panic("Keyboard resend unimplemented.\n"); 225 case Reset: 226 panic("Keyboard reset unimplemented.\n"); 227 default: 228 panic("Unknown keyboard command %#02x.\n", data); 229 } 230 return hasData(); 231} 232 233bool 234X86ISA::PS2Mouse::processData(uint8_t data) 235{ 236 if (lastCommand != NoCommand) { 237 switch(lastCommand) { 238 case SetResolution: 239 DPRINTF(I8042, "Mouse resolution set to %d.\n", data); 240 resolution = data; 241 ack(); 242 lastCommand = NoCommand; 243 break; 244 case SampleRate: 245 DPRINTF(I8042, "Mouse sample rate %d samples " 246 "per second.\n", data); 247 sampleRate = data; 248 ack(); 249 lastCommand = NoCommand; 250 break; 251 default: 252 panic("Not expecting data for a mouse command.\n"); 253 } 254 return hasData(); 255 } 256 switch (data) { 257 case Scale1to1: 258 DPRINTF(I8042, "Setting mouse scale to 1:1.\n"); 259 status.twoToOne = 0; 260 ack(); 261 break; 262 case Scale2to1: 263 DPRINTF(I8042, "Setting mouse scale to 2:1.\n"); 264 status.twoToOne = 1; 265 ack(); 266 break; 267 case SetResolution: 268 DPRINTF(I8042, "Setting mouse resolution.\n"); 269 lastCommand = SetResolution; 270 ack(); 271 break; 272 case GetStatus: 273 DPRINTF(I8042, "Getting mouse status.\n"); 274 ack(); 275 bufferData((uint8_t *)&(status), 1); 276 bufferData(&resolution, sizeof(resolution)); 277 bufferData(&sampleRate, sizeof(sampleRate)); 278 break; 279 case ReadData: 280 panic("Reading mouse data unimplemented.\n"); 281 case ResetWrapMode: 282 panic("Resetting mouse wrap mode unimplemented.\n"); 283 case WrapMode: 284 panic("Setting mouse wrap mode unimplemented.\n"); 285 case RemoteMode: 286 panic("Setting mouse remote mode unimplemented.\n"); 287 case ReadID: 288 DPRINTF(I8042, "Mouse ID requested.\n"); 289 ack(); 290 bufferData(ID, sizeof(ID)); 291 break; 292 case SampleRate: 293 DPRINTF(I8042, "Setting mouse sample rate.\n"); 294 lastCommand = SampleRate; 295 ack(); 296 break; 297 case DisableReporting: 298 DPRINTF(I8042, "Disabling data reporting.\n"); 299 status.enabled = 0; 300 ack(); 301 break; 302 case EnableReporting: 303 DPRINTF(I8042, "Enabling data reporting.\n"); 304 status.enabled = 1; 305 ack(); 306 break; 307 case DefaultsAndDisable: 308 DPRINTF(I8042, "Disabling and resetting mouse.\n"); 309 sampleRate = 100; 310 resolution = 4; 311 status.twoToOne = 0; 312 status.enabled = 0; 313 ack(); 314 break; 315 case Resend: 316 panic("Mouse resend unimplemented.\n"); 317 case Reset: 318 DPRINTF(I8042, "Resetting the mouse.\n"); 319 sampleRate = 100; 320 resolution = 4; 321 status.twoToOne = 0; 322 status.enabled = 0; 323 ack(); 324 bufferData(&BatSuccessful, sizeof(BatSuccessful)); 325 bufferData(ID, sizeof(ID)); 326 break; 327 default: 328 warn("Unknown mouse command %#02x.\n", data); 329 nack(); 330 break; 331 } 332 return hasData(); 333} 334 335 336Tick 337X86ISA::I8042::read(PacketPtr pkt) 338{ 339 assert(pkt->getSize() == 1); 340 Addr addr = pkt->getAddr(); 341 if (addr == dataPort) { 342 uint8_t data = readDataOut(); 343 //DPRINTF(I8042, "Read from data port got %#02x.\n", data); 344 pkt->set<uint8_t>(data); 345 } else if (addr == commandPort) { 346 //DPRINTF(I8042, "Read status as %#02x.\n", (uint8_t)statusReg); 347 pkt->set<uint8_t>((uint8_t)statusReg); 348 } else { 349 panic("Read from unrecognized port %#x.\n", addr); 350 } 351 pkt->makeAtomicResponse(); 352 return latency; 353} 354 355Tick 356X86ISA::I8042::write(PacketPtr pkt) 357{ 358 assert(pkt->getSize() == 1); 359 Addr addr = pkt->getAddr(); 360 uint8_t data = pkt->get<uint8_t>(); 361 if (addr == dataPort) { 362 statusReg.commandLast = 0; 363 switch (lastCommand) { 364 case NoCommand: 365 if (keyboard.processData(data)) { 366 writeData(keyboard.getData(), false); 367 } 368 break; 369 case WriteToMouse: 370 if (mouse.processData(data)) { 371 writeData(mouse.getData(), true); 372 } 373 break; 374 case WriteCommandByte: 375 commandByte = data; 376 DPRINTF(I8042, "Got data %#02x for \"Write " 377 "command byte\" command.\n", data); 378 statusReg.passedSelfTest = (uint8_t)commandByte.passedSelfTest; 379 break; 380 case WriteMouseOutputBuff: 381 DPRINTF(I8042, "Got data %#02x for \"Write " 382 "mouse output buffer\" command.\n", data); 383 writeData(data, true); 384 break;
| 43// The 8042 has a whopping 32 bytes of internal RAM. 44const uint8_t RamSize = 32; 45const uint8_t NumOutputBits = 14; 46const uint8_t X86ISA::PS2Keyboard::ID[] = {0xab, 0x83}; 47const uint8_t X86ISA::PS2Mouse::ID[] = {0x00}; 48const uint8_t CommandAck = 0xfa; 49const uint8_t CommandNack = 0xfe; 50const uint8_t BatSuccessful = 0xaa; 51 52 53X86ISA::I8042::I8042(Params *p) 54 : BasicPioDevice(p, 0), // pioSize arg is dummy value... not used 55 latency(p->pio_latency), 56 dataPort(p->data_port), commandPort(p->command_port), 57 statusReg(0), commandByte(0), dataReg(0), lastCommand(NoCommand), 58 mouseIntPin(p->mouse_int_pin), keyboardIntPin(p->keyboard_int_pin) 59{ 60 statusReg.passedSelfTest = 1; 61 statusReg.commandLast = 1; 62 statusReg.keyboardUnlocked = 1; 63 64 commandByte.convertScanCodes = 1; 65 commandByte.passedSelfTest = 1; 66 commandByte.keyboardFullInt = 1; 67} 68 69 70AddrRangeList 71X86ISA::I8042::getAddrRanges() const 72{ 73 AddrRangeList ranges; 74 // TODO: Are these really supposed to be a single byte and not 4? 75 ranges.push_back(RangeSize(dataPort, 1)); 76 ranges.push_back(RangeSize(commandPort, 1)); 77 return ranges; 78} 79 80void 81X86ISA::I8042::writeData(uint8_t newData, bool mouse) 82{ 83 DPRINTF(I8042, "Set data %#02x.\n", newData); 84 dataReg = newData; 85 statusReg.outputFull = 1; 86 statusReg.mouseOutputFull = (mouse ? 1 : 0); 87 if (!mouse && commandByte.keyboardFullInt) { 88 DPRINTF(I8042, "Sending keyboard interrupt.\n"); 89 keyboardIntPin->raise(); 90 //This is a hack 91 keyboardIntPin->lower(); 92 } else if (mouse && commandByte.mouseFullInt) { 93 DPRINTF(I8042, "Sending mouse interrupt.\n"); 94 mouseIntPin->raise(); 95 //This is a hack 96 mouseIntPin->lower(); 97 } 98} 99 100void 101X86ISA::PS2Device::serialize(const std::string &base, CheckpointOut &cp) const 102{ 103 paramOut(cp, base + ".lastCommand", lastCommand); 104 105 std::vector<uint8_t> buffer(outBuffer.size()); 106 std::copy(outBuffer.begin(), outBuffer.end(), buffer.begin()); 107 arrayParamOut(cp, base + ".outBuffer.elts", buffer); 108} 109 110void 111X86ISA::PS2Device::unserialize(const std::string &base, CheckpointIn &cp) 112{ 113 paramIn(cp, base + ".lastCommand", lastCommand); 114 115 std::vector<uint8_t> buffer; 116 arrayParamIn(cp, base + ".outBuffer.elts", buffer); 117 assert(outBuffer.empty()); 118 for (auto c : buffer) 119 outBuffer.push_back(c); 120} 121 122 123void 124X86ISA::PS2Device::ack() 125{ 126 bufferData(&CommandAck, sizeof(CommandAck)); 127} 128 129void 130X86ISA::PS2Device::nack() 131{ 132 bufferData(&CommandNack, sizeof(CommandNack)); 133} 134 135void 136X86ISA::PS2Device::bufferData(const uint8_t *data, int size) 137{ 138 assert(data || size == 0); 139 while (size) { 140 outBuffer.push_back(*(data++)); 141 size--; 142 } 143} 144 145uint8_t 146X86ISA::I8042::readDataOut() 147{ 148 uint8_t data = dataReg; 149 statusReg.outputFull = 0; 150 statusReg.mouseOutputFull = 0; 151 if (keyboard.hasData()) { 152 writeData(keyboard.getData(), false); 153 } else if (mouse.hasData()) { 154 writeData(mouse.getData(), true); 155 } 156 return data; 157} 158 159bool 160X86ISA::PS2Keyboard::processData(uint8_t data) 161{ 162 if (lastCommand != NoCommand) { 163 switch (lastCommand) { 164 case LEDWrite: 165 DPRINTF(I8042, "Setting LEDs: " 166 "caps lock %s, num lock %s, scroll lock %s\n", 167 bits(data, 2) ? "on" : "off", 168 bits(data, 1) ? "on" : "off", 169 bits(data, 0) ? "on" : "off"); 170 ack(); 171 lastCommand = NoCommand; 172 break; 173 case TypematicInfo: 174 DPRINTF(I8042, "Setting typematic info to %#02x.\n", data); 175 ack(); 176 lastCommand = NoCommand; 177 break; 178 } 179 return hasData(); 180 } 181 switch (data) { 182 case LEDWrite: 183 DPRINTF(I8042, "Got LED write command.\n"); 184 ack(); 185 lastCommand = LEDWrite; 186 break; 187 case DiagnosticEcho: 188 panic("Keyboard diagnostic echo unimplemented.\n"); 189 case AlternateScanCodes: 190 panic("Accessing alternate scan codes unimplemented.\n"); 191 case ReadID: 192 DPRINTF(I8042, "Got keyboard read ID command.\n"); 193 ack(); 194 bufferData((uint8_t *)&ID, sizeof(ID)); 195 break; 196 case TypematicInfo: 197 DPRINTF(I8042, "Setting typematic info.\n"); 198 ack(); 199 lastCommand = TypematicInfo; 200 break; 201 case Enable: 202 DPRINTF(I8042, "Enabling the keyboard.\n"); 203 ack(); 204 break; 205 case Disable: 206 DPRINTF(I8042, "Disabling the keyboard.\n"); 207 ack(); 208 break; 209 case DefaultsAndDisable: 210 DPRINTF(I8042, "Disabling and resetting the keyboard.\n"); 211 ack(); 212 break; 213 case AllKeysToTypematic: 214 panic("Setting all keys to typemantic unimplemented.\n"); 215 case AllKeysToMakeRelease: 216 panic("Setting all keys to make/release unimplemented.\n"); 217 case AllKeysToMake: 218 panic("Setting all keys to make unimplemented.\n"); 219 case AllKeysToTypematicMakeRelease: 220 panic("Setting all keys to " 221 "typematic/make/release unimplemented.\n"); 222 case KeyToTypematic: 223 panic("Setting a key to typematic unimplemented.\n"); 224 case KeyToMakeRelease: 225 panic("Setting a key to make/release unimplemented.\n"); 226 case KeyToMakeOnly: 227 panic("Setting key to make only unimplemented.\n"); 228 case Resend: 229 panic("Keyboard resend unimplemented.\n"); 230 case Reset: 231 panic("Keyboard reset unimplemented.\n"); 232 default: 233 panic("Unknown keyboard command %#02x.\n", data); 234 } 235 return hasData(); 236} 237 238bool 239X86ISA::PS2Mouse::processData(uint8_t data) 240{ 241 if (lastCommand != NoCommand) { 242 switch(lastCommand) { 243 case SetResolution: 244 DPRINTF(I8042, "Mouse resolution set to %d.\n", data); 245 resolution = data; 246 ack(); 247 lastCommand = NoCommand; 248 break; 249 case SampleRate: 250 DPRINTF(I8042, "Mouse sample rate %d samples " 251 "per second.\n", data); 252 sampleRate = data; 253 ack(); 254 lastCommand = NoCommand; 255 break; 256 default: 257 panic("Not expecting data for a mouse command.\n"); 258 } 259 return hasData(); 260 } 261 switch (data) { 262 case Scale1to1: 263 DPRINTF(I8042, "Setting mouse scale to 1:1.\n"); 264 status.twoToOne = 0; 265 ack(); 266 break; 267 case Scale2to1: 268 DPRINTF(I8042, "Setting mouse scale to 2:1.\n"); 269 status.twoToOne = 1; 270 ack(); 271 break; 272 case SetResolution: 273 DPRINTF(I8042, "Setting mouse resolution.\n"); 274 lastCommand = SetResolution; 275 ack(); 276 break; 277 case GetStatus: 278 DPRINTF(I8042, "Getting mouse status.\n"); 279 ack(); 280 bufferData((uint8_t *)&(status), 1); 281 bufferData(&resolution, sizeof(resolution)); 282 bufferData(&sampleRate, sizeof(sampleRate)); 283 break; 284 case ReadData: 285 panic("Reading mouse data unimplemented.\n"); 286 case ResetWrapMode: 287 panic("Resetting mouse wrap mode unimplemented.\n"); 288 case WrapMode: 289 panic("Setting mouse wrap mode unimplemented.\n"); 290 case RemoteMode: 291 panic("Setting mouse remote mode unimplemented.\n"); 292 case ReadID: 293 DPRINTF(I8042, "Mouse ID requested.\n"); 294 ack(); 295 bufferData(ID, sizeof(ID)); 296 break; 297 case SampleRate: 298 DPRINTF(I8042, "Setting mouse sample rate.\n"); 299 lastCommand = SampleRate; 300 ack(); 301 break; 302 case DisableReporting: 303 DPRINTF(I8042, "Disabling data reporting.\n"); 304 status.enabled = 0; 305 ack(); 306 break; 307 case EnableReporting: 308 DPRINTF(I8042, "Enabling data reporting.\n"); 309 status.enabled = 1; 310 ack(); 311 break; 312 case DefaultsAndDisable: 313 DPRINTF(I8042, "Disabling and resetting mouse.\n"); 314 sampleRate = 100; 315 resolution = 4; 316 status.twoToOne = 0; 317 status.enabled = 0; 318 ack(); 319 break; 320 case Resend: 321 panic("Mouse resend unimplemented.\n"); 322 case Reset: 323 DPRINTF(I8042, "Resetting the mouse.\n"); 324 sampleRate = 100; 325 resolution = 4; 326 status.twoToOne = 0; 327 status.enabled = 0; 328 ack(); 329 bufferData(&BatSuccessful, sizeof(BatSuccessful)); 330 bufferData(ID, sizeof(ID)); 331 break; 332 default: 333 warn("Unknown mouse command %#02x.\n", data); 334 nack(); 335 break; 336 } 337 return hasData(); 338} 339 340 341Tick 342X86ISA::I8042::read(PacketPtr pkt) 343{ 344 assert(pkt->getSize() == 1); 345 Addr addr = pkt->getAddr(); 346 if (addr == dataPort) { 347 uint8_t data = readDataOut(); 348 //DPRINTF(I8042, "Read from data port got %#02x.\n", data); 349 pkt->set<uint8_t>(data); 350 } else if (addr == commandPort) { 351 //DPRINTF(I8042, "Read status as %#02x.\n", (uint8_t)statusReg); 352 pkt->set<uint8_t>((uint8_t)statusReg); 353 } else { 354 panic("Read from unrecognized port %#x.\n", addr); 355 } 356 pkt->makeAtomicResponse(); 357 return latency; 358} 359 360Tick 361X86ISA::I8042::write(PacketPtr pkt) 362{ 363 assert(pkt->getSize() == 1); 364 Addr addr = pkt->getAddr(); 365 uint8_t data = pkt->get<uint8_t>(); 366 if (addr == dataPort) { 367 statusReg.commandLast = 0; 368 switch (lastCommand) { 369 case NoCommand: 370 if (keyboard.processData(data)) { 371 writeData(keyboard.getData(), false); 372 } 373 break; 374 case WriteToMouse: 375 if (mouse.processData(data)) { 376 writeData(mouse.getData(), true); 377 } 378 break; 379 case WriteCommandByte: 380 commandByte = data; 381 DPRINTF(I8042, "Got data %#02x for \"Write " 382 "command byte\" command.\n", data); 383 statusReg.passedSelfTest = (uint8_t)commandByte.passedSelfTest; 384 break; 385 case WriteMouseOutputBuff: 386 DPRINTF(I8042, "Got data %#02x for \"Write " 387 "mouse output buffer\" command.\n", data); 388 writeData(data, true); 389 break;
|
462 lastCommand = WriteKeyboardOutputBuff; 463 break; 464 case WriteMouseOutputBuff: 465 DPRINTF(I8042, "Got command to write to mouse output buffer.\n"); 466 lastCommand = WriteMouseOutputBuff; 467 break; 468 case WriteToMouse: 469 DPRINTF(I8042, "Expecting mouse command.\n"); 470 lastCommand = WriteToMouse; 471 break; 472 case DisableA20: 473 panic("i8042 \"Disable A20\" command not implemented.\n"); 474 case EnableA20: 475 panic("i8042 \"Enable A20\" command not implemented.\n"); 476 case ReadTestInputs: 477 panic("i8042 \"Read test inputs\" command not implemented.\n"); 478 case SystemReset: 479 panic("i8042 \"System reset\" command not implemented.\n"); 480 default: 481 warn("Write to unknown i8042 " 482 "(keyboard controller) command port.\n"); 483 } 484 } else { 485 panic("Write to unrecognized port %#x.\n", addr); 486 } 487 pkt->makeAtomicResponse(); 488 return latency; 489} 490 491void 492X86ISA::I8042::serialize(CheckpointOut &cp) const 493{ 494 SERIALIZE_SCALAR(dataPort); 495 SERIALIZE_SCALAR(commandPort); 496 SERIALIZE_SCALAR(statusReg); 497 SERIALIZE_SCALAR(commandByte); 498 SERIALIZE_SCALAR(dataReg); 499 SERIALIZE_SCALAR(lastCommand); 500 mouse.serialize("mouse", cp); 501 keyboard.serialize("keyboard", cp); 502} 503 504void 505X86ISA::I8042::unserialize(CheckpointIn &cp) 506{ 507 UNSERIALIZE_SCALAR(dataPort); 508 UNSERIALIZE_SCALAR(commandPort); 509 UNSERIALIZE_SCALAR(statusReg); 510 UNSERIALIZE_SCALAR(commandByte); 511 UNSERIALIZE_SCALAR(dataReg); 512 UNSERIALIZE_SCALAR(lastCommand); 513 mouse.unserialize("mouse", cp); 514 keyboard.unserialize("keyboard", cp); 515} 516 517void 518X86ISA::PS2Mouse::serialize(const std::string &base, CheckpointOut &cp) const 519{ 520 PS2Device::serialize(base, cp); 521 522 paramOut(cp, base + ".status", status); 523 paramOut(cp, base + ".resolution", resolution); 524 paramOut(cp, base + ".sampleRate", sampleRate); 525} 526 527void 528X86ISA::PS2Mouse::unserialize(const std::string &base, CheckpointIn &cp) 529{ 530 PS2Device::unserialize(base, cp); 531 532 paramIn(cp, base + ".status", status); 533 paramIn(cp, base + ".resolution", resolution); 534 paramIn(cp, base + ".sampleRate", sampleRate); 535} 536 537X86ISA::I8042 * 538I8042Params::create() 539{ 540 return new X86ISA::I8042(this); 541}
| 475 lastCommand = WriteKeyboardOutputBuff; 476 break; 477 case WriteMouseOutputBuff: 478 DPRINTF(I8042, "Got command to write to mouse output buffer.\n"); 479 lastCommand = WriteMouseOutputBuff; 480 break; 481 case WriteToMouse: 482 DPRINTF(I8042, "Expecting mouse command.\n"); 483 lastCommand = WriteToMouse; 484 break; 485 case DisableA20: 486 panic("i8042 \"Disable A20\" command not implemented.\n"); 487 case EnableA20: 488 panic("i8042 \"Enable A20\" command not implemented.\n"); 489 case ReadTestInputs: 490 panic("i8042 \"Read test inputs\" command not implemented.\n"); 491 case SystemReset: 492 panic("i8042 \"System reset\" command not implemented.\n"); 493 default: 494 warn("Write to unknown i8042 " 495 "(keyboard controller) command port.\n"); 496 } 497 } else { 498 panic("Write to unrecognized port %#x.\n", addr); 499 } 500 pkt->makeAtomicResponse(); 501 return latency; 502} 503 504void 505X86ISA::I8042::serialize(CheckpointOut &cp) const 506{ 507 SERIALIZE_SCALAR(dataPort); 508 SERIALIZE_SCALAR(commandPort); 509 SERIALIZE_SCALAR(statusReg); 510 SERIALIZE_SCALAR(commandByte); 511 SERIALIZE_SCALAR(dataReg); 512 SERIALIZE_SCALAR(lastCommand); 513 mouse.serialize("mouse", cp); 514 keyboard.serialize("keyboard", cp); 515} 516 517void 518X86ISA::I8042::unserialize(CheckpointIn &cp) 519{ 520 UNSERIALIZE_SCALAR(dataPort); 521 UNSERIALIZE_SCALAR(commandPort); 522 UNSERIALIZE_SCALAR(statusReg); 523 UNSERIALIZE_SCALAR(commandByte); 524 UNSERIALIZE_SCALAR(dataReg); 525 UNSERIALIZE_SCALAR(lastCommand); 526 mouse.unserialize("mouse", cp); 527 keyboard.unserialize("keyboard", cp); 528} 529 530void 531X86ISA::PS2Mouse::serialize(const std::string &base, CheckpointOut &cp) const 532{ 533 PS2Device::serialize(base, cp); 534 535 paramOut(cp, base + ".status", status); 536 paramOut(cp, base + ".resolution", resolution); 537 paramOut(cp, base + ".sampleRate", sampleRate); 538} 539 540void 541X86ISA::PS2Mouse::unserialize(const std::string &base, CheckpointIn &cp) 542{ 543 PS2Device::unserialize(base, cp); 544 545 paramIn(cp, base + ".status", status); 546 paramIn(cp, base + ".resolution", resolution); 547 paramIn(cp, base + ".sampleRate", sampleRate); 548} 549 550X86ISA::I8042 * 551I8042Params::create() 552{ 553 return new X86ISA::I8042(this); 554}
|