touchkit.cc revision 12658
112655Sandreas.sandberg@arm.com/* 212655Sandreas.sandberg@arm.com * Copyright (c) 2010, 2017-2018 ARM Limited 312655Sandreas.sandberg@arm.com * All rights reserved 412655Sandreas.sandberg@arm.com * 512655Sandreas.sandberg@arm.com * The license below extends only to copyright in the software and shall 612655Sandreas.sandberg@arm.com * not be construed as granting a license to any other intellectual 712655Sandreas.sandberg@arm.com * property including but not limited to intellectual property relating 812655Sandreas.sandberg@arm.com * to a hardware implementation of the functionality of the software 912655Sandreas.sandberg@arm.com * licensed hereunder. You may use the software subject to the license 1012655Sandreas.sandberg@arm.com * terms below provided that you ensure that this notice is replicated 1112655Sandreas.sandberg@arm.com * unmodified and in its entirety in all distributions of the software, 1212655Sandreas.sandberg@arm.com * modified or unmodified, in source code or in binary form. 1312655Sandreas.sandberg@arm.com * 1412655Sandreas.sandberg@arm.com * Copyright (c) 2005 The Regents of The University of Michigan 1512655Sandreas.sandberg@arm.com * All rights reserved. 1612655Sandreas.sandberg@arm.com * 1712655Sandreas.sandberg@arm.com * Redistribution and use in source and binary forms, with or without 1812655Sandreas.sandberg@arm.com * modification, are permitted provided that the following conditions are 1912655Sandreas.sandberg@arm.com * met: redistributions of source code must retain the above copyright 2012655Sandreas.sandberg@arm.com * notice, this list of conditions and the following disclaimer; 2112655Sandreas.sandberg@arm.com * redistributions in binary form must reproduce the above copyright 2212655Sandreas.sandberg@arm.com * notice, this list of conditions and the following disclaimer in the 2312655Sandreas.sandberg@arm.com * documentation and/or other materials provided with the distribution; 2412655Sandreas.sandberg@arm.com * neither the name of the copyright holders nor the names of its 2512655Sandreas.sandberg@arm.com * contributors may be used to endorse or promote products derived from 2612655Sandreas.sandberg@arm.com * this software without specific prior written permission. 2712655Sandreas.sandberg@arm.com * 2812655Sandreas.sandberg@arm.com * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 2912655Sandreas.sandberg@arm.com * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 3012655Sandreas.sandberg@arm.com * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 3112655Sandreas.sandberg@arm.com * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT 3212655Sandreas.sandberg@arm.com * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 3312655Sandreas.sandberg@arm.com * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 3412655Sandreas.sandberg@arm.com * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 3512655Sandreas.sandberg@arm.com * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 3612655Sandreas.sandberg@arm.com * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 3712655Sandreas.sandberg@arm.com * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE 3812655Sandreas.sandberg@arm.com * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 3912655Sandreas.sandberg@arm.com * 4012655Sandreas.sandberg@arm.com * Authors: Ali Saidi 4112655Sandreas.sandberg@arm.com * William Wang 4212655Sandreas.sandberg@arm.com * Andreas Sandberg 4312655Sandreas.sandberg@arm.com */ 4412655Sandreas.sandberg@arm.com 4512655Sandreas.sandberg@arm.com#include "dev/ps2/touchkit.hh" 4612655Sandreas.sandberg@arm.com 4712655Sandreas.sandberg@arm.com#include "base/logging.hh" 4812655Sandreas.sandberg@arm.com#include "debug/PS2.hh" 4912655Sandreas.sandberg@arm.com#include "dev/ps2.hh" 5012655Sandreas.sandberg@arm.com#include "params/PS2TouchKit.hh" 5112655Sandreas.sandberg@arm.com 5212655Sandreas.sandberg@arm.comconst uint8_t PS2TouchKit::ID[] = {0x00}; 5312655Sandreas.sandberg@arm.com 5412655Sandreas.sandberg@arm.comPS2TouchKit::PS2TouchKit(const PS2TouchKitParams *p) 5512655Sandreas.sandberg@arm.com : PS2Device(p), 5612655Sandreas.sandberg@arm.com vnc(p->vnc), 5712658Sandreas.sandberg@arm.com enabled(false), touchKitEnabled(false) 5812655Sandreas.sandberg@arm.com{ 5912655Sandreas.sandberg@arm.com if (vnc) 6012655Sandreas.sandberg@arm.com vnc->setMouse(this); 6112655Sandreas.sandberg@arm.com} 6212655Sandreas.sandberg@arm.com 6312655Sandreas.sandberg@arm.comvoid 6412655Sandreas.sandberg@arm.comPS2TouchKit::serialize(CheckpointOut &cp) const 6512655Sandreas.sandberg@arm.com{ 6612655Sandreas.sandberg@arm.com PS2Device::serialize(cp); 6712655Sandreas.sandberg@arm.com 6812658Sandreas.sandberg@arm.com SERIALIZE_SCALAR(enabled); 6912658Sandreas.sandberg@arm.com SERIALIZE_SCALAR(touchKitEnabled); 7012655Sandreas.sandberg@arm.com} 7112655Sandreas.sandberg@arm.com 7212655Sandreas.sandberg@arm.comvoid 7312655Sandreas.sandberg@arm.comPS2TouchKit::unserialize(CheckpointIn &cp) 7412655Sandreas.sandberg@arm.com{ 7512655Sandreas.sandberg@arm.com PS2Device::unserialize(cp); 7612655Sandreas.sandberg@arm.com 7712658Sandreas.sandberg@arm.com UNSERIALIZE_SCALAR(enabled); 7812658Sandreas.sandberg@arm.com UNSERIALIZE_SCALAR(touchKitEnabled); 7912655Sandreas.sandberg@arm.com} 8012655Sandreas.sandberg@arm.com 8112656Sandreas.sandberg@arm.combool 8212656Sandreas.sandberg@arm.comPS2TouchKit::recv(const std::vector<uint8_t> &data) 8312655Sandreas.sandberg@arm.com{ 8412656Sandreas.sandberg@arm.com switch (data[0]) { 8512655Sandreas.sandberg@arm.com case Ps2::Ps2Reset: 8612658Sandreas.sandberg@arm.com DPRINTF(PS2, "Resetting device.\n"); 8712658Sandreas.sandberg@arm.com enabled = false; 8812658Sandreas.sandberg@arm.com touchKitEnabled = false; 8912655Sandreas.sandberg@arm.com sendAck(); 9012655Sandreas.sandberg@arm.com send(Ps2::SelfTestPass); 9112656Sandreas.sandberg@arm.com return true; 9212655Sandreas.sandberg@arm.com 9312655Sandreas.sandberg@arm.com case Ps2::SetResolution: 9412655Sandreas.sandberg@arm.com case Ps2::SetRate: 9512655Sandreas.sandberg@arm.com case Ps2::SetStatusLed: 9612655Sandreas.sandberg@arm.com sendAck(); 9712656Sandreas.sandberg@arm.com return data.size() == 2; 9812655Sandreas.sandberg@arm.com 9912655Sandreas.sandberg@arm.com case Ps2::ReadId: 10012655Sandreas.sandberg@arm.com sendAck(); 10112655Sandreas.sandberg@arm.com send((const uint8_t *)&ID, sizeof(ID)); 10212656Sandreas.sandberg@arm.com return true; 10312655Sandreas.sandberg@arm.com 10412655Sandreas.sandberg@arm.com case Ps2::TpReadId: 10512655Sandreas.sandberg@arm.com // We're not a trackpoint device, this should make the probe 10612655Sandreas.sandberg@arm.com // go away 10712655Sandreas.sandberg@arm.com sendAck(); 10812655Sandreas.sandberg@arm.com send(0); 10912655Sandreas.sandberg@arm.com send(0); 11012655Sandreas.sandberg@arm.com sendAck(); 11112656Sandreas.sandberg@arm.com return true; 11212655Sandreas.sandberg@arm.com 11312655Sandreas.sandberg@arm.com case Ps2::SetScaling1_1: 11412655Sandreas.sandberg@arm.com case Ps2::SetScaling1_2: 11512658Sandreas.sandberg@arm.com sendAck(); 11612658Sandreas.sandberg@arm.com return true; 11712658Sandreas.sandberg@arm.com 11812655Sandreas.sandberg@arm.com case Ps2::Disable: 11912658Sandreas.sandberg@arm.com DPRINTF(PS2, "Disabling device.\n"); 12012658Sandreas.sandberg@arm.com enabled = false; 12112658Sandreas.sandberg@arm.com sendAck(); 12212658Sandreas.sandberg@arm.com return true; 12312658Sandreas.sandberg@arm.com 12412655Sandreas.sandberg@arm.com case Ps2::Enable: 12512658Sandreas.sandberg@arm.com DPRINTF(PS2, "Enabling device.\n"); 12612658Sandreas.sandberg@arm.com enabled = true; 12712658Sandreas.sandberg@arm.com sendAck(); 12812658Sandreas.sandberg@arm.com return true; 12912658Sandreas.sandberg@arm.com 13012655Sandreas.sandberg@arm.com case Ps2::SetDefaults: 13112658Sandreas.sandberg@arm.com DPRINTF(PS2, "Setting defaults and disabling device.\n"); 13212658Sandreas.sandberg@arm.com enabled = false; 13312655Sandreas.sandberg@arm.com sendAck(); 13412656Sandreas.sandberg@arm.com return true; 13512655Sandreas.sandberg@arm.com 13612655Sandreas.sandberg@arm.com case Ps2::StatusRequest: 13712655Sandreas.sandberg@arm.com sendAck(); 13812655Sandreas.sandberg@arm.com send(0); 13912655Sandreas.sandberg@arm.com send(2); // default resolution 14012655Sandreas.sandberg@arm.com send(100); // default sample rate 14112656Sandreas.sandberg@arm.com return true; 14212655Sandreas.sandberg@arm.com 14312655Sandreas.sandberg@arm.com case Ps2::TouchKitId: 14412658Sandreas.sandberg@arm.com return recvTouchKit(data); 14512655Sandreas.sandberg@arm.com 14612655Sandreas.sandberg@arm.com default: 14712658Sandreas.sandberg@arm.com panic("Unknown byte received: %#x\n", data[0]); 14812655Sandreas.sandberg@arm.com } 14912655Sandreas.sandberg@arm.com} 15012655Sandreas.sandberg@arm.com 15112658Sandreas.sandberg@arm.combool 15212658Sandreas.sandberg@arm.comPS2TouchKit::recvTouchKit(const std::vector<uint8_t> &data) 15312658Sandreas.sandberg@arm.com{ 15412658Sandreas.sandberg@arm.com // Ack all incoming bytes 15512658Sandreas.sandberg@arm.com sendAck(); 15612658Sandreas.sandberg@arm.com 15712658Sandreas.sandberg@arm.com // Packet format is: 0x0A SIZE CMD DATA 15812658Sandreas.sandberg@arm.com assert(data[0] == Ps2::TouchKitId); 15912658Sandreas.sandberg@arm.com if (data.size() < 3 || data.size() - 2 < data[1]) 16012658Sandreas.sandberg@arm.com return false; 16112658Sandreas.sandberg@arm.com 16212658Sandreas.sandberg@arm.com const uint8_t len = data[1]; 16312658Sandreas.sandberg@arm.com const uint8_t cmd = data[2]; 16412658Sandreas.sandberg@arm.com 16512658Sandreas.sandberg@arm.com // We have received at least one TouchKit diagnostic 16612658Sandreas.sandberg@arm.com // command. Enabled TouchKit reports. 16712658Sandreas.sandberg@arm.com touchKitEnabled = true; 16812658Sandreas.sandberg@arm.com 16912658Sandreas.sandberg@arm.com 17012658Sandreas.sandberg@arm.com switch (cmd) { 17112658Sandreas.sandberg@arm.com case TouchKitActive: 17212658Sandreas.sandberg@arm.com warn_if(len != 1, "Unexpected activate packet length: %u\n", len); 17312658Sandreas.sandberg@arm.com sendTouchKit('A'); 17412658Sandreas.sandberg@arm.com return true; 17512658Sandreas.sandberg@arm.com 17612658Sandreas.sandberg@arm.com default: 17712658Sandreas.sandberg@arm.com panic("Unimplemented touchscreen command: %#x\n", cmd); 17812658Sandreas.sandberg@arm.com } 17912658Sandreas.sandberg@arm.com} 18012658Sandreas.sandberg@arm.com 18112658Sandreas.sandberg@arm.comvoid 18212658Sandreas.sandberg@arm.comPS2TouchKit::sendTouchKit(const uint8_t *data, size_t size) 18312658Sandreas.sandberg@arm.com{ 18412658Sandreas.sandberg@arm.com send(Ps2::TouchKitId); 18512658Sandreas.sandberg@arm.com send(size); 18612658Sandreas.sandberg@arm.com for (int i = 0; i < size; ++i) 18712658Sandreas.sandberg@arm.com send(data[i]); 18812658Sandreas.sandberg@arm.com} 18912658Sandreas.sandberg@arm.com 19012658Sandreas.sandberg@arm.com 19112655Sandreas.sandberg@arm.comvoid 19212655Sandreas.sandberg@arm.comPS2TouchKit::mouseAt(uint16_t x, uint16_t y, uint8_t buttons) 19312655Sandreas.sandberg@arm.com{ 19412655Sandreas.sandberg@arm.com // If the driver hasn't initialized the device yet, no need to try and send 19512655Sandreas.sandberg@arm.com // it anything. Similarly we can get vnc mouse events orders of magnitude 19612655Sandreas.sandberg@arm.com // faster than m5 can process them. Only queue up two sets mouse movements 19712655Sandreas.sandberg@arm.com // and don't add more until those are processed. 19812658Sandreas.sandberg@arm.com if (!enabled || !touchKitEnabled || sendPending() > 10) 19912655Sandreas.sandberg@arm.com return; 20012655Sandreas.sandberg@arm.com 20112655Sandreas.sandberg@arm.com // Convert screen coordinates to touchpad coordinates 20212655Sandreas.sandberg@arm.com const uint16_t _x = (2047.0 / vnc->videoWidth()) * x; 20312655Sandreas.sandberg@arm.com const uint16_t _y = (2047.0 / vnc->videoHeight()) * y; 20412655Sandreas.sandberg@arm.com 20512655Sandreas.sandberg@arm.com const uint8_t resp[] = { 20612655Sandreas.sandberg@arm.com buttons, 20712655Sandreas.sandberg@arm.com (uint8_t)(_x >> 7), (uint8_t)(_x & 0x7f), 20812655Sandreas.sandberg@arm.com (uint8_t)(_y >> 7), (uint8_t)(_y & 0x7f), 20912655Sandreas.sandberg@arm.com }; 21012655Sandreas.sandberg@arm.com 21112655Sandreas.sandberg@arm.com send(resp, sizeof(resp)); 21212655Sandreas.sandberg@arm.com} 21312655Sandreas.sandberg@arm.com 21412655Sandreas.sandberg@arm.comPS2TouchKit * 21512655Sandreas.sandberg@arm.comPS2TouchKitParams::create() 21612655Sandreas.sandberg@arm.com{ 21712655Sandreas.sandberg@arm.com return new PS2TouchKit(this); 21812655Sandreas.sandberg@arm.com} 219