Merge pull request #85 from wheremyfoodat/gyro

Initial gyroscope support

src/core/services/hid.cpp

@@ -33,6 +33,7 @@ void HIDService::reset() {
 	newButtons = oldButtons = 0;
 	circlePadX = circlePadY = 0;
 	touchScreenX = touchScreenY = 0;
+	roll = pitch = yaw = 0;
 }
 
 void HIDService::handleSyncRequest(u32 messagePointer) {
@@ -182,6 +183,14 @@ void HIDService::updateInputs(u64 currentTick) {
 			writeSharedMem<u64>(0x160, readSharedMem<u64>(0x158)); // Copy previous tick count
 			writeSharedMem<u64>(0x158, currentTick);             // Write new tick count
 		}
+		const size_t gyroEntryOffset = 0x178 + (nextGyroIndex * 6);  // Offset in the array of 8 touchscreen entries
+		writeSharedMem<u16>(gyroEntryOffset, pitch);
+		writeSharedMem<u16>(gyroEntryOffset + 2, yaw);
+		writeSharedMem<u16>(gyroEntryOffset + 4, roll);
+
+		// Since gyroscope euler angles are relative, we zero them out here and the frontend will update them again when we receive a new rotation
+		roll = pitch = yaw = 0;
+
 		writeSharedMem<u32>(0x168, nextGyroIndex); // Index last updated by the HID module
 		nextGyroIndex = (nextGyroIndex + 1) % 32; // Move to next entry
 	}

src/emulator.cpp

@@ -192,6 +192,8 @@ void Emulator::run() {
 						} else {
 							srv.releaseTouchScreen();
 						}
+					} else if (event.button.button == SDL_BUTTON_RIGHT) {
+						holdingRightClick = true;
 					}
 					break;
 				}
@@ -199,6 +201,8 @@ void Emulator::run() {
 				case SDL_MOUSEBUTTONUP:
 					if (event.button.button == SDL_BUTTON_LEFT) {
 						srv.releaseTouchScreen();
+					} else if (event.button.button == SDL_BUTTON_RIGHT) {
+						holdingRightClick = false;
 					}
 					break;
 
@@ -244,6 +248,24 @@ void Emulator::run() {
 						}
 					}
 				}
+
+				// Detect mouse motion events for gyroscope emulation
+				case SDL_MOUSEMOTION: {
+					// We use right click to indicate we want to rotate the console. If right click is not held, then this is not a gyroscope rotation
+					if (!holdingRightClick) break;
+
+					// Relative motion since last mouse motion event
+					const s32 motionX = event.motion.xrel;
+					const s32 motionY = event.motion.yrel;
+
+					// The gyroscope involves lots of weird math I don't want to bother with atm
+					// So up until then, we will set the gyroscope euler angles to fixed values based on the direction of the relative motion
+					const s32 roll = motionX > 0 ? 0x7f : -0x7f;
+					const s32 pitch = motionY > 0 ? 0x7f : -0x7f;
+					srv.setRoll(roll);
+					srv.setPitch(pitch);
+					break;
+				}
 			}
 		}