Merge pull request #5276 from german77/gestures
HID: Implement gestures
This commit is contained in:
		| @@ -5,15 +5,25 @@ | ||||
| #include <cstring> | ||||
| #include "common/common_types.h" | ||||
| #include "core/core_timing.h" | ||||
| #include "core/frontend/emu_window.h" | ||||
| #include "core/hle/service/hid/controllers/gesture.h" | ||||
| #include "core/settings.h" | ||||
|  | ||||
| namespace Service::HID { | ||||
| constexpr std::size_t SHARED_MEMORY_OFFSET = 0x3BA00; | ||||
| constexpr f32 angle_threshold = 0.08f; | ||||
| constexpr f32 pinch_threshold = 100.0f; | ||||
|  | ||||
| Controller_Gesture::Controller_Gesture(Core::System& system) : ControllerBase(system) {} | ||||
| Controller_Gesture::~Controller_Gesture() = default; | ||||
|  | ||||
| void Controller_Gesture::OnInit() {} | ||||
| void Controller_Gesture::OnInit() { | ||||
|     for (std::size_t id = 0; id < MAX_FINGERS; ++id) { | ||||
|         mouse_finger_id[id] = MAX_FINGERS; | ||||
|         keyboard_finger_id[id] = MAX_FINGERS; | ||||
|         udp_finger_id[id] = MAX_FINGERS; | ||||
|     } | ||||
| } | ||||
|  | ||||
| void Controller_Gesture::OnRelease() {} | ||||
|  | ||||
| @@ -35,10 +45,153 @@ void Controller_Gesture::OnUpdate(const Core::Timing::CoreTiming& core_timing, u | ||||
|  | ||||
|     cur_entry.sampling_number = last_entry.sampling_number + 1; | ||||
|     cur_entry.sampling_number2 = cur_entry.sampling_number; | ||||
|     // TODO(ogniK): Update gesture states | ||||
|  | ||||
|     // TODO(german77): Implement all gesture types | ||||
|  | ||||
|     const Input::TouchStatus& mouse_status = touch_mouse_device->GetStatus(); | ||||
|     const Input::TouchStatus& udp_status = touch_udp_device->GetStatus(); | ||||
|     for (std::size_t id = 0; id < mouse_status.size(); ++id) { | ||||
|         mouse_finger_id[id] = UpdateTouchInputEvent(mouse_status[id], mouse_finger_id[id]); | ||||
|         udp_finger_id[id] = UpdateTouchInputEvent(udp_status[id], udp_finger_id[id]); | ||||
|     } | ||||
|  | ||||
|     if (Settings::values.use_touch_from_button) { | ||||
|         const Input::TouchStatus& keyboard_status = touch_btn_device->GetStatus(); | ||||
|         for (std::size_t id = 0; id < mouse_status.size(); ++id) { | ||||
|             keyboard_finger_id[id] = | ||||
|                 UpdateTouchInputEvent(keyboard_status[id], keyboard_finger_id[id]); | ||||
|         } | ||||
|     } | ||||
|  | ||||
|     TouchType type = TouchType::Idle; | ||||
|     Attribute attributes{}; | ||||
|     GestureProperties gesture = GetGestureProperties(); | ||||
|     if (last_gesture.active_points != gesture.active_points) { | ||||
|         ++last_gesture.detection_count; | ||||
|     } | ||||
|     if (gesture.active_points > 0) { | ||||
|         if (last_gesture.active_points == 0) { | ||||
|             attributes.is_new_touch.Assign(true); | ||||
|             last_gesture.average_distance = gesture.average_distance; | ||||
|             last_gesture.angle = gesture.angle; | ||||
|         } | ||||
|  | ||||
|         type = TouchType::Touch; | ||||
|         if (gesture.mid_point.x != last_entry.x || gesture.mid_point.y != last_entry.y) { | ||||
|             type = TouchType::Pan; | ||||
|         } | ||||
|         if (std::abs(gesture.average_distance - last_gesture.average_distance) > pinch_threshold) { | ||||
|             type = TouchType::Pinch; | ||||
|         } | ||||
|         if (std::abs(gesture.angle - last_gesture.angle) > angle_threshold) { | ||||
|             type = TouchType::Rotate; | ||||
|         } | ||||
|  | ||||
|         cur_entry.delta_x = gesture.mid_point.x - last_entry.x; | ||||
|         cur_entry.delta_y = gesture.mid_point.y - last_entry.y; | ||||
|         // TODO: Find how velocities are calculated | ||||
|         cur_entry.vel_x = static_cast<float>(cur_entry.delta_x) * 150.1f; | ||||
|         cur_entry.vel_y = static_cast<float>(cur_entry.delta_y) * 150.1f; | ||||
|  | ||||
|         // Slowdown the rate of change for less flapping | ||||
|         last_gesture.average_distance = | ||||
|             (last_gesture.average_distance * 0.9f) + (gesture.average_distance * 0.1f); | ||||
|         last_gesture.angle = (last_gesture.angle * 0.9f) + (gesture.angle * 0.1f); | ||||
|  | ||||
|     } else { | ||||
|         cur_entry.delta_x = 0; | ||||
|         cur_entry.delta_y = 0; | ||||
|         cur_entry.vel_x = 0; | ||||
|         cur_entry.vel_y = 0; | ||||
|     } | ||||
|     last_gesture.active_points = gesture.active_points; | ||||
|     cur_entry.detection_count = last_gesture.detection_count; | ||||
|     cur_entry.type = type; | ||||
|     cur_entry.attributes = attributes; | ||||
|     cur_entry.x = gesture.mid_point.x; | ||||
|     cur_entry.y = gesture.mid_point.y; | ||||
|     cur_entry.point_count = static_cast<s32>(gesture.active_points); | ||||
|     for (size_t id = 0; id < MAX_POINTS; id++) { | ||||
|         cur_entry.points[id].x = gesture.points[id].x; | ||||
|         cur_entry.points[id].y = gesture.points[id].y; | ||||
|     } | ||||
|     cur_entry.rotation_angle = 0; | ||||
|     cur_entry.scale = 0; | ||||
|  | ||||
|     std::memcpy(data + SHARED_MEMORY_OFFSET, &shared_memory, sizeof(SharedMemory)); | ||||
| } | ||||
|  | ||||
| void Controller_Gesture::OnLoadInputDevices() {} | ||||
| void Controller_Gesture::OnLoadInputDevices() { | ||||
|     touch_mouse_device = Input::CreateDevice<Input::TouchDevice>("engine:emu_window"); | ||||
|     touch_udp_device = Input::CreateDevice<Input::TouchDevice>("engine:cemuhookudp"); | ||||
|     touch_btn_device = Input::CreateDevice<Input::TouchDevice>("engine:touch_from_button"); | ||||
| } | ||||
|  | ||||
| std::optional<std::size_t> Controller_Gesture::GetUnusedFingerID() const { | ||||
|     std::size_t first_free_id = 0; | ||||
|     while (first_free_id < MAX_POINTS) { | ||||
|         if (!fingers[first_free_id].pressed) { | ||||
|             return first_free_id; | ||||
|         } else { | ||||
|             first_free_id++; | ||||
|         } | ||||
|     } | ||||
|     return std::nullopt; | ||||
| } | ||||
|  | ||||
| std::size_t Controller_Gesture::UpdateTouchInputEvent( | ||||
|     const std::tuple<float, float, bool>& touch_input, std::size_t finger_id) { | ||||
|     const auto& [x, y, pressed] = touch_input; | ||||
|     if (pressed) { | ||||
|         if (finger_id == MAX_POINTS) { | ||||
|             const auto first_free_id = GetUnusedFingerID(); | ||||
|             if (!first_free_id) { | ||||
|                 // Invalid finger id do nothing | ||||
|                 return MAX_POINTS; | ||||
|             } | ||||
|             finger_id = first_free_id.value(); | ||||
|             fingers[finger_id].pressed = true; | ||||
|         } | ||||
|         fingers[finger_id].x = x; | ||||
|         fingers[finger_id].y = y; | ||||
|         return finger_id; | ||||
|     } | ||||
|  | ||||
|     if (finger_id != MAX_POINTS) { | ||||
|         fingers[finger_id].pressed = false; | ||||
|     } | ||||
|  | ||||
|     return MAX_POINTS; | ||||
| } | ||||
|  | ||||
| Controller_Gesture::GestureProperties Controller_Gesture::GetGestureProperties() { | ||||
|     GestureProperties gesture; | ||||
|     std::array<Finger, MAX_POINTS> active_fingers; | ||||
|     const auto end_iter = std::copy_if(fingers.begin(), fingers.end(), active_fingers.begin(), | ||||
|                                        [](const auto& finger) { return finger.pressed; }); | ||||
|     gesture.active_points = | ||||
|         static_cast<std::size_t>(std::distance(active_fingers.begin(), end_iter)); | ||||
|  | ||||
|     for (size_t id = 0; id < gesture.active_points; ++id) { | ||||
|         gesture.points[id].x = | ||||
|             static_cast<int>(active_fingers[id].x * Layout::ScreenUndocked::Width); | ||||
|         gesture.points[id].y = | ||||
|             static_cast<int>(active_fingers[id].y * Layout::ScreenUndocked::Height); | ||||
|         gesture.mid_point.x += static_cast<int>(gesture.points[id].x / gesture.active_points); | ||||
|         gesture.mid_point.y += static_cast<int>(gesture.points[id].y / gesture.active_points); | ||||
|     } | ||||
|  | ||||
|     for (size_t id = 0; id < gesture.active_points; ++id) { | ||||
|         const double distance = | ||||
|             std::pow(static_cast<float>(gesture.mid_point.x - gesture.points[id].x), 2) + | ||||
|             std::pow(static_cast<float>(gesture.mid_point.y - gesture.points[id].y), 2); | ||||
|         gesture.average_distance += | ||||
|             static_cast<float>(distance) / static_cast<float>(gesture.active_points); | ||||
|     } | ||||
|  | ||||
|     gesture.angle = std::atan2(static_cast<float>(gesture.mid_point.y - gesture.points[0].y), | ||||
|                                static_cast<float>(gesture.mid_point.x - gesture.points[0].x)); | ||||
|     return gesture; | ||||
| } | ||||
|  | ||||
| } // namespace Service::HID | ||||
|   | ||||
| @@ -5,8 +5,10 @@ | ||||
| #pragma once | ||||
|  | ||||
| #include <array> | ||||
| #include "common/bit_field.h" | ||||
| #include "common/common_types.h" | ||||
| #include "common/swap.h" | ||||
| #include "core/frontend/input.h" | ||||
| #include "core/hle/service/hid/controllers/controller_base.h" | ||||
|  | ||||
| namespace Service::HID { | ||||
| @@ -28,29 +30,64 @@ public: | ||||
|     void OnLoadInputDevices() override; | ||||
|  | ||||
| private: | ||||
|     struct Locations { | ||||
|     static constexpr size_t MAX_FINGERS = 16; | ||||
|     static constexpr size_t MAX_POINTS = 4; | ||||
|  | ||||
|     enum class TouchType : u32 { | ||||
|         Idle,     // Nothing touching the screen | ||||
|         Complete, // Unknown. End of touch? | ||||
|         Cancel,   // Never triggered | ||||
|         Touch,    // Pressing without movement | ||||
|         Press,    // Never triggered | ||||
|         Tap,      // Fast press then release | ||||
|         Pan,      // All points moving together across the screen | ||||
|         Swipe,    // Fast press movement and release of a single point | ||||
|         Pinch,    // All points moving away/closer to the midpoint | ||||
|         Rotate,   // All points rotating from the midpoint | ||||
|     }; | ||||
|  | ||||
|     enum class Direction : u32 { | ||||
|         None, | ||||
|         Left, | ||||
|         Up, | ||||
|         Right, | ||||
|         Down, | ||||
|     }; | ||||
|  | ||||
|     struct Attribute { | ||||
|         union { | ||||
|             u32_le raw{}; | ||||
|  | ||||
|             BitField<0, 1, u32> is_new_touch; | ||||
|             BitField<1, 1, u32> is_double_tap; | ||||
|         }; | ||||
|     }; | ||||
|     static_assert(sizeof(Attribute) == 4, "Attribute is an invalid size"); | ||||
|  | ||||
|     struct Points { | ||||
|         s32_le x; | ||||
|         s32_le y; | ||||
|     }; | ||||
|     static_assert(sizeof(Points) == 8, "Points is an invalid size"); | ||||
|  | ||||
|     struct GestureState { | ||||
|         s64_le sampling_number; | ||||
|         s64_le sampling_number2; | ||||
|  | ||||
|         s64_le detection_count; | ||||
|         s32_le type; | ||||
|         s32_le dir; | ||||
|         TouchType type; | ||||
|         Direction dir; | ||||
|         s32_le x; | ||||
|         s32_le y; | ||||
|         s32_le delta_x; | ||||
|         s32_le delta_y; | ||||
|         f32 vel_x; | ||||
|         f32 vel_y; | ||||
|         s32_le attributes; | ||||
|         f32 scale; | ||||
|         f32 rotation; | ||||
|         s32_le location_count; | ||||
|         std::array<Locations, 4> locations; | ||||
|         Attribute attributes; | ||||
|         u32 scale; | ||||
|         u32 rotation_angle; | ||||
|         s32_le point_count; | ||||
|         std::array<Points, 4> points; | ||||
|     }; | ||||
|     static_assert(sizeof(GestureState) == 0x68, "GestureState is an invalid size"); | ||||
|  | ||||
| @@ -58,6 +95,45 @@ private: | ||||
|         CommonHeader header; | ||||
|         std::array<GestureState, 17> gesture_states; | ||||
|     }; | ||||
|     static_assert(sizeof(SharedMemory) == 0x708, "SharedMemory is an invalid size"); | ||||
|  | ||||
|     struct Finger { | ||||
|         f32 x{}; | ||||
|         f32 y{}; | ||||
|         bool pressed{}; | ||||
|     }; | ||||
|  | ||||
|     struct GestureProperties { | ||||
|         std::array<Points, MAX_POINTS> points{}; | ||||
|         std::size_t active_points{}; | ||||
|         Points mid_point{}; | ||||
|         s64_le detection_count{}; | ||||
|         u64_le delta_time{}; | ||||
|         float average_distance{}; | ||||
|         float angle{}; | ||||
|     }; | ||||
|  | ||||
|     // Returns an unused finger id, if there is no fingers avaliable MAX_FINGERS will be returned | ||||
|     std::optional<size_t> GetUnusedFingerID() const; | ||||
|  | ||||
|     /** If the touch is new it tries to assing a new finger id, if there is no fingers avaliable no | ||||
|      * changes will be made. Updates the coordinates if the finger id it's already set. If the touch | ||||
|      * ends delays the output by one frame to set the end_touch flag before finally freeing the | ||||
|      * finger id */ | ||||
|     size_t UpdateTouchInputEvent(const std::tuple<float, float, bool>& touch_input, | ||||
|                                  size_t finger_id); | ||||
|  | ||||
|     // Returns the average distance, angle and middle point of the active fingers | ||||
|     GestureProperties GetGestureProperties(); | ||||
|  | ||||
|     SharedMemory shared_memory{}; | ||||
|     std::unique_ptr<Input::TouchDevice> touch_mouse_device; | ||||
|     std::unique_ptr<Input::TouchDevice> touch_udp_device; | ||||
|     std::unique_ptr<Input::TouchDevice> touch_btn_device; | ||||
|     std::array<size_t, MAX_FINGERS> mouse_finger_id; | ||||
|     std::array<size_t, MAX_FINGERS> keyboard_finger_id; | ||||
|     std::array<size_t, MAX_FINGERS> udp_finger_id; | ||||
|     std::array<Finger, MAX_POINTS> fingers; | ||||
|     GestureProperties last_gesture; | ||||
| }; | ||||
| } // namespace Service::HID | ||||
|   | ||||
		Reference in New Issue
	
	Block a user