2015-01-18 15:07:48 -08:00
|
|
|
// Copyright 2015 Citra Emulator Project
|
|
|
|
// Licensed under GPLv2 or any later version
|
|
|
|
// Refer to the license.txt file included.
|
|
|
|
|
2017-01-20 12:46:39 -08:00
|
|
|
#include <algorithm>
|
|
|
|
#include <atomic>
|
2016-06-10 21:59:38 -07:00
|
|
|
#include <cmath>
|
2017-01-20 12:46:39 -08:00
|
|
|
#include <memory>
|
2016-09-17 17:38:01 -07:00
|
|
|
#include "common/logging/log.h"
|
2015-03-16 09:16:59 -07:00
|
|
|
#include "core/core_timing.h"
|
2016-12-23 05:37:40 -08:00
|
|
|
#include "core/frontend/emu_window.h"
|
2017-01-20 12:46:39 -08:00
|
|
|
#include "core/frontend/input.h"
|
2015-01-18 15:07:48 -08:00
|
|
|
#include "core/hle/kernel/event.h"
|
|
|
|
#include "core/hle/kernel/shared_memory.h"
|
2016-09-20 23:52:38 -07:00
|
|
|
#include "core/hle/service/hid/hid.h"
|
2016-09-20 08:21:23 -07:00
|
|
|
#include "core/hle/service/hid/hid_spvr.h"
|
|
|
|
#include "core/hle/service/hid/hid_user.h"
|
|
|
|
#include "core/hle/service/service.h"
|
2015-03-08 21:14:59 -07:00
|
|
|
#include "video_core/video_core.h"
|
|
|
|
|
2015-01-18 15:07:48 -08:00
|
|
|
namespace Service {
|
|
|
|
namespace HID {
|
|
|
|
|
2015-03-09 20:38:52 -07:00
|
|
|
// Handle to shared memory region designated to HID_User service
|
2015-04-27 19:01:48 -07:00
|
|
|
static Kernel::SharedPtr<Kernel::SharedMemory> shared_mem;
|
2015-01-18 15:07:48 -08:00
|
|
|
|
2015-03-09 20:38:52 -07:00
|
|
|
// Event handles
|
2015-04-27 19:01:48 -07:00
|
|
|
static Kernel::SharedPtr<Kernel::Event> event_pad_or_touch_1;
|
|
|
|
static Kernel::SharedPtr<Kernel::Event> event_pad_or_touch_2;
|
|
|
|
static Kernel::SharedPtr<Kernel::Event> event_accelerometer;
|
|
|
|
static Kernel::SharedPtr<Kernel::Event> event_gyroscope;
|
|
|
|
static Kernel::SharedPtr<Kernel::Event> event_debug_pad;
|
2015-01-18 15:07:48 -08:00
|
|
|
|
2015-04-27 19:01:48 -07:00
|
|
|
static u32 next_pad_index;
|
|
|
|
static u32 next_touch_index;
|
2016-03-18 13:27:36 -07:00
|
|
|
static u32 next_accelerometer_index;
|
|
|
|
static u32 next_gyroscope_index;
|
|
|
|
|
2017-02-16 22:04:27 -08:00
|
|
|
static int enable_accelerometer_count; // positive means enabled
|
|
|
|
static int enable_gyroscope_count; // positive means enabled
|
2015-03-07 23:05:56 -08:00
|
|
|
|
2017-01-15 11:27:00 -08:00
|
|
|
static int pad_update_event;
|
|
|
|
static int accelerometer_update_event;
|
|
|
|
static int gyroscope_update_event;
|
|
|
|
|
|
|
|
// Updating period for each HID device. These empirical values are measured from a 11.2 3DS.
|
2017-01-15 23:59:16 -08:00
|
|
|
constexpr u64 pad_update_ticks = BASE_CLOCK_RATE_ARM11 / 234;
|
|
|
|
constexpr u64 accelerometer_update_ticks = BASE_CLOCK_RATE_ARM11 / 104;
|
|
|
|
constexpr u64 gyroscope_update_ticks = BASE_CLOCK_RATE_ARM11 / 101;
|
2017-01-15 11:27:00 -08:00
|
|
|
|
2017-01-20 12:46:39 -08:00
|
|
|
static std::atomic<bool> is_device_reload_pending;
|
|
|
|
static std::array<std::unique_ptr<Input::ButtonDevice>, Settings::NativeButton::NUM_BUTTONS_HID>
|
|
|
|
buttons;
|
2017-01-20 13:58:03 -08:00
|
|
|
static std::unique_ptr<Input::AnalogDevice> circle_pad;
|
2017-01-20 12:46:39 -08:00
|
|
|
|
2016-05-12 03:09:36 -07:00
|
|
|
static PadState GetCirclePadDirectionState(s16 circle_pad_x, s16 circle_pad_y) {
|
2016-09-18 18:01:46 -07:00
|
|
|
// 30 degree and 60 degree are angular thresholds for directions
|
2016-12-15 12:50:16 -08:00
|
|
|
constexpr float TAN30 = 0.577350269f;
|
|
|
|
constexpr float TAN60 = 1 / TAN30;
|
2016-09-18 18:01:46 -07:00
|
|
|
// a circle pad radius greater than 40 will trigger circle pad direction
|
|
|
|
constexpr int CIRCLE_PAD_THRESHOLD_SQUARE = 40 * 40;
|
2016-05-12 03:09:36 -07:00
|
|
|
PadState state;
|
|
|
|
state.hex = 0;
|
|
|
|
|
|
|
|
if (circle_pad_x * circle_pad_x + circle_pad_y * circle_pad_y > CIRCLE_PAD_THRESHOLD_SQUARE) {
|
|
|
|
float t = std::abs(static_cast<float>(circle_pad_y) / circle_pad_x);
|
|
|
|
|
|
|
|
if (circle_pad_x != 0 && t < TAN60) {
|
|
|
|
if (circle_pad_x > 0)
|
|
|
|
state.circle_right.Assign(1);
|
|
|
|
else
|
|
|
|
state.circle_left.Assign(1);
|
|
|
|
}
|
|
|
|
|
|
|
|
if (circle_pad_x == 0 || t > TAN30) {
|
|
|
|
if (circle_pad_y > 0)
|
|
|
|
state.circle_up.Assign(1);
|
|
|
|
else
|
|
|
|
state.circle_down.Assign(1);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
return state;
|
|
|
|
}
|
2015-02-26 18:13:08 -08:00
|
|
|
|
2017-01-20 12:46:39 -08:00
|
|
|
static void LoadInputDevices() {
|
|
|
|
std::transform(Settings::values.buttons.begin() + Settings::NativeButton::BUTTON_HID_BEGIN,
|
|
|
|
Settings::values.buttons.begin() + Settings::NativeButton::BUTTON_HID_END,
|
|
|
|
buttons.begin(), Input::CreateDevice<Input::ButtonDevice>);
|
2017-01-20 13:58:03 -08:00
|
|
|
circle_pad = Input::CreateDevice<Input::AnalogDevice>(
|
|
|
|
Settings::values.analogs[Settings::NativeAnalog::CirclePad]);
|
2017-01-20 12:46:39 -08:00
|
|
|
}
|
|
|
|
|
|
|
|
static void UnloadInputDevices() {
|
|
|
|
for (auto& button : buttons) {
|
|
|
|
button.reset();
|
|
|
|
}
|
2017-01-20 13:58:03 -08:00
|
|
|
circle_pad.reset();
|
2017-01-20 12:46:39 -08:00
|
|
|
}
|
|
|
|
|
2017-01-15 11:27:00 -08:00
|
|
|
static void UpdatePadCallback(u64 userdata, int cycles_late) {
|
2015-05-10 15:47:07 -07:00
|
|
|
SharedMem* mem = reinterpret_cast<SharedMem*>(shared_mem->GetPointer());
|
2015-01-18 15:07:48 -08:00
|
|
|
|
2017-01-20 12:46:39 -08:00
|
|
|
if (is_device_reload_pending.exchange(false))
|
|
|
|
LoadInputDevices();
|
|
|
|
|
|
|
|
PadState state;
|
|
|
|
using namespace Settings::NativeButton;
|
|
|
|
state.a.Assign(buttons[A - BUTTON_HID_BEGIN]->GetStatus());
|
|
|
|
state.b.Assign(buttons[B - BUTTON_HID_BEGIN]->GetStatus());
|
|
|
|
state.x.Assign(buttons[X - BUTTON_HID_BEGIN]->GetStatus());
|
|
|
|
state.y.Assign(buttons[Y - BUTTON_HID_BEGIN]->GetStatus());
|
|
|
|
state.right.Assign(buttons[Right - BUTTON_HID_BEGIN]->GetStatus());
|
|
|
|
state.left.Assign(buttons[Left - BUTTON_HID_BEGIN]->GetStatus());
|
|
|
|
state.up.Assign(buttons[Up - BUTTON_HID_BEGIN]->GetStatus());
|
|
|
|
state.down.Assign(buttons[Down - BUTTON_HID_BEGIN]->GetStatus());
|
|
|
|
state.l.Assign(buttons[L - BUTTON_HID_BEGIN]->GetStatus());
|
|
|
|
state.r.Assign(buttons[R - BUTTON_HID_BEGIN]->GetStatus());
|
|
|
|
state.start.Assign(buttons[Start - BUTTON_HID_BEGIN]->GetStatus());
|
|
|
|
state.select.Assign(buttons[Select - BUTTON_HID_BEGIN]->GetStatus());
|
2016-05-12 03:09:36 -07:00
|
|
|
|
2016-05-15 09:35:06 -07:00
|
|
|
// Get current circle pad position and update circle pad direction
|
2017-01-20 13:58:03 -08:00
|
|
|
float circle_pad_x_f, circle_pad_y_f;
|
|
|
|
std::tie(circle_pad_x_f, circle_pad_y_f) = circle_pad->GetStatus();
|
|
|
|
constexpr int MAX_CIRCLEPAD_POS = 0x9C; // Max value for a circle pad position
|
|
|
|
s16 circle_pad_x = static_cast<s16>(circle_pad_x_f * MAX_CIRCLEPAD_POS);
|
|
|
|
s16 circle_pad_y = static_cast<s16>(circle_pad_y_f * MAX_CIRCLEPAD_POS);
|
2016-05-12 03:09:36 -07:00
|
|
|
state.hex |= GetCirclePadDirectionState(circle_pad_x, circle_pad_y).hex;
|
|
|
|
|
2015-03-09 20:38:52 -07:00
|
|
|
mem->pad.current_state.hex = state.hex;
|
|
|
|
mem->pad.index = next_pad_index;
|
2016-03-13 01:19:17 -08:00
|
|
|
next_pad_index = (next_pad_index + 1) % mem->pad.entries.size();
|
2015-01-18 15:07:48 -08:00
|
|
|
|
|
|
|
// Get the previous Pad state
|
2015-03-09 20:38:52 -07:00
|
|
|
u32 last_entry_index = (mem->pad.index - 1) % mem->pad.entries.size();
|
|
|
|
PadState old_state = mem->pad.entries[last_entry_index].current_state;
|
2015-01-18 15:07:48 -08:00
|
|
|
|
|
|
|
// Compute bitmask with 1s for bits different from the old state
|
2016-09-17 17:38:01 -07:00
|
|
|
PadState changed = {{(state.hex ^ old_state.hex)}};
|
2015-01-18 15:07:48 -08:00
|
|
|
|
|
|
|
// Get the current Pad entry
|
2016-03-26 00:50:02 -07:00
|
|
|
PadDataEntry& pad_entry = mem->pad.entries[mem->pad.index];
|
2015-01-18 15:07:48 -08:00
|
|
|
|
|
|
|
// Update entry properties
|
2016-03-26 00:50:02 -07:00
|
|
|
pad_entry.current_state.hex = state.hex;
|
|
|
|
pad_entry.delta_additions.hex = changed.hex & state.hex;
|
2016-05-12 03:09:36 -07:00
|
|
|
pad_entry.delta_removals.hex = changed.hex & old_state.hex;
|
|
|
|
pad_entry.circle_pad_x = circle_pad_x;
|
|
|
|
pad_entry.circle_pad_y = circle_pad_y;
|
2015-03-07 21:12:47 -08:00
|
|
|
|
|
|
|
// If we just updated index 0, provide a new timestamp
|
2015-03-09 20:38:52 -07:00
|
|
|
if (mem->pad.index == 0) {
|
|
|
|
mem->pad.index_reset_ticks_previous = mem->pad.index_reset_ticks;
|
2015-03-16 09:16:59 -07:00
|
|
|
mem->pad.index_reset_ticks = (s64)CoreTiming::GetTicks();
|
2015-03-07 21:12:47 -08:00
|
|
|
}
|
|
|
|
|
2015-03-09 20:38:52 -07:00
|
|
|
mem->touch.index = next_touch_index;
|
2015-05-27 09:20:09 -07:00
|
|
|
next_touch_index = (next_touch_index + 1) % mem->touch.entries.size();
|
2015-03-07 23:05:56 -08:00
|
|
|
|
|
|
|
// Get the current touch entry
|
2016-03-26 00:50:02 -07:00
|
|
|
TouchDataEntry& touch_entry = mem->touch.entries[mem->touch.index];
|
2015-03-08 21:14:59 -07:00
|
|
|
bool pressed = false;
|
2015-03-07 23:05:56 -08:00
|
|
|
|
2016-03-26 00:50:02 -07:00
|
|
|
std::tie(touch_entry.x, touch_entry.y, pressed) = VideoCore::g_emu_window->GetTouchState();
|
|
|
|
touch_entry.valid.Assign(pressed ? 1 : 0);
|
2015-03-07 23:05:56 -08:00
|
|
|
|
|
|
|
// TODO(bunnei): We're not doing anything with offset 0xA8 + 0x18 of HID SharedMemory, which
|
|
|
|
// supposedly is "Touch-screen entry, which contains the raw coordinate data prior to being
|
|
|
|
// converted to pixel coordinates." (http://3dbrew.org/wiki/HID_Shared_Memory#Offset_0xA8).
|
|
|
|
|
|
|
|
// If we just updated index 0, provide a new timestamp
|
2015-03-09 20:38:52 -07:00
|
|
|
if (mem->touch.index == 0) {
|
|
|
|
mem->touch.index_reset_ticks_previous = mem->touch.index_reset_ticks;
|
2015-03-16 09:16:59 -07:00
|
|
|
mem->touch.index_reset_ticks = (s64)CoreTiming::GetTicks();
|
2015-03-07 23:05:56 -08:00
|
|
|
}
|
2015-05-25 11:34:09 -07:00
|
|
|
|
2015-03-07 23:05:56 -08:00
|
|
|
// Signal both handles when there's an update to Pad or touch
|
2015-03-09 20:38:52 -07:00
|
|
|
event_pad_or_touch_1->Signal();
|
|
|
|
event_pad_or_touch_2->Signal();
|
2016-03-18 13:27:36 -07:00
|
|
|
|
2017-01-15 11:27:00 -08:00
|
|
|
// Reschedule recurrent event
|
|
|
|
CoreTiming::ScheduleEvent(pad_update_ticks - cycles_late, pad_update_event);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void UpdateAccelerometerCallback(u64 userdata, int cycles_late) {
|
|
|
|
SharedMem* mem = reinterpret_cast<SharedMem*>(shared_mem->GetPointer());
|
|
|
|
|
|
|
|
mem->accelerometer.index = next_accelerometer_index;
|
|
|
|
next_accelerometer_index = (next_accelerometer_index + 1) % mem->accelerometer.entries.size();
|
2016-03-18 13:27:36 -07:00
|
|
|
|
2017-01-15 11:27:00 -08:00
|
|
|
AccelerometerDataEntry& accelerometer_entry =
|
|
|
|
mem->accelerometer.entries[mem->accelerometer.index];
|
|
|
|
std::tie(accelerometer_entry.x, accelerometer_entry.y, accelerometer_entry.z) =
|
|
|
|
VideoCore::g_emu_window->GetAccelerometerState();
|
|
|
|
|
|
|
|
// Make up "raw" entry
|
|
|
|
// TODO(wwylele):
|
|
|
|
// From hardware testing, the raw_entry values are approximately, but not exactly, as twice as
|
|
|
|
// corresponding entries (or with a minus sign). It may caused by system calibration to the
|
|
|
|
// accelerometer. Figure out how it works, or, if no game reads raw_entry, the following three
|
|
|
|
// lines can be removed and leave raw_entry unimplemented.
|
|
|
|
mem->accelerometer.raw_entry.x = -2 * accelerometer_entry.x;
|
|
|
|
mem->accelerometer.raw_entry.z = 2 * accelerometer_entry.y;
|
|
|
|
mem->accelerometer.raw_entry.y = -2 * accelerometer_entry.z;
|
|
|
|
|
|
|
|
// If we just updated index 0, provide a new timestamp
|
|
|
|
if (mem->accelerometer.index == 0) {
|
|
|
|
mem->accelerometer.index_reset_ticks_previous = mem->accelerometer.index_reset_ticks;
|
|
|
|
mem->accelerometer.index_reset_ticks = (s64)CoreTiming::GetTicks();
|
2016-03-18 13:27:36 -07:00
|
|
|
}
|
|
|
|
|
2017-01-15 11:27:00 -08:00
|
|
|
event_accelerometer->Signal();
|
2016-03-18 13:27:36 -07:00
|
|
|
|
2017-01-15 11:27:00 -08:00
|
|
|
// Reschedule recurrent event
|
|
|
|
CoreTiming::ScheduleEvent(accelerometer_update_ticks - cycles_late, accelerometer_update_event);
|
|
|
|
}
|
2016-03-18 13:27:36 -07:00
|
|
|
|
2017-01-15 11:27:00 -08:00
|
|
|
static void UpdateGyroscopeCallback(u64 userdata, int cycles_late) {
|
|
|
|
SharedMem* mem = reinterpret_cast<SharedMem*>(shared_mem->GetPointer());
|
2016-03-18 13:27:36 -07:00
|
|
|
|
2017-01-15 11:27:00 -08:00
|
|
|
mem->gyroscope.index = next_gyroscope_index;
|
|
|
|
next_gyroscope_index = (next_gyroscope_index + 1) % mem->gyroscope.entries.size();
|
|
|
|
|
|
|
|
GyroscopeDataEntry& gyroscope_entry = mem->gyroscope.entries[mem->gyroscope.index];
|
|
|
|
std::tie(gyroscope_entry.x, gyroscope_entry.y, gyroscope_entry.z) =
|
|
|
|
VideoCore::g_emu_window->GetGyroscopeState();
|
|
|
|
|
|
|
|
// Make up "raw" entry
|
|
|
|
mem->gyroscope.raw_entry.x = gyroscope_entry.x;
|
|
|
|
mem->gyroscope.raw_entry.z = -gyroscope_entry.y;
|
|
|
|
mem->gyroscope.raw_entry.y = gyroscope_entry.z;
|
2016-03-18 13:27:36 -07:00
|
|
|
|
2017-01-15 11:27:00 -08:00
|
|
|
// If we just updated index 0, provide a new timestamp
|
|
|
|
if (mem->gyroscope.index == 0) {
|
|
|
|
mem->gyroscope.index_reset_ticks_previous = mem->gyroscope.index_reset_ticks;
|
|
|
|
mem->gyroscope.index_reset_ticks = (s64)CoreTiming::GetTicks();
|
2016-03-18 13:27:36 -07:00
|
|
|
}
|
2017-01-15 11:27:00 -08:00
|
|
|
|
|
|
|
event_gyroscope->Signal();
|
|
|
|
|
|
|
|
// Reschedule recurrent event
|
|
|
|
CoreTiming::ScheduleEvent(gyroscope_update_ticks - cycles_late, gyroscope_update_event);
|
2015-03-07 23:05:56 -08:00
|
|
|
}
|
|
|
|
|
2015-02-26 18:13:08 -08:00
|
|
|
void GetIPCHandles(Service::Interface* self) {
|
|
|
|
u32* cmd_buff = Kernel::GetCommandBuffer();
|
|
|
|
|
2016-09-17 17:38:01 -07:00
|
|
|
cmd_buff[1] = 0; // No error
|
2015-03-13 14:36:19 -07:00
|
|
|
cmd_buff[2] = 0x14000000; // IPC Command Structure translate-header
|
2015-02-26 18:13:08 -08:00
|
|
|
// TODO(yuriks): Return error from SendSyncRequest is this fails (part of IPC marshalling)
|
2015-03-09 20:38:52 -07:00
|
|
|
cmd_buff[3] = Kernel::g_handle_table.Create(Service::HID::shared_mem).MoveFrom();
|
|
|
|
cmd_buff[4] = Kernel::g_handle_table.Create(Service::HID::event_pad_or_touch_1).MoveFrom();
|
|
|
|
cmd_buff[5] = Kernel::g_handle_table.Create(Service::HID::event_pad_or_touch_2).MoveFrom();
|
|
|
|
cmd_buff[6] = Kernel::g_handle_table.Create(Service::HID::event_accelerometer).MoveFrom();
|
|
|
|
cmd_buff[7] = Kernel::g_handle_table.Create(Service::HID::event_gyroscope).MoveFrom();
|
|
|
|
cmd_buff[8] = Kernel::g_handle_table.Create(Service::HID::event_debug_pad).MoveFrom();
|
2015-02-26 18:13:08 -08:00
|
|
|
}
|
|
|
|
|
2015-03-13 14:36:19 -07:00
|
|
|
void EnableAccelerometer(Service::Interface* self) {
|
|
|
|
u32* cmd_buff = Kernel::GetCommandBuffer();
|
|
|
|
|
2016-03-18 13:27:36 -07:00
|
|
|
++enable_accelerometer_count;
|
2017-01-15 11:27:00 -08:00
|
|
|
|
|
|
|
// Schedules the accelerometer update event if the accelerometer was just enabled
|
|
|
|
if (enable_accelerometer_count == 1) {
|
|
|
|
CoreTiming::ScheduleEvent(accelerometer_update_ticks, accelerometer_update_event);
|
|
|
|
}
|
2015-03-13 14:36:19 -07:00
|
|
|
|
|
|
|
cmd_buff[1] = RESULT_SUCCESS.raw;
|
|
|
|
|
2016-03-18 13:27:36 -07:00
|
|
|
LOG_DEBUG(Service_HID, "called");
|
2015-03-13 14:36:19 -07:00
|
|
|
}
|
|
|
|
|
2015-05-22 15:55:27 -07:00
|
|
|
void DisableAccelerometer(Service::Interface* self) {
|
|
|
|
u32* cmd_buff = Kernel::GetCommandBuffer();
|
|
|
|
|
2016-03-18 13:27:36 -07:00
|
|
|
--enable_accelerometer_count;
|
2017-01-15 11:27:00 -08:00
|
|
|
|
|
|
|
// Unschedules the accelerometer update event if the accelerometer was just disabled
|
|
|
|
if (enable_accelerometer_count == 0) {
|
|
|
|
CoreTiming::UnscheduleEvent(accelerometer_update_event, 0);
|
|
|
|
}
|
2015-05-22 15:55:27 -07:00
|
|
|
|
|
|
|
cmd_buff[1] = RESULT_SUCCESS.raw;
|
|
|
|
|
2016-03-18 13:27:36 -07:00
|
|
|
LOG_DEBUG(Service_HID, "called");
|
2015-05-22 15:55:27 -07:00
|
|
|
}
|
|
|
|
|
2015-03-13 14:36:19 -07:00
|
|
|
void EnableGyroscopeLow(Service::Interface* self) {
|
|
|
|
u32* cmd_buff = Kernel::GetCommandBuffer();
|
|
|
|
|
2016-03-18 13:27:36 -07:00
|
|
|
++enable_gyroscope_count;
|
2017-01-15 11:27:00 -08:00
|
|
|
|
|
|
|
// Schedules the gyroscope update event if the gyroscope was just enabled
|
|
|
|
if (enable_gyroscope_count == 1) {
|
|
|
|
CoreTiming::ScheduleEvent(gyroscope_update_ticks, gyroscope_update_event);
|
|
|
|
}
|
2015-03-13 14:36:19 -07:00
|
|
|
|
|
|
|
cmd_buff[1] = RESULT_SUCCESS.raw;
|
|
|
|
|
2016-03-18 13:27:36 -07:00
|
|
|
LOG_DEBUG(Service_HID, "called");
|
2015-03-13 14:36:19 -07:00
|
|
|
}
|
|
|
|
|
2015-05-22 15:55:27 -07:00
|
|
|
void DisableGyroscopeLow(Service::Interface* self) {
|
|
|
|
u32* cmd_buff = Kernel::GetCommandBuffer();
|
|
|
|
|
2016-03-18 13:27:36 -07:00
|
|
|
--enable_gyroscope_count;
|
2017-01-15 11:27:00 -08:00
|
|
|
|
|
|
|
// Unschedules the gyroscope update event if the gyroscope was just disabled
|
|
|
|
if (enable_gyroscope_count == 0) {
|
|
|
|
CoreTiming::UnscheduleEvent(gyroscope_update_event, 0);
|
|
|
|
}
|
2015-05-22 15:55:27 -07:00
|
|
|
|
|
|
|
cmd_buff[1] = RESULT_SUCCESS.raw;
|
|
|
|
|
2016-03-18 13:27:36 -07:00
|
|
|
LOG_DEBUG(Service_HID, "called");
|
|
|
|
}
|
|
|
|
|
|
|
|
void GetGyroscopeLowRawToDpsCoefficient(Service::Interface* self) {
|
|
|
|
u32* cmd_buff = Kernel::GetCommandBuffer();
|
|
|
|
|
|
|
|
cmd_buff[1] = RESULT_SUCCESS.raw;
|
|
|
|
|
|
|
|
f32 coef = VideoCore::g_emu_window->GetGyroscopeRawToDpsCoefficient();
|
|
|
|
memcpy(&cmd_buff[2], &coef, 4);
|
|
|
|
}
|
|
|
|
|
|
|
|
void GetGyroscopeLowCalibrateParam(Service::Interface* self) {
|
|
|
|
u32* cmd_buff = Kernel::GetCommandBuffer();
|
|
|
|
|
|
|
|
cmd_buff[1] = RESULT_SUCCESS.raw;
|
|
|
|
|
2016-03-25 01:39:59 -07:00
|
|
|
const s16 param_unit = 6700; // an approximate value taken from hw
|
|
|
|
GyroscopeCalibrateParam param = {
|
2016-09-17 17:38:01 -07:00
|
|
|
{0, param_unit, -param_unit}, {0, param_unit, -param_unit}, {0, param_unit, -param_unit},
|
2016-03-25 01:39:59 -07:00
|
|
|
};
|
|
|
|
memcpy(&cmd_buff[2], ¶m, sizeof(param));
|
2016-03-18 13:27:36 -07:00
|
|
|
|
2015-05-22 15:55:27 -07:00
|
|
|
LOG_WARNING(Service_HID, "(STUBBED) called");
|
|
|
|
}
|
|
|
|
|
2015-03-13 14:36:19 -07:00
|
|
|
void GetSoundVolume(Service::Interface* self) {
|
|
|
|
u32* cmd_buff = Kernel::GetCommandBuffer();
|
|
|
|
|
|
|
|
const u8 volume = 0x3F; // TODO(purpasmart): Find out if this is the max value for the volume
|
|
|
|
|
|
|
|
cmd_buff[1] = RESULT_SUCCESS.raw;
|
|
|
|
cmd_buff[2] = volume;
|
|
|
|
|
|
|
|
LOG_WARNING(Service_HID, "(STUBBED) called");
|
|
|
|
}
|
|
|
|
|
2015-03-07 17:54:16 -08:00
|
|
|
void Init() {
|
2015-01-22 21:11:25 -08:00
|
|
|
using namespace Kernel;
|
|
|
|
|
2015-02-26 18:13:08 -08:00
|
|
|
AddService(new HID_U_Interface);
|
|
|
|
AddService(new HID_SPVR_Interface);
|
|
|
|
|
2017-01-20 12:46:39 -08:00
|
|
|
is_device_reload_pending.store(true);
|
|
|
|
|
2015-05-10 15:47:07 -07:00
|
|
|
using Kernel::MemoryPermission;
|
2016-09-17 17:38:01 -07:00
|
|
|
shared_mem =
|
|
|
|
SharedMemory::Create(nullptr, 0x1000, MemoryPermission::ReadWrite, MemoryPermission::Read,
|
|
|
|
0, Kernel::MemoryRegion::BASE, "HID:SharedMemory");
|
2015-01-18 15:07:48 -08:00
|
|
|
|
2015-03-08 21:14:59 -07:00
|
|
|
next_pad_index = 0;
|
|
|
|
next_touch_index = 0;
|
2017-01-20 13:33:50 -08:00
|
|
|
next_accelerometer_index = 0;
|
|
|
|
next_gyroscope_index = 0;
|
2015-03-08 21:14:59 -07:00
|
|
|
|
2017-02-16 22:04:27 -08:00
|
|
|
enable_accelerometer_count = 0;
|
|
|
|
enable_gyroscope_count = 0;
|
|
|
|
|
2015-01-18 15:07:48 -08:00
|
|
|
// Create event handles
|
2016-03-12 12:06:31 -08:00
|
|
|
event_pad_or_touch_1 = Event::Create(ResetType::OneShot, "HID:EventPadOrTouch1");
|
|
|
|
event_pad_or_touch_2 = Event::Create(ResetType::OneShot, "HID:EventPadOrTouch2");
|
2016-09-17 17:38:01 -07:00
|
|
|
event_accelerometer = Event::Create(ResetType::OneShot, "HID:EventAccelerometer");
|
|
|
|
event_gyroscope = Event::Create(ResetType::OneShot, "HID:EventGyroscope");
|
|
|
|
event_debug_pad = Event::Create(ResetType::OneShot, "HID:EventDebugPad");
|
2017-01-15 11:27:00 -08:00
|
|
|
|
|
|
|
// Register update callbacks
|
|
|
|
pad_update_event = CoreTiming::RegisterEvent("HID::UpdatePadCallback", UpdatePadCallback);
|
|
|
|
accelerometer_update_event =
|
|
|
|
CoreTiming::RegisterEvent("HID::UpdateAccelerometerCallback", UpdateAccelerometerCallback);
|
|
|
|
gyroscope_update_event =
|
|
|
|
CoreTiming::RegisterEvent("HID::UpdateGyroscopeCallback", UpdateGyroscopeCallback);
|
|
|
|
|
|
|
|
CoreTiming::ScheduleEvent(pad_update_ticks, pad_update_event);
|
2015-01-18 15:07:48 -08:00
|
|
|
}
|
|
|
|
|
2015-03-07 17:54:16 -08:00
|
|
|
void Shutdown() {
|
2015-04-27 19:01:48 -07:00
|
|
|
shared_mem = nullptr;
|
|
|
|
event_pad_or_touch_1 = nullptr;
|
|
|
|
event_pad_or_touch_2 = nullptr;
|
|
|
|
event_accelerometer = nullptr;
|
|
|
|
event_gyroscope = nullptr;
|
|
|
|
event_debug_pad = nullptr;
|
2017-01-20 12:46:39 -08:00
|
|
|
UnloadInputDevices();
|
|
|
|
}
|
|
|
|
|
|
|
|
void ReloadInputDevices() {
|
|
|
|
is_device_reload_pending.store(true);
|
2015-01-18 15:07:48 -08:00
|
|
|
}
|
|
|
|
|
2015-03-08 21:14:59 -07:00
|
|
|
} // namespace HID
|
|
|
|
|
|
|
|
} // namespace Service
|