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'; | |
const scsServoSDK = new ScsServoSDK(); | |
// 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> | |