🎨 Updates and simplifies command handling

app/src/lib/components/Visualization.svelte

@@ -33,7 +33,7 @@
   import SceneBuilder from '$lib/sceneBuilder'
   import { lerp, degToRad } from 'three/src/math/MathUtils'
   import { GUI } from 'three/addons/libs/lil-gui.module.min.js'
-  import Kinematic, { type body_state_t } from '$lib/kinematic'
+  import { type body_state_t } from '$lib/kinematic'
   import {
     BezierState,
     CalibrationState,
@@ -264,16 +264,15 @@
     if (sceneManager.isDragging || !settings['Internal kinematic']) return
     const controlData = get(outControllerData)
     const data = {
-      stop: controlData[0],
-      lx: controlData[1],
-      ly: controlData[2],
-      rx: controlData[3],
-      ry: controlData[4],
-      h: controlData[5],
-      s: controlData[6],
-      s1: controlData[7]
+      lx: controlData[0],
+      ly: controlData[1],
+      rx: controlData[2],
+      ry: controlData[3],
+      h: controlData[4],
+      s: controlData[5],
+      s1: controlData[6]
     }
-    body_state.ym = ((data.h + 127) * 0.35) / 100
+    body_state.ym = data.h
 
     let planner = planners[get(mode)]
     const delta = performance.now() - lastTick

app/src/lib/gait.ts

@@ -14,7 +14,6 @@ export interface gait_state_t {
 }
 
 export interface ControllerCommand {
-  stop: number
   lx: number
   ly: number
   rx: number
@@ -61,11 +60,11 @@ export abstract class GaitState {
 
   map_command(command: ControllerCommand) {
     const newCommand = {
-      step_height: 0.4 + (command.s1 / 128 + 1) / 2,
-      step_x: command.ly / 128,
-      step_z: -command.lx / 128,
-      step_velocity: command.s / 128 + 1,
-      step_angle: command.rx / 128,
+      step_height: 0.4 + (command.s1 + 1) / 2,
+      step_x: command.ly,
+      step_z: -command.lx,
+      step_velocity: command.s,
+      step_angle: command.rx,
       step_depth: 0.002
     }
 
@@ -112,10 +111,10 @@ export class StandState extends GaitState {
 
   step(body_state: body_state_t, command: ControllerCommand, dt: number = 0.02) {
     body_state.omega = 0
-    body_state.phi = command.rx / 8
-    body_state.psi = command.ry / 8
-    body_state.xm = command.ly / 2 / 100
-    body_state.zm = command.lx / 2 / 100
+    body_state.phi = command.rx
+    body_state.psi = command.ry
+    body_state.xm = command.ly / 4
+    body_state.zm = command.lx / 4
     body_state.feet = this.default_feet_pos
     return body_state
   }

app/src/routes/controller/Controls.svelte

@@ -1,11 +1,11 @@
 <script lang="ts">
   import nipplejs from 'nipplejs'
   import { onMount } from 'svelte'
-  import { capitalize, throttler, toInt8 } from '$lib/utilities'
+  import { capitalize, throttler } from '$lib/utilities'
   import { input, outControllerData, mode, modes, type Modes, ModesEnum } from '$lib/stores'
   import type { vector } from '$lib/types/models'
   import { VerticalSlider } from '$lib/components/input'
-  import { gamepadAxes, gamepadButtons, hasGamepad } from '$lib/stores/gamepad'
+  import { gamepadAxes, hasGamepad } from '$lib/stores/gamepad'
   import { notifications } from '$lib/components/toasts/notifications'
 
   let throttle = new throttler()
@@ -64,14 +64,13 @@
   }
 
   const updateData = () => {
-    data[0] = 0
-    data[1] = toInt8($input.left.x, -1, 1)
-    data[2] = toInt8($input.left.y, -1, 1)
-    data[3] = toInt8($input.right.x, -1, 1)
-    data[4] = toInt8($input.right.y, -1, 1)
-    data[5] = toInt8($input.height, 0, 100)
-    data[6] = toInt8($input.speed, 0, 100)
-    data[7] = toInt8($input.s1, 0, 100)
+    data[0] = $input.left.x
+    data[1] = $input.left.y
+    data[2] = $input.right.x
+    data[3] = $input.right.y
+    data[4] = $input.height
+    data[5] = $input.speed
+    data[6] = $input.s1
 
     outControllerData.set(data)
   }
@@ -122,7 +121,11 @@
   </div>
   <div class="absolute bottom-0 z-10 flex items-end">
     <div class="flex items-center flex-col bg-base-300 bg-opacity-50 p-3 pb-2 gap-2 rounded-tr-xl">
-      <VerticalSlider min={0} max={100} oninput={(e: Event) => handleRange(e, 'height')} />
+      <VerticalSlider
+        min={0}
+        max={1}
+        step={0.01}
+        oninput={(e: Event) => handleRange(e, 'height')} />
       <label for="height">Ht</label>
     </div>
     <div
@@ -146,7 +149,8 @@
               type="range"
               name="s1"
               min="0"
-              max="25"
+              step="0.01"
+              max="1"
               oninput={e => handleRange(e, 's1')}
               class="range range-sm range-primary" />
           </div>
@@ -156,7 +160,8 @@
               type="range"
               name="speed"
               min="0"
-              max="25"
+              step="0.01"
+              max="1"
               oninput={e => handleRange(e, 'speed')}
               class="range range-sm range-primary" />
           </div>