/* * Copyright (C) 2010 The Android Open Source 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. */ #include "keychords.h" #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include namespace android { namespace init { Keychords::Keychords() : epoll_(nullptr), inotify_fd_(-1) {} Keychords::~Keychords() noexcept { if (inotify_fd_ >= 0) { epoll_->UnregisterHandler(inotify_fd_); ::close(inotify_fd_); } while (!registration_.empty()) GeteventCloseDevice(registration_.begin()->first); } Keychords::Mask::Mask(size_t bit) : bits_((bit + sizeof(mask_t) - 1) / sizeof(mask_t), 0) {} void Keychords::Mask::SetBit(size_t bit, bool value) { auto idx = bit / (kBitsPerByte * sizeof(mask_t)); if (idx >= bits_.size()) return; if (value) { bits_[idx] |= mask_t(1) << (bit % (kBitsPerByte * sizeof(mask_t))); } else { bits_[idx] &= ~(mask_t(1) << (bit % (kBitsPerByte * sizeof(mask_t)))); } } bool Keychords::Mask::GetBit(size_t bit) const { auto idx = bit / (kBitsPerByte * sizeof(mask_t)); return bits_[idx] & (mask_t(1) << (bit % (kBitsPerByte * sizeof(mask_t)))); } size_t Keychords::Mask::bytesize() const { return bits_.size() * sizeof(mask_t); } void* Keychords::Mask::data() { return bits_.data(); } size_t Keychords::Mask::size() const { return bits_.size() * sizeof(mask_t) * kBitsPerByte; } void Keychords::Mask::resize(size_t bit) { auto idx = bit / (kBitsPerByte * sizeof(mask_t)); if (idx >= bits_.size()) { bits_.resize(idx + 1, 0); } } Keychords::Mask::operator bool() const { for (size_t i = 0; i < bits_.size(); ++i) { if (bits_[i]) return true; } return false; } Keychords::Mask Keychords::Mask::operator&(const Keychords::Mask& rval) const { auto len = std::min(bits_.size(), rval.bits_.size()); Keychords::Mask ret; ret.bits_.resize(len); for (size_t i = 0; i < len; ++i) { ret.bits_[i] = bits_[i] & rval.bits_[i]; } return ret; } void Keychords::Mask::operator|=(const Keychords::Mask& rval) { auto len = rval.bits_.size(); bits_.resize(len); for (size_t i = 0; i < len; ++i) { bits_[i] |= rval.bits_[i]; } } Keychords::Entry::Entry() : notified(false) {} void Keychords::LambdaCheck() { for (auto& [keycodes, entry] : entries_) { auto found = true; for (auto& code : keycodes) { if (!current_.GetBit(code)) { entry.notified = false; found = false; break; } } if (!found) continue; if (entry.notified) continue; entry.notified = true; handler_(keycodes); } } void Keychords::LambdaHandler(int fd) { input_event event; auto res = TEMP_FAILURE_RETRY(::read(fd, &event, sizeof(event))); if ((res != sizeof(event)) || (event.type != EV_KEY)) return; current_.SetBit(event.code, event.value); LambdaCheck(); } bool Keychords::GeteventEnable(int fd) { // Make sure it is an event channel, should pass this ioctl call int version; if (::ioctl(fd, EVIOCGVERSION, &version)) return false; #ifdef EVIOCSMASK static auto EviocsmaskSupported = true; if (EviocsmaskSupported) { Keychords::Mask mask(EV_KEY); mask.SetBit(EV_KEY); input_mask msg = {}; msg.type = EV_SYN; msg.codes_size = mask.bytesize(); msg.codes_ptr = reinterpret_cast(mask.data()); if (::ioctl(fd, EVIOCSMASK, &msg) == -1) { PLOG(WARNING) << "EVIOCSMASK not supported"; EviocsmaskSupported = false; } } #endif Keychords::Mask mask; for (auto& [keycodes, entry] : entries_) { for (auto& code : keycodes) { mask.resize(code); mask.SetBit(code); } } current_.resize(mask.size()); Keychords::Mask available(mask.size()); auto res = ::ioctl(fd, EVIOCGBIT(EV_KEY, available.bytesize()), available.data()); if (res == -1) return false; if (!(available & mask)) return false; #ifdef EVIOCSMASK if (EviocsmaskSupported) { input_mask msg = {}; msg.type = EV_KEY; msg.codes_size = mask.bytesize(); msg.codes_ptr = reinterpret_cast(mask.data()); ::ioctl(fd, EVIOCSMASK, &msg); } #endif Keychords::Mask set(mask.size()); res = ::ioctl(fd, EVIOCGKEY(res), set.data()); if (res > 0) { current_ |= mask & available & set; LambdaCheck(); } if (auto result = epoll_->RegisterHandler(fd, [this, fd]() { this->LambdaHandler(fd); }); !result.ok()) { LOG(WARNING) << "Could not register keychord epoll handler: " << result.error(); return false; } return true; } void Keychords::GeteventOpenDevice(const std::string& device) { if (registration_.count(device)) return; auto fd = TEMP_FAILURE_RETRY(::open(device.c_str(), O_RDONLY | O_CLOEXEC)); if (fd == -1) { PLOG(ERROR) << "Can not open " << device; return; } if (!GeteventEnable(fd)) { ::close(fd); } else { registration_.emplace(device, fd); } } void Keychords::GeteventCloseDevice(const std::string& device) { auto it = registration_.find(device); if (it == registration_.end()) return; auto fd = (*it).second; epoll_->UnregisterHandler(fd); registration_.erase(it); ::close(fd); } void Keychords::InotifyHandler() { unsigned char buf[512]; // History shows 32-64 bytes typical auto res = TEMP_FAILURE_RETRY(::read(inotify_fd_, buf, sizeof(buf))); if (res < 0) { PLOG(WARNING) << "could not get event"; return; } auto event_buf = buf; while (static_cast(res) >= sizeof(inotify_event)) { auto event = reinterpret_cast(event_buf); auto event_size = sizeof(inotify_event) + event->len; if (static_cast(res) < event_size) break; if (event->len) { std::string devname(kDevicePath); devname += '/'; devname += event->name; if (event->mask & IN_CREATE) { GeteventOpenDevice(devname); } else { GeteventCloseDevice(devname); } } res -= event_size; event_buf += event_size; } } void Keychords::GeteventOpenDevice() { inotify_fd_ = ::inotify_init1(IN_NONBLOCK | IN_CLOEXEC); if (inotify_fd_ < 0) { PLOG(WARNING) << "Could not instantiate inotify for " << kDevicePath; } else if (::inotify_add_watch(inotify_fd_, kDevicePath, IN_DELETE | IN_CREATE | IN_ONLYDIR) < 0) { PLOG(WARNING) << "Could not add watch for " << kDevicePath; ::close(inotify_fd_); inotify_fd_ = -1; } std::unique_ptr device(opendir(kDevicePath), closedir); if (device) { dirent* entry; while ((entry = readdir(device.get()))) { if (entry->d_name[0] == '.') continue; std::string devname(kDevicePath); devname += '/'; devname += entry->d_name; GeteventOpenDevice(devname); } } if (inotify_fd_ >= 0) { if (auto result = epoll_->RegisterHandler(inotify_fd_, [this]() { this->InotifyHandler(); }); !result.ok()) { LOG(WARNING) << "Could not register keychord epoll handler: " << result.error(); } } } void Keychords::Register(const std::vector& keycodes) { if (keycodes.empty()) return; entries_.try_emplace(keycodes, Entry()); } void Keychords::Start(Epoll* epoll, std::function&)> handler) { epoll_ = epoll; handler_ = std::move(handler); if (entries_.size()) GeteventOpenDevice(); } } // namespace init } // namespace android