android_device_oneplus_sm8150-common/tri-state-key/main.cpp

/*
 * Copyright (C) 2018 The LineageOS Project
 *
 * Licensed under the Apache License, Version 2.0 (the "License");
 * you may not use this file except in compliance with the License.
 * You may obtain a copy of the License at
 *
 *      http://www.apache.org/licenses/LICENSE-2.0
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 */

#define LOG_TAG "tri-state-key_daemon"

#include <android-base/file.h>
#include <android-base/logging.h>
#include <fcntl.h>
#include <linux/input.h>
#include <linux/uinput.h>
#include <unistd.h>

#include "uevent_listener.h"

#define HALL_CALIBRATION_DATA "/sys/bus/platform/devices/soc:tri_state_key/hall_data_calib"
#define HALL_PERSIST_CALIBRATION_DATA "/mnt/vendor/persist/engineermode/tri_state_hall_data"

#define KEY_MODE_NORMAL 601
#define KEY_MODE_VIBRATION 602
#define KEY_MODE_SILENCE 603

using android::base::ReadFileToString;
using android::base::WriteStringToFile;
using android::Uevent;
using android::UeventListener;

int main() {
    int err;
    int uinputFd;
    struct uinput_user_dev uidev {};
    UeventListener uevent_listener;

    LOG(INFO) << "Started";

    if (std::string hallData; ReadFileToString(HALL_PERSIST_CALIBRATION_DATA, &hallData)) {
        std::replace(hallData.begin(), hallData.end(), ';', ',');
        WriteStringToFile(hallData, HALL_CALIBRATION_DATA);
    }

    uinputFd = open("/dev/uinput", O_WRONLY | O_NONBLOCK);
    if (uinputFd < 0) {
        LOG(ERROR) << "Unable to open uinput node";
        return 1;
    }

    err = ioctl(uinputFd, UI_SET_EVBIT, EV_KEY) |
          ioctl(uinputFd, UI_SET_KEYBIT, KEY_MODE_NORMAL) |
          ioctl(uinputFd, UI_SET_KEYBIT, KEY_MODE_VIBRATION) |
          ioctl(uinputFd, UI_SET_KEYBIT, KEY_MODE_SILENCE);
    if (err != 0) {
        LOG(ERROR) << "Unable to enable KEY events";
        goto out;
    }

    sprintf(uidev.name, "uinput-tri-state-key");
    uidev.id.bustype = BUS_VIRTUAL;

    err = write(uinputFd, &uidev, sizeof(uidev));
    if (err < 0) {
        LOG(ERROR) << "Write user device to uinput node failed";
        goto out;
    }

    err = ioctl(uinputFd, UI_DEV_CREATE);
    if (err < 0) {
        LOG(ERROR) << "Unable to create uinput device";
        goto out;
    }

    LOG(INFO) << "Successfully registered uinput-tri-state-key for KEY events";

    uevent_listener.Poll([&uinputFd](const Uevent& uevent) {
        int err;
        struct input_event event {};

        if (uevent.action != "change" || uevent.name != "soc:tri_state_key") {
            return;
        }

        bool none = uevent.state.find("USB=0") != std::string::npos;
        bool vibration = uevent.state.find("USB-HOST=0") != std::string::npos;
        bool silent = uevent.state.find("null)=0") != std::string::npos;

        int keyCode;
        if (none && !vibration && !silent) {
            keyCode = KEY_MODE_NORMAL;
        } else if (!none && vibration && !silent) {
            keyCode = KEY_MODE_VIBRATION;
        } else if (!none && !vibration && silent) {
            keyCode = KEY_MODE_SILENCE;
        } else {
            // Ignore intermediate states
            return;
        }

        // Report the key
        event.type = EV_KEY;
        event.code = keyCode;
        event.value = 1;
        err = write(uinputFd, &event, sizeof(event));
        if (err < 0) {
            LOG(ERROR) << "Write EV_KEY to uinput node failed";
            return;
        }

        // Force a flush with an EV_SYN
        event.type = EV_SYN;
        event.code = SYN_REPORT;
        event.value = 0;
        err = write(uinputFd, &event, sizeof(event));
        if (err < 0) {
            LOG(ERROR) << "Write EV_SYN to uinput node failed";
            return;
        }

        // Report the key
        event.type = EV_KEY;
        event.code = keyCode;
        event.value = 0;
        err = write(uinputFd, &event, sizeof(event));
        if (err < 0) {
            LOG(ERROR) << "Write EV_KEY to uinput node failed";
            return;
        }

        // Force a flush with an EV_SYN
        event.type = EV_SYN;
        event.code = SYN_REPORT;
        event.value = 0;
        err = write(uinputFd, &event, sizeof(event));
        if (err < 0) {
            LOG(ERROR) << "Write EV_SYN to uinput node failed";
            return;
        }

        return;
    });

out:
    // Clean up
    close(uinputFd);

    // The loop can only be exited via failure or signal
    return 1;
}