kinematic motion controller

web/js/sections/input-text.js

@@ -2,6 +2,7 @@ import BLE from '../ble.js';
 import UI from '../ui.js';
 import IK from '../kinematics.js';
 import Settings from '../settings.js';
+import Motion from '../motion.js';
 import { buildQuickSequencesHTML, initQuickSequences } from '../quick-sequences.js';
 
 let eventCleanup = [];
@@ -17,6 +18,7 @@ function syncStateFromStorage() {
   isHomed = localStorage.getItem('wiji_homed') === 'true';
   steps1 = isHomed ? parseInt(localStorage.getItem('wiji_steps1') || IK.ARM.HOME_STEPS.m1) : IK.ARM.HOME_STEPS.m1;
   steps2 = isHomed ? parseInt(localStorage.getItem('wiji_steps2') || IK.ARM.HOME_STEPS.m2) : IK.ARM.HOME_STEPS.m2;
+  Motion.setSteps(steps1, steps2);
 }
 
 function saveSteps() {
@@ -263,44 +265,8 @@ function delay(ms) {
 }
 
 async function executeMove(spot) {
-  const wsCheck = IK.checkWorkspace(spot.x, spot.y);
-  if (!wsCheck.ok) {
-    UI.log(`⛔ ${wsCheck.reason}`, 'error');
-    return false;
-  }
-
-  const res = IK.solve(spot.x, spot.y);
-  if (!res.reachable || IK.armsCrossed(res.theta1, res.theta2)) {
-    UI.log(`Target ${spot.label} is unreachable or crosses arms.`, 'error');
-    return false;
-  }
-
-  const newSteps1 = IK.radToStepsAbsolute(res.theta1, 1);
-  const newSteps2 = IK.radToStepsAbsolute(res.theta2, 2);
-  const delta1 = newSteps1 - steps1;
-  const delta2 = newSteps2 - steps2;
-
-  const cmd1 = `S1${delta1 >= 0 ? '+' : ''}${delta1}`;
-  const cmd2 = `S2${delta2 >= 0 ? '+' : ''}${delta2}`;
-
   UI.log(`Spelling: ${spot.label}`, 'info');
-
-  if (BLE.isConnected()) {
-    try {
-      await BLE.write(cmd1);
-      await BLE.write(cmd2);
-    } catch (e) {
-      UI.log(`BLE error: ${e.message}`, 'error');
-      return false;
-    }
-  } else {
-    steps1 = newSteps1;
-    steps2 = newSteps2;
-    saveSteps();
-    updatePosMarker();
-    console.log(`[sim] ${cmd1}  ${cmd2}`);
-  }
-  return true;
+  return await Motion.goto(spot.x, spot.y);
 }
 
 async function spellText(text) {
@@ -414,6 +380,7 @@ export default {
       } else {
         steps1 = IK.ARM.HOME_STEPS.m1;
         steps2 = IK.ARM.HOME_STEPS.m2;
+        Motion.setSteps(steps1, steps2);
         saveSteps();
         updatePosMarker();
         UI.log('[sim] HOMEALL', 'info');