|
2393 | 2393 | function updateStateUI() { |
2394 | 2394 | const s = Math.min(robotState, STATE_NAMES.length - 1); |
2395 | 2395 |
|
2396 | | - // Compute fallen direction sub-state (uses latest pitch/roll data) |
2397 | | - let stateName = STATE_NAMES[s] || String(robotState); |
2398 | | - if (robotState === 0) { |
2399 | | - const p = lastPitch || 0; |
2400 | | - const r = lastRollAngle; |
2401 | | - if (Math.abs(r) > 60) { |
2402 | | - fallenDir = r > 0 ? 3 : 4; |
2403 | | - stateName = r > 0 ? 'FALLEN LEFT' : 'FALLEN RIGHT'; |
2404 | | - } else if (Math.abs(p) > 30) { |
2405 | | - fallenDir = p > 0 ? 2 : 1; |
2406 | | - stateName = p > 0 ? 'FALLEN BWD' : 'FALLEN FWD'; |
2407 | | - } else { |
2408 | | - fallenDir = 0; |
2409 | | - } |
2410 | | - } else { |
2411 | | - fallenDir = 0; |
2412 | | - } |
| 2396 | + const stateName = STATE_NAMES[s] || String(robotState); |
| 2397 | + fallenDir = 0; |
2413 | 2398 |
|
2414 | 2399 | swingBtn.classList.toggle('active', robotState === 1); |
2415 | 2400 | standUpBtn.classList.toggle('active', robotState === 3); |
2416 | 2401 | playProgBtn.classList.toggle('active', robotState === 6); |
2417 | 2402 | ctrlStateVal.textContent = stateName; |
2418 | 2403 | ctrlStateCard.className = 'ctrl-card ' + (STATE_CSS[s] || ''); |
2419 | 2404 |
|
2420 | | - // D-pad hints: highlight button(s) relevant to current fall direction |
2421 | | - const pitchFallen = robotState === 0 && (fallenDir === 1 || fallenDir === 2); |
2422 | | - const leftFallen = robotState === 0 && fallenDir === 3; |
2423 | | - const rightFallen = robotState === 0 && fallenDir === 4; |
2424 | | - btnFwd.classList.toggle('dpad-hint', pitchFallen); |
2425 | | - btnBack.classList.toggle('dpad-hint', pitchFallen); |
2426 | | - btnLeft.classList.toggle('dpad-hint', leftFallen); |
2427 | | - btnRight.classList.toggle('dpad-hint', rightFallen); |
| 2405 | + btnFwd.classList.remove('dpad-hint'); |
| 2406 | + btnBack.classList.remove('dpad-hint'); |
| 2407 | + btnLeft.classList.remove('dpad-hint'); |
| 2408 | + btnRight.classList.remove('dpad-hint'); |
2428 | 2409 | } |
2429 | 2410 |
|
2430 | 2411 | // ==================== TABS ==================== |
|
0 commit comments