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"
4912660Sandreas.sandberg@arm.com#include "dev/ps2/types.hh"
5012655Sandreas.sandberg@arm.com#include "params/PS2TouchKit.hh"
5112655Sandreas.sandberg@arm.com
5212655Sandreas.sandberg@arm.comPS2TouchKit::PS2TouchKit(const PS2TouchKitParams *p)
5312655Sandreas.sandberg@arm.com    : PS2Device(p),
5412655Sandreas.sandberg@arm.com      vnc(p->vnc),
5512658Sandreas.sandberg@arm.com      enabled(false), touchKitEnabled(false)
5612655Sandreas.sandberg@arm.com{
5712655Sandreas.sandberg@arm.com    if (vnc)
5812655Sandreas.sandberg@arm.com        vnc->setMouse(this);
5912655Sandreas.sandberg@arm.com}
6012655Sandreas.sandberg@arm.com
6112655Sandreas.sandberg@arm.comvoid
6212655Sandreas.sandberg@arm.comPS2TouchKit::serialize(CheckpointOut &cp) const
6312655Sandreas.sandberg@arm.com{
6412655Sandreas.sandberg@arm.com    PS2Device::serialize(cp);
6512655Sandreas.sandberg@arm.com
6612658Sandreas.sandberg@arm.com    SERIALIZE_SCALAR(enabled);
6712658Sandreas.sandberg@arm.com    SERIALIZE_SCALAR(touchKitEnabled);
6812655Sandreas.sandberg@arm.com}
6912655Sandreas.sandberg@arm.com
7012655Sandreas.sandberg@arm.comvoid
7112655Sandreas.sandberg@arm.comPS2TouchKit::unserialize(CheckpointIn &cp)
7212655Sandreas.sandberg@arm.com{
7312655Sandreas.sandberg@arm.com    PS2Device::unserialize(cp);
7412655Sandreas.sandberg@arm.com
7512658Sandreas.sandberg@arm.com    UNSERIALIZE_SCALAR(enabled);
7612658Sandreas.sandberg@arm.com    UNSERIALIZE_SCALAR(touchKitEnabled);
7712655Sandreas.sandberg@arm.com}
7812655Sandreas.sandberg@arm.com
7912656Sandreas.sandberg@arm.combool
8012656Sandreas.sandberg@arm.comPS2TouchKit::recv(const std::vector<uint8_t> &data)
8112655Sandreas.sandberg@arm.com{
8212656Sandreas.sandberg@arm.com    switch (data[0]) {
8312660Sandreas.sandberg@arm.com      case Ps2::Reset:
8412658Sandreas.sandberg@arm.com        DPRINTF(PS2, "Resetting device.\n");
8512658Sandreas.sandberg@arm.com        enabled = false;
8612658Sandreas.sandberg@arm.com        touchKitEnabled = false;
8712655Sandreas.sandberg@arm.com        sendAck();
8812655Sandreas.sandberg@arm.com        send(Ps2::SelfTestPass);
8912656Sandreas.sandberg@arm.com        return true;
9012655Sandreas.sandberg@arm.com
9112660Sandreas.sandberg@arm.com      case Ps2::ReadID:
9212655Sandreas.sandberg@arm.com        sendAck();
9312660Sandreas.sandberg@arm.com        send(Ps2::Mouse::ID);
9412658Sandreas.sandberg@arm.com        return true;
9512658Sandreas.sandberg@arm.com
9612655Sandreas.sandberg@arm.com      case Ps2::Disable:
9712658Sandreas.sandberg@arm.com        DPRINTF(PS2, "Disabling device.\n");
9812658Sandreas.sandberg@arm.com        enabled = false;
9912658Sandreas.sandberg@arm.com        sendAck();
10012658Sandreas.sandberg@arm.com        return true;
10112658Sandreas.sandberg@arm.com
10212655Sandreas.sandberg@arm.com      case Ps2::Enable:
10312658Sandreas.sandberg@arm.com        DPRINTF(PS2, "Enabling device.\n");
10412658Sandreas.sandberg@arm.com        enabled = true;
10512658Sandreas.sandberg@arm.com        sendAck();
10612658Sandreas.sandberg@arm.com        return true;
10712658Sandreas.sandberg@arm.com
10812660Sandreas.sandberg@arm.com      case Ps2::DefaultsAndDisable:
10912658Sandreas.sandberg@arm.com        DPRINTF(PS2, "Setting defaults and disabling device.\n");
11012658Sandreas.sandberg@arm.com        enabled = false;
11112655Sandreas.sandberg@arm.com        sendAck();
11212656Sandreas.sandberg@arm.com        return true;
11312655Sandreas.sandberg@arm.com
11412660Sandreas.sandberg@arm.com      case Ps2::Mouse::Scale1to1:
11512660Sandreas.sandberg@arm.com      case Ps2::Mouse::Scale2to1:
11612660Sandreas.sandberg@arm.com        sendAck();
11712660Sandreas.sandberg@arm.com        return true;
11812660Sandreas.sandberg@arm.com
11912660Sandreas.sandberg@arm.com      case Ps2::Mouse::SetResolution:
12012660Sandreas.sandberg@arm.com      case Ps2::Mouse::SampleRate:
12112660Sandreas.sandberg@arm.com        sendAck();
12212660Sandreas.sandberg@arm.com        return data.size() == 2;
12312660Sandreas.sandberg@arm.com
12412660Sandreas.sandberg@arm.com      case Ps2::Mouse::GetStatus:
12512655Sandreas.sandberg@arm.com        sendAck();
12612655Sandreas.sandberg@arm.com        send(0);
12712655Sandreas.sandberg@arm.com        send(2); // default resolution
12812655Sandreas.sandberg@arm.com        send(100); // default sample rate
12912656Sandreas.sandberg@arm.com        return true;
13012655Sandreas.sandberg@arm.com
13112660Sandreas.sandberg@arm.com      case TpReadId:
13212660Sandreas.sandberg@arm.com        // We're not a trackpoint device, this should make the probe
13312660Sandreas.sandberg@arm.com        // go away
13412660Sandreas.sandberg@arm.com        sendAck();
13512660Sandreas.sandberg@arm.com        send(0);
13612660Sandreas.sandberg@arm.com        send(0);
13712660Sandreas.sandberg@arm.com        sendAck();
13812660Sandreas.sandberg@arm.com        return true;
13912660Sandreas.sandberg@arm.com
14012660Sandreas.sandberg@arm.com      case TouchKitDiag:
14112658Sandreas.sandberg@arm.com        return recvTouchKit(data);
14212655Sandreas.sandberg@arm.com
14312655Sandreas.sandberg@arm.com      default:
14412658Sandreas.sandberg@arm.com        panic("Unknown byte received: %#x\n", data[0]);
14512655Sandreas.sandberg@arm.com    }
14612655Sandreas.sandberg@arm.com}
14712655Sandreas.sandberg@arm.com
14812658Sandreas.sandberg@arm.combool
14912658Sandreas.sandberg@arm.comPS2TouchKit::recvTouchKit(const std::vector<uint8_t> &data)
15012658Sandreas.sandberg@arm.com{
15112658Sandreas.sandberg@arm.com    // Ack all incoming bytes
15212658Sandreas.sandberg@arm.com    sendAck();
15312658Sandreas.sandberg@arm.com
15412658Sandreas.sandberg@arm.com    // Packet format is: 0x0A SIZE CMD DATA
15512660Sandreas.sandberg@arm.com    assert(data[0] == TouchKitDiag);
15612658Sandreas.sandberg@arm.com    if (data.size() < 3 || data.size() - 2 < data[1])
15712658Sandreas.sandberg@arm.com        return false;
15812658Sandreas.sandberg@arm.com
15912658Sandreas.sandberg@arm.com    const uint8_t len = data[1];
16012658Sandreas.sandberg@arm.com    const uint8_t cmd = data[2];
16112658Sandreas.sandberg@arm.com
16212658Sandreas.sandberg@arm.com    // We have received at least one TouchKit diagnostic
16312658Sandreas.sandberg@arm.com    // command. Enabled TouchKit reports.
16412658Sandreas.sandberg@arm.com    touchKitEnabled = true;
16512658Sandreas.sandberg@arm.com
16612658Sandreas.sandberg@arm.com
16712658Sandreas.sandberg@arm.com    switch (cmd) {
16812658Sandreas.sandberg@arm.com      case TouchKitActive:
16912658Sandreas.sandberg@arm.com        warn_if(len != 1, "Unexpected activate packet length: %u\n", len);
17012658Sandreas.sandberg@arm.com        sendTouchKit('A');
17112658Sandreas.sandberg@arm.com        return true;
17212658Sandreas.sandberg@arm.com
17312658Sandreas.sandberg@arm.com      default:
17412658Sandreas.sandberg@arm.com        panic("Unimplemented touchscreen command: %#x\n", cmd);
17512658Sandreas.sandberg@arm.com    }
17612658Sandreas.sandberg@arm.com}
17712658Sandreas.sandberg@arm.com
17812658Sandreas.sandberg@arm.comvoid
17912658Sandreas.sandberg@arm.comPS2TouchKit::sendTouchKit(const uint8_t *data, size_t size)
18012658Sandreas.sandberg@arm.com{
18112660Sandreas.sandberg@arm.com    send(TouchKitDiag);
18212658Sandreas.sandberg@arm.com    send(size);
18312658Sandreas.sandberg@arm.com    for (int i = 0; i < size; ++i)
18412658Sandreas.sandberg@arm.com        send(data[i]);
18512658Sandreas.sandberg@arm.com}
18612658Sandreas.sandberg@arm.com
18712658Sandreas.sandberg@arm.com
18812655Sandreas.sandberg@arm.comvoid
18912655Sandreas.sandberg@arm.comPS2TouchKit::mouseAt(uint16_t x, uint16_t y, uint8_t buttons)
19012655Sandreas.sandberg@arm.com{
19112655Sandreas.sandberg@arm.com    // If the driver hasn't initialized the device yet, no need to try and send
19212655Sandreas.sandberg@arm.com    // it anything. Similarly we can get vnc mouse events orders of magnitude
19312655Sandreas.sandberg@arm.com    // faster than m5 can process them. Only queue up two sets mouse movements
19412655Sandreas.sandberg@arm.com    // and don't add more until those are processed.
19512658Sandreas.sandberg@arm.com    if (!enabled || !touchKitEnabled || sendPending() > 10)
19612655Sandreas.sandberg@arm.com        return;
19712655Sandreas.sandberg@arm.com
19812655Sandreas.sandberg@arm.com    // Convert screen coordinates to touchpad coordinates
19912655Sandreas.sandberg@arm.com    const uint16_t _x = (2047.0 / vnc->videoWidth()) * x;
20012655Sandreas.sandberg@arm.com    const uint16_t _y = (2047.0 / vnc->videoHeight()) * y;
20112655Sandreas.sandberg@arm.com
20212655Sandreas.sandberg@arm.com    const uint8_t resp[] = {
20312655Sandreas.sandberg@arm.com        buttons,
20412655Sandreas.sandberg@arm.com        (uint8_t)(_x >> 7), (uint8_t)(_x & 0x7f),
20512655Sandreas.sandberg@arm.com        (uint8_t)(_y >> 7), (uint8_t)(_y & 0x7f),
20612655Sandreas.sandberg@arm.com    };
20712655Sandreas.sandberg@arm.com
20812655Sandreas.sandberg@arm.com    send(resp, sizeof(resp));
20912655Sandreas.sandberg@arm.com}
21012655Sandreas.sandberg@arm.com
21112655Sandreas.sandberg@arm.comPS2TouchKit *
21212655Sandreas.sandberg@arm.comPS2TouchKitParams::create()
21312655Sandreas.sandberg@arm.com{
21412655Sandreas.sandberg@arm.com    return new PS2TouchKit(this);
21512655Sandreas.sandberg@arm.com}
216