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