Spaces:
Running
Running
<html lang="en"> | |
<head> | |
<meta charset="UTF-8" /> | |
<meta name="viewport" content="width=device-width, initial-scale=1.0" /> | |
<title>Feetech Servo Test</title> | |
<style> | |
body { | |
font-family: sans-serif; | |
line-height: 1.6; | |
padding: 20px; | |
} | |
.container { | |
max-width: 800px; | |
margin: auto; | |
} | |
.section { | |
border: 1px solid #ccc; | |
padding: 15px; | |
margin-bottom: 20px; | |
border-radius: 5px; | |
} | |
h2 { | |
margin-top: 0; | |
} | |
label { | |
display: inline-block; | |
min-width: 100px; | |
margin-bottom: 5px; | |
} | |
input[type="number"], | |
input[type="text"] { | |
width: 100px; | |
padding: 5px; | |
margin-right: 10px; | |
margin-bottom: 10px; | |
} | |
button { | |
padding: 8px 15px; | |
margin-right: 10px; | |
cursor: pointer; | |
} | |
pre { | |
background-color: #f4f4f4; | |
padding: 10px; | |
border: 1px solid #ddd; | |
border-radius: 3px; | |
white-space: pre-wrap; | |
word-wrap: break-word; | |
} | |
.status { | |
font-weight: bold; | |
} | |
.success { | |
color: green; | |
} | |
.error { | |
color: red; | |
} | |
.log-area { | |
margin-top: 10px; | |
} | |
</style> | |
</head> | |
<body> | |
<div class="container"> | |
<h1>Feetech Servo Test Page</h1> | |
<details class="section"> | |
<summary>Key Concepts</summary> | |
<p>Understanding these parameters is crucial for controlling Feetech servos:</p> | |
<ul> | |
<li> | |
<strong>Mode:</strong> Determines the servo's primary function. | |
<ul> | |
<li> | |
<code>Mode 0</code>: Position/Servo Mode. The servo moves to and holds a specific | |
angular position. | |
</li> | |
<li> | |
<code>Mode 1</code>: Wheel/Speed Mode. The servo rotates continuously at a specified | |
speed and direction, like a motor. | |
</li> | |
</ul> | |
Changing the mode requires unlocking, writing the mode value (0 or 1), and locking the | |
configuration. | |
</li> | |
<li> | |
<strong>Position:</strong> In Position Mode (Mode 0), this value represents the target | |
or current angular position of the servo's output shaft. | |
<ul> | |
<li> | |
Range: Typically <code>0</code> to <code>4095</code> (representing a 12-bit | |
resolution). | |
</li> | |
<li> | |
Meaning: Corresponds to the servo's rotational range (e.g., 0-360 degrees or 0-270 | |
degrees, depending on the specific servo model). <code>0</code> is one end of the | |
range, <code>4095</code> is the other. | |
</li> | |
</ul> | |
</li> | |
<li> | |
<strong>Speed (Wheel Mode):</strong> In Wheel Mode (Mode 1), this value controls the | |
rotational speed and direction. | |
<ul> | |
<li> | |
Range: Typically <code>-2500</code> to <code>+2500</code>. (Note: Some documentation | |
might mention -1023 to +1023, but the SDK example uses a wider range). | |
</li> | |
<li> | |
Meaning: <code>0</code> stops the wheel. Positive values rotate in one direction | |
(e.g., clockwise), negative values rotate in the opposite direction (e.g., | |
counter-clockwise). The magnitude determines the speed (larger absolute value means | |
faster rotation). | |
</li> | |
<li>Control Address: <code>ADDR_SCS_GOAL_SPEED</code> (Register 46/47).</li> | |
</ul> | |
</li> | |
<li> | |
<strong>Acceleration:</strong> Controls how quickly the servo changes speed to reach its | |
target position (in Position Mode) or target speed (in Wheel Mode). | |
<ul> | |
<li>Range: Typically <code>0</code> to <code>254</code>.</li> | |
<li> | |
Meaning: Defines the rate of change of speed. The unit is 100 steps/s². | |
<code>0</code> usually means instantaneous acceleration (or minimal delay). Higher | |
values result in slower, smoother acceleration and deceleration. For example, a | |
value of <code>10</code> means the speed changes by 10 * 100 = 1000 steps per | |
second, per second. This helps reduce jerky movements and mechanical stress. | |
</li> | |
<li>Control Address: <code>ADDR_SCS_GOAL_ACC</code> (Register 41).</li> | |
</ul> | |
</li> | |
<li> | |
<strong>Baud Rate:</strong> The speed of communication between the controller and the | |
servo. It must match on both ends. Servos often support multiple baud rates, selectable | |
via an index: | |
<ul> | |
<li>Index 0: 1,000,000 bps</li> | |
<li>Index 1: 500,000 bps</li> | |
<li>Index 2: 250,000 bps</li> | |
<li>Index 3: 128,000 bps</li> | |
<li>Index 4: 115,200 bps</li> | |
<li>Index 5: 76,800 bps</li> | |
<li>Index 6: 57,600 bps</li> | |
<li>Index 7: 38,400 bps</li> | |
</ul> | |
</li> | |
</ul> | |
</details> | |
<div class="section"> | |
<h2>Connection</h2> | |
<button id="connectBtn">Connect</button> | |
<button id="disconnectBtn">Disconnect</button> | |
<p>Status: <span id="connectionStatus" class="status error">Disconnected</span></p> | |
<label for="baudRate">Baud Rate:</label> | |
<input type="number" id="baudRate" value="1000000" /> | |
<label for="protocolEnd">Protocol End (0=STS/SMS, 1=SCS):</label> | |
<input type="number" id="protocolEnd" value="0" min="0" max="1" /> | |
</div> | |
<div class="section"> | |
<h2>Scan Servos</h2> | |
<label for="scanStartId">Start ID:</label> | |
<input type="number" id="scanStartId" value="1" min="1" max="252" /> | |
<label for="scanEndId">End ID:</label> | |
<input type="number" id="scanEndId" value="15" min="1" max="252" /> | |
<button id="scanServosBtn">Scan</button> | |
<p>Scan Results:</p> | |
<pre id="scanResultsOutput" style="max-height: 200px; overflow-y: auto"></pre> | |
<!-- Added element for results --> | |
</div> | |
<div class="section"> | |
<h2>Single Servo Control</h2> | |
<label for="servoId">Servo ID:</label> | |
<input type="number" id="servoId" value="1" min="1" max="252" /><br /> | |
<label for="idWrite">Change servo ID:</label> | |
<input type="number" id="idWrite" value="1" min="1" max="252" /> | |
<button id="writeIdBtn">Write</button><br /> | |
<label for="baudRead">Read Baud Rate:</label> | |
<button id="readBaudBtn">Read</button> | |
<span id="readBaudResult"></span><br /> | |
<label for="baudWrite">Write Baud Rate Index:</label> | |
<input type="number" id="baudWrite" value="6" min="0" max="7" /> | |
<!-- Assuming index 0-7 --> | |
<button id="writeBaudBtn">Write</button><br /> | |
<label for="positionRead">Read Position:</label> | |
<button id="readPosBtn">Read</button> | |
<span id="readPosResult"></span><br /> | |
<label for="positionWrite">Write Position:</label> | |
<input type="number" id="positionWrite" value="1000" min="0" max="4095" /> | |
<button id="writePosBtn">Write</button><br /> | |
<label for="torqueEnable">Torque:</label> | |
<button id="torqueEnableBtn">Enable</button> | |
<button id="torqueDisableBtn">Disable</button><br /> | |
<label for="accelerationWrite">Write Acceleration:</label> | |
<input type="number" id="accelerationWrite" value="50" min="0" max="254" /> | |
<button id="writeAccBtn">Write</button><br /> | |
<label for="wheelMode">Wheel Mode:</label> | |
<button id="setWheelModeBtn">Set Wheel Mode</button> | |
<button id="removeWheelModeBtn">Set Position Mode</button><br /> | |
<label for="wheelSpeedWrite">Write Wheel Speed:</label> | |
<input type="number" id="wheelSpeedWrite" value="0" min="-2500" max="2500" /> | |
<button id="writeWheelSpeedBtn">Write Speed</button> | |
</div> | |
<div class="section"> | |
<h2>Sync Operations</h2> | |
<label for="syncReadIds">Sync Read IDs (csv):</label> | |
<input type="text" id="syncReadIds" value="1,2,3" style="width: 150px" /> | |
<button id="syncReadBtn">Sync Read Positions</button><br /> | |
<label for="syncWriteData">Sync Write (id:pos,...):</label> | |
<input type="text" id="syncWriteData" value="1:1500,2:2500" style="width: 200px" /> | |
<button id="syncWriteBtn">Sync Write Positions</button><br /> | |
<label for="syncWriteSpeedData">Sync Write Speed (id:speed,...):</label> | |
<input type="text" id="syncWriteSpeedData" value="1:500,2:-1000" style="width: 200px" /> | |
<button id="syncWriteSpeedBtn">Sync Write Speeds</button> | |
<!-- New Button --> | |
</div> | |
<div class="section"> | |
<h2>Log Output</h2> | |
<pre id="logOutput"></pre> | |
</div> | |
</div> | |
<script type="module"> | |
// Import the scsServoSDK object from index.mjs | |
import { scsServoSDK } from "./index.mjs"; | |
// No longer need COMM_SUCCESS etc. here as errors are thrown | |
const connectBtn = document.getElementById("connectBtn"); | |
const disconnectBtn = document.getElementById("disconnectBtn"); | |
const connectionStatus = document.getElementById("connectionStatus"); | |
const baudRateInput = document.getElementById("baudRate"); | |
const protocolEndInput = document.getElementById("protocolEnd"); | |
const servoIdInput = document.getElementById("servoId"); | |
const readIdBtn = document.getElementById("readIdBtn"); // New | |
const readIdResult = document.getElementById("readIdResult"); // New | |
const idWriteInput = document.getElementById("idWrite"); // New | |
const writeIdBtn = document.getElementById("writeIdBtn"); // New | |
const readBaudBtn = document.getElementById("readBaudBtn"); // New | |
const readBaudResult = document.getElementById("readBaudResult"); // New | |
const baudWriteInput = document.getElementById("baudWrite"); // New | |
const writeBaudBtn = document.getElementById("writeBaudBtn"); // New | |
const readPosBtn = document.getElementById("readPosBtn"); | |
const readPosResult = document.getElementById("readPosResult"); | |
const positionWriteInput = document.getElementById("positionWrite"); | |
const writePosBtn = document.getElementById("writePosBtn"); | |
const torqueEnableBtn = document.getElementById("torqueEnableBtn"); | |
const torqueDisableBtn = document.getElementById("torqueDisableBtn"); | |
const accelerationWriteInput = document.getElementById("accelerationWrite"); | |
const writeAccBtn = document.getElementById("writeAccBtn"); | |
const setWheelModeBtn = document.getElementById("setWheelModeBtn"); | |
const removeWheelModeBtn = document.getElementById("removeWheelModeBtn"); // Get reference to the new button | |
const wheelSpeedWriteInput = document.getElementById("wheelSpeedWrite"); | |
const writeWheelSpeedBtn = document.getElementById("writeWheelSpeedBtn"); | |
const syncReadIdsInput = document.getElementById("syncReadIds"); | |
const syncReadBtn = document.getElementById("syncReadBtn"); | |
const syncWriteDataInput = document.getElementById("syncWriteData"); | |
const syncWriteBtn = document.getElementById("syncWriteBtn"); | |
const syncWriteSpeedDataInput = document.getElementById("syncWriteSpeedData"); // New Input | |
const syncWriteSpeedBtn = document.getElementById("syncWriteSpeedBtn"); // New Button | |
const scanServosBtn = document.getElementById("scanServosBtn"); // Get reference to the scan button | |
const scanStartIdInput = document.getElementById("scanStartId"); // Get reference to start ID input | |
const scanEndIdInput = document.getElementById("scanEndId"); // Get reference to end ID input | |
const scanResultsOutput = document.getElementById("scanResultsOutput"); // Get reference to the new results area | |
const logOutput = document.getElementById("logOutput"); | |
let isConnected = false; | |
function log(message) { | |
console.log(message); | |
const timestamp = new Date().toLocaleTimeString(); | |
logOutput.textContent = `[${timestamp}] ${message}\n` + logOutput.textContent; | |
// Limit log size | |
const lines = logOutput.textContent.split("\n"); // Use '\n' instead of literal newline | |
if (lines.length > 50) { | |
logOutput.textContent = lines.slice(0, 50).join("\n"); // Use '\n' instead of literal newline | |
} | |
} | |
function updateConnectionStatus(connected, message) { | |
isConnected = connected; | |
connectionStatus.textContent = message || (connected ? "Connected" : "Disconnected"); | |
connectionStatus.className = `status ${connected ? "success" : "error"}`; | |
log(`Connection status: ${connectionStatus.textContent}`); | |
} | |
connectBtn.onclick = async () => { | |
log("Attempting to connect..."); | |
try { | |
const baudRate = parseInt(baudRateInput.value, 10); | |
const protocolEnd = parseInt(protocolEndInput.value, 10); | |
// Use scsServoSDK - throws on error | |
await scsServoSDK.connect({ baudRate, protocolEnd }); | |
updateConnectionStatus(true, "Connected"); | |
} catch (err) { | |
updateConnectionStatus(false, `Connection error: ${err.message}`); | |
console.error(err); | |
} | |
}; | |
disconnectBtn.onclick = async () => { | |
log("Attempting to disconnect..."); | |
try { | |
// Use scsServoSDK - throws on error | |
await scsServoSDK.disconnect(); | |
updateConnectionStatus(false, "Disconnected"); // Success means disconnected | |
} catch (err) { | |
// Assuming disconnect might fail if already disconnected or other issues | |
updateConnectionStatus(false, `Disconnection error: ${err.message}`); | |
console.error(err); | |
} | |
}; | |
writeIdBtn.onclick = async () => { | |
// New handler | |
if (!isConnected) { | |
log("Error: Not connected"); | |
return; | |
} | |
const currentId = parseInt(servoIdInput.value, 10); | |
const newId = parseInt(idWriteInput.value, 10); | |
if (isNaN(newId) || newId < 1 || newId > 252) { | |
log(`Error: Invalid new ID ${newId}. Must be between 1 and 252.`); | |
return; | |
} | |
log(`Writing new ID ${newId} to servo ${currentId}...`); | |
try { | |
// Use scsServoSDK - throws on error | |
await scsServoSDK.setServoId(currentId, newId); | |
log(`Successfully wrote new ID ${newId} to servo (was ${currentId}).`); | |
// IMPORTANT: Update the main ID input to reflect the change | |
servoIdInput.value = newId; | |
log(`Servo ID input field updated to ${newId}.`); | |
} catch (err) { | |
log(`Error writing ID for servo ${currentId}: ${err.message}`); | |
console.error(err); | |
} | |
}; | |
readBaudBtn.onclick = async () => { | |
// New handler | |
if (!isConnected) { | |
log("Error: Not connected"); | |
return; | |
} | |
const id = parseInt(servoIdInput.value, 10); | |
log(`Reading Baud Rate Index for servo ${id}...`); | |
readBaudResult.textContent = "Reading..."; | |
try { | |
// Use scsServoSDK - returns value directly or throws | |
const baudRateIndex = await scsServoSDK.readBaudRate(id); | |
readBaudResult.textContent = `Baud Index: ${baudRateIndex}`; | |
log(`Servo ${id} Baud Rate Index: ${baudRateIndex}`); | |
} catch (err) { | |
readBaudResult.textContent = `Error: ${err.message}`; | |
log(`Error reading Baud Rate Index for servo ${id}: ${err.message}`); | |
console.error(err); | |
} | |
}; | |
writeBaudBtn.onclick = async () => { | |
// New handler | |
if (!isConnected) { | |
log("Error: Not connected"); | |
return; | |
} | |
const id = parseInt(servoIdInput.value, 10); | |
const newBaudIndex = parseInt(baudWriteInput.value, 10); | |
if (isNaN(newBaudIndex) || newBaudIndex < 0 || newBaudIndex > 7) { | |
// Adjust max index if needed | |
log(`Error: Invalid new Baud Rate Index ${newBaudIndex}. Check valid range.`); | |
return; | |
} | |
log(`Writing new Baud Rate Index ${newBaudIndex} to servo ${id}...`); | |
try { | |
// Use scsServoSDK - throws on error | |
await scsServoSDK.setBaudRate(id, newBaudIndex); | |
log(`Successfully wrote new Baud Rate Index ${newBaudIndex} to servo ${id}.`); | |
log( | |
`IMPORTANT: You may need to disconnect and reconnect with the new baud rate if it differs from the current connection baud rate.` | |
); | |
} catch (err) { | |
log(`Error writing Baud Rate Index for servo ${id}: ${err.message}`); | |
console.error(err); | |
} | |
}; | |
readPosBtn.onclick = async () => { | |
if (!isConnected) { | |
log("Error: Not connected"); | |
return; | |
} | |
const id = parseInt(servoIdInput.value, 10); | |
log(`Reading position for servo ${id}...`); | |
readPosResult.textContent = "Reading..."; | |
try { | |
// Use scsServoSDK - returns value directly or throws | |
const position = await scsServoSDK.readPosition(id); | |
readPosResult.textContent = `Position: ${position}`; | |
log(`Servo ${id} position: ${position}`); | |
} catch (err) { | |
readPosResult.textContent = `Error: ${err.message}`; | |
log(`Error reading position for servo ${id}: ${err.message}`); | |
console.error(err); | |
} | |
}; | |
writePosBtn.onclick = async () => { | |
if (!isConnected) { | |
log("Error: Not connected"); | |
return; | |
} | |
const id = parseInt(servoIdInput.value, 10); | |
const pos = parseInt(positionWriteInput.value, 10); | |
log(`Writing position ${pos} to servo ${id}...`); | |
try { | |
// Use scsServoSDK - throws on error | |
await scsServoSDK.writePosition(id, pos); | |
log(`Successfully wrote position ${pos} to servo ${id}.`); | |
} catch (err) { | |
log(`Error writing position for servo ${id}: ${err.message}`); | |
console.error(err); | |
} | |
}; | |
torqueEnableBtn.onclick = async () => { | |
if (!isConnected) { | |
log("Error: Not connected"); | |
return; | |
} | |
const id = parseInt(servoIdInput.value, 10); | |
log(`Enabling torque for servo ${id}...`); | |
try { | |
// Use scsServoSDK - throws on error | |
await scsServoSDK.writeTorqueEnable(id, true); | |
log(`Successfully enabled torque for servo ${id}.`); | |
} catch (err) { | |
log(`Error enabling torque for servo ${id}: ${err.message}`); | |
console.error(err); | |
} | |
}; | |
torqueDisableBtn.onclick = async () => { | |
if (!isConnected) { | |
log("Error: Not connected"); | |
return; | |
} | |
const id = parseInt(servoIdInput.value, 10); | |
log(`Disabling torque for servo ${id}...`); | |
try { | |
// Use scsServoSDK - throws on error | |
await scsServoSDK.writeTorqueEnable(id, false); | |
log(`Successfully disabled torque for servo ${id}.`); | |
} catch (err) { | |
log(`Error disabling torque for servo ${id}: ${err.message}`); | |
console.error(err); | |
} | |
}; | |
writeAccBtn.onclick = async () => { | |
if (!isConnected) { | |
log("Error: Not connected"); | |
return; | |
} | |
const id = parseInt(servoIdInput.value, 10); | |
const acc = parseInt(accelerationWriteInput.value, 10); | |
log(`Writing acceleration ${acc} to servo ${id}...`); | |
try { | |
// Use scsServoSDK - throws on error | |
await scsServoSDK.writeAcceleration(id, acc); | |
log(`Successfully wrote acceleration ${acc} to servo ${id}.`); | |
} catch (err) { | |
log(`Error writing acceleration for servo ${id}: ${err.message}`); | |
console.error(err); | |
} | |
}; | |
setWheelModeBtn.onclick = async () => { | |
if (!isConnected) { | |
log("Error: Not connected"); | |
return; | |
} | |
const id = parseInt(servoIdInput.value, 10); | |
log(`Setting servo ${id} to wheel mode...`); | |
try { | |
// Use scsServoSDK - throws on error | |
await scsServoSDK.setWheelMode(id); | |
log(`Successfully set servo ${id} to wheel mode.`); | |
} catch (err) { | |
log(`Error setting wheel mode for servo ${id}: ${err.message}`); | |
console.error(err); | |
} | |
}; | |
// Add event listener for the new button | |
removeWheelModeBtn.onclick = async () => { | |
if (!isConnected) { | |
log("Error: Not connected"); | |
return; | |
} | |
const id = parseInt(servoIdInput.value, 10); | |
log(`Setting servo ${id} back to position mode...`); | |
try { | |
// Use scsServoSDK - throws on error | |
await scsServoSDK.setPositionMode(id); | |
log(`Successfully set servo ${id} back to position mode.`); | |
} catch (err) { | |
log(`Error setting position mode for servo ${id}: ${err.message}`); | |
console.error(err); | |
} | |
}; | |
writeWheelSpeedBtn.onclick = async () => { | |
if (!isConnected) { | |
log("Error: Not connected"); | |
return; | |
} | |
const id = parseInt(servoIdInput.value, 10); | |
const speed = parseInt(wheelSpeedWriteInput.value, 10); | |
log(`Writing wheel speed ${speed} to servo ${id}...`); | |
try { | |
// Use scsServoSDK - throws on error | |
await scsServoSDK.writeWheelSpeed(id, speed); | |
log(`Successfully wrote wheel speed ${speed} to servo ${id}.`); | |
} catch (err) { | |
log(`Error writing wheel speed for servo ${id}: ${err.message}`); | |
console.error(err); | |
} | |
}; | |
syncReadBtn.onclick = async () => { | |
if (!isConnected) { | |
log("Error: Not connected"); | |
return; | |
} | |
const idsString = syncReadIdsInput.value; | |
const ids = idsString | |
.split(",") | |
.map((s) => parseInt(s.trim(), 10)) | |
.filter((id) => !isNaN(id) && id > 0 && id < 253); | |
if (ids.length === 0) { | |
log("Sync Read: No valid servo IDs provided."); | |
return; | |
} | |
log(`Sync reading positions for servos: ${ids.join(", ")}...`); | |
try { | |
// Use scsServoSDK - returns Map or throws | |
const positions = await scsServoSDK.syncReadPositions(ids); | |
let logMsg = "Sync Read Successful:\n"; | |
positions.forEach((pos, id) => { | |
logMsg += ` Servo ${id}: Position=${pos}\n`; | |
}); | |
log(logMsg.trim()); | |
} catch (err) { | |
log(`Sync Read Failed: ${err.message}`); | |
console.error(err); | |
} | |
}; | |
syncWriteBtn.onclick = async () => { | |
if (!isConnected) { | |
log("Error: Not connected"); | |
return; | |
} | |
const dataString = syncWriteDataInput.value; | |
const positionMap = new Map(); | |
const pairs = dataString.split(","); | |
let validData = false; | |
pairs.forEach((pair) => { | |
const parts = pair.split(":"); | |
if (parts.length === 2) { | |
const id = parseInt(parts[0].trim(), 10); | |
const pos = parseInt(parts[1].trim(), 10); | |
// Position validation (0-4095) | |
if (!isNaN(id) && id > 0 && id < 253 && !isNaN(pos) && pos >= 0 && pos <= 4095) { | |
positionMap.set(id, pos); | |
validData = true; | |
} else { | |
log( | |
`Sync Write Position: Invalid data pair "${pair}". ID (1-252), Pos (0-4095). Skipping.` | |
); | |
} | |
} else { | |
log(`Sync Write Position: Invalid format "${pair}". Skipping.`); | |
} | |
}); | |
if (!validData) { | |
log("Sync Write Position: No valid servo position data provided."); | |
return; | |
} | |
log( | |
`Sync writing positions: ${Array.from(positionMap.entries()) | |
.map(([id, pos]) => `${id}:${pos}`) | |
.join(", ")}...` | |
); | |
try { | |
// Use scsServoSDK - throws on error | |
await scsServoSDK.syncWritePositions(positionMap); | |
log(`Sync write position command sent successfully.`); | |
} catch (err) { | |
log(`Sync Write Position Failed: ${err.message}`); | |
console.error(err); | |
} | |
}; | |
// New handler for Sync Write Speed | |
syncWriteSpeedBtn.onclick = async () => { | |
if (!isConnected) { | |
log("Error: Not connected"); | |
return; | |
} | |
const dataString = syncWriteSpeedDataInput.value; | |
const speedMap = new Map(); | |
const pairs = dataString.split(","); | |
let validData = false; | |
pairs.forEach((pair) => { | |
const parts = pair.split(":"); | |
if (parts.length === 2) { | |
const id = parseInt(parts[0].trim(), 10); | |
const speed = parseInt(parts[1].trim(), 10); | |
// Speed validation (-10000 to 10000) | |
if ( | |
!isNaN(id) && | |
id > 0 && | |
id < 253 && | |
!isNaN(speed) && | |
speed >= -10000 && | |
speed <= 10000 | |
) { | |
speedMap.set(id, speed); | |
validData = true; | |
} else { | |
log( | |
`Sync Write Speed: Invalid data pair "${pair}". ID (1-252), Speed (-10000 to 10000). Skipping.` | |
); | |
} | |
} else { | |
log(`Sync Write Speed: Invalid format "${pair}". Skipping.`); | |
} | |
}); | |
if (!validData) { | |
log("Sync Write Speed: No valid servo speed data provided."); | |
return; | |
} | |
log( | |
`Sync writing speeds: ${Array.from(speedMap.entries()) | |
.map(([id, speed]) => `${id}:${speed}`) | |
.join(", ")}...` | |
); | |
try { | |
// Use scsServoSDK - throws on error | |
await scsServoSDK.syncWriteWheelSpeed(speedMap); | |
log(`Sync write speed command sent successfully.`); | |
} catch (err) { | |
log(`Sync Write Speed Failed: ${err.message}`); | |
console.error(err); | |
} | |
}; | |
scanServosBtn.onclick = async () => { | |
if (!isConnected) { | |
log("Error: Not connected"); | |
return; | |
} | |
const startId = parseInt(scanStartIdInput.value, 10); | |
const endId = parseInt(scanEndIdInput.value, 10); | |
if (isNaN(startId) || isNaN(endId) || startId < 1 || endId > 252 || startId > endId) { | |
const errorMsg = | |
"Error: Invalid scan ID range. Please enter values between 1 and 252, with Start ID <= End ID."; | |
log(errorMsg); | |
scanResultsOutput.textContent = errorMsg; // Show error in results area too | |
return; | |
} | |
const startMsg = `Starting servo scan (IDs ${startId}-${endId})...`; | |
log(startMsg); | |
scanResultsOutput.textContent = startMsg + "\n"; // Clear and start results area | |
scanServosBtn.disabled = true; // Disable button during scan | |
let foundCount = 0; | |
for (let id = startId; id <= endId; id++) { | |
let resultMsg = `Scanning ID ${id}... `; | |
try { | |
// Attempt to read position. If it succeeds, the servo exists. | |
// If it throws, the servo likely doesn't exist or there's another issue. | |
const position = await scsServoSDK.readPosition(id); | |
foundCount++; | |
// Servo found, now try to read mode and baud rate | |
let mode = "ReadError"; | |
let baudRateIndex = "ReadError"; | |
try { | |
mode = await scsServoSDK.readMode(id); | |
} catch (modeErr) { | |
log(` Servo ${id}: Error reading mode: ${modeErr.message}`); | |
} | |
try { | |
baudRateIndex = await scsServoSDK.readBaudRate(id); | |
} catch (baudErr) { | |
log(` Servo ${id}: Error reading baud rate: ${baudErr.message}`); | |
} | |
resultMsg += `FOUND: Pos=${position}, Mode=${mode}, BaudIdx=${baudRateIndex}`; | |
log( | |
` Servo ${id} FOUND: Position=${position}, Mode=${mode}, BaudIndex=${baudRateIndex}` | |
); | |
} catch (err) { | |
// Check if the error message indicates a timeout or non-response, which is expected for non-existent IDs | |
// This check might need refinement based on the exact error messages thrown by readPosition | |
if ( | |
err.message.includes("timeout") || | |
err.message.includes("No response") || | |
err.message.includes("failed: RX") | |
) { | |
resultMsg += `No response`; | |
// log(` Servo ${id}: No response`); // Optional: reduce log noise | |
} else { | |
// Log other unexpected errors | |
resultMsg += `Error: ${err.message}`; | |
log(` Servo ${id}: Error during scan: ${err.message}`); | |
console.error(`Error scanning servo ${id}:`, err); | |
} | |
} | |
scanResultsOutput.textContent += resultMsg + "\n"; // Append result to the results area | |
scanResultsOutput.scrollTop = scanResultsOutput.scrollHeight; // Auto-scroll | |
// Optional small delay between scans if needed | |
// await new Promise(resolve => setTimeout(resolve, 10)); | |
} | |
const finishMsg = `Servo scan finished. Found ${foundCount} servo(s).`; | |
log(finishMsg); | |
scanResultsOutput.textContent += finishMsg + "\n"; // Add finish message to results area | |
scanResultsOutput.scrollTop = scanResultsOutput.scrollHeight; // Auto-scroll | |
scanServosBtn.disabled = false; // Re-enable button | |
}; | |
// Initial log | |
log("Test page loaded. Please connect to a servo controller."); | |
</script> | |
</body> | |
</html> | |