mirror of
https://github.com/legop3/MultiRoombaRover.git
synced 2026-09-16 17:40:46 -04:00
ugh..
This commit is contained in:
Vendored
BIN
Binary file not shown.
Vendored
BIN
Binary file not shown.
@@ -92,10 +92,6 @@ func (s *SerialAdapter) SendRaw(raw []byte) error {
|
|||||||
return s.write(raw)
|
return s.write(raw)
|
||||||
}
|
}
|
||||||
|
|
||||||
func (s *SerialAdapter) StartOI() error {
|
|
||||||
return s.write([]byte{128})
|
|
||||||
}
|
|
||||||
|
|
||||||
func (s *SerialAdapter) SeekDock() error {
|
func (s *SerialAdapter) SeekDock() error {
|
||||||
return s.write([]byte{143})
|
return s.write([]byte{143})
|
||||||
}
|
}
|
||||||
|
|||||||
@@ -52,11 +52,6 @@ func (s *SerialAdapter) SendRaw(raw []byte) error {
|
|||||||
return nil
|
return nil
|
||||||
}
|
}
|
||||||
|
|
||||||
func (s *SerialAdapter) StartOI() error {
|
|
||||||
s.log.Printf("[dummy] start OI")
|
|
||||||
return nil
|
|
||||||
}
|
|
||||||
|
|
||||||
func (s *SerialAdapter) SeekDock() error {
|
func (s *SerialAdapter) SeekDock() error {
|
||||||
s.log.Printf("[dummy] seek dock")
|
s.log.Printf("[dummy] seek dock")
|
||||||
return nil
|
return nil
|
||||||
|
|||||||
+13
-73
@@ -22,12 +22,6 @@ type WSClient struct {
|
|||||||
log *log.Logger
|
log *log.Logger
|
||||||
}
|
}
|
||||||
|
|
||||||
const (
|
|
||||||
sensorSilenceTimeout = 5 * time.Second
|
|
||||||
sensorRecoveryCooldown = 5 * time.Second
|
|
||||||
sensorCommandPause = 1 * time.Millisecond
|
|
||||||
)
|
|
||||||
|
|
||||||
func NewWSClient(cfg *Config, adapter *SerialAdapter, frames <-chan []byte, events chan RoverEvent, media *MediaSupervisor, servo *CameraServo, nightVision *NightVisionLight, logger *log.Logger) *WSClient {
|
func NewWSClient(cfg *Config, adapter *SerialAdapter, frames <-chan []byte, events chan RoverEvent, media *MediaSupervisor, servo *CameraServo, nightVision *NightVisionLight, logger *log.Logger) *WSClient {
|
||||||
return &WSClient{
|
return &WSClient{
|
||||||
cfg: cfg,
|
cfg: cfg,
|
||||||
@@ -132,15 +126,24 @@ func (c *WSClient) dispatch(ctx context.Context, msg *inboundMessage) error {
|
|||||||
return c.adapter.MotorPWM(main, side, vac)
|
return c.adapter.MotorPWM(main, side, vac)
|
||||||
case msg.SensorStream != nil:
|
case msg.SensorStream != nil:
|
||||||
if msg.SensorStream.Enable {
|
if msg.SensorStream.Enable {
|
||||||
return c.kickstartSensorStream(sensorCommandPause)
|
if err := c.adapter.StartSensorStream(defaultStreamPackets); err != nil {
|
||||||
|
return err
|
||||||
}
|
}
|
||||||
return nil
|
return c.adapter.PauseSensorStream(false)
|
||||||
|
}
|
||||||
|
return c.adapter.PauseSensorStream(true)
|
||||||
case msg.Raw != "" && len(msg.Raw) > 0:
|
case msg.Raw != "" && len(msg.Raw) > 0:
|
||||||
buf, err := base64.StdEncoding.DecodeString(msg.Raw)
|
buf, err := base64.StdEncoding.DecodeString(msg.Raw)
|
||||||
if err != nil {
|
if err != nil {
|
||||||
return fmt.Errorf("raw decode: %w", err)
|
return fmt.Errorf("raw decode: %w", err)
|
||||||
}
|
}
|
||||||
return c.adapter.SendRaw(buf)
|
if err := c.adapter.SendRaw(buf); err != nil {
|
||||||
|
return err
|
||||||
|
}
|
||||||
|
if len(buf) > 0 && isModeOpcode(buf[0]) {
|
||||||
|
return c.ensureSensorStream()
|
||||||
|
}
|
||||||
|
return nil
|
||||||
case msg.Media != nil:
|
case msg.Media != nil:
|
||||||
if c.media == nil {
|
if c.media == nil {
|
||||||
return fmt.Errorf("media supervisor disabled")
|
return fmt.Errorf("media supervisor disabled")
|
||||||
@@ -183,45 +186,11 @@ func (c *WSClient) handleServoCommand(payload *servoPayload) error {
|
|||||||
}
|
}
|
||||||
|
|
||||||
func (c *WSClient) forwardSensors(ctx context.Context, conn *websocket.Conn) {
|
func (c *WSClient) forwardSensors(ctx context.Context, conn *websocket.Conn) {
|
||||||
timer := time.NewTimer(sensorSilenceTimeout)
|
|
||||||
defer timer.Stop()
|
|
||||||
|
|
||||||
resetTimer := func() {
|
|
||||||
if !timer.Stop() {
|
|
||||||
select {
|
|
||||||
case <-timer.C:
|
|
||||||
default:
|
|
||||||
}
|
|
||||||
}
|
|
||||||
timer.Reset(sensorSilenceTimeout)
|
|
||||||
}
|
|
||||||
|
|
||||||
lastRecovery := time.Time{}
|
|
||||||
lastFrame := time.Now()
|
|
||||||
|
|
||||||
for {
|
for {
|
||||||
select {
|
select {
|
||||||
case <-ctx.Done():
|
case <-ctx.Done():
|
||||||
return
|
return
|
||||||
case <-timer.C:
|
|
||||||
now := time.Now()
|
|
||||||
if !lastRecovery.IsZero() && now.Sub(lastRecovery) < sensorRecoveryCooldown {
|
|
||||||
resetTimer()
|
|
||||||
continue
|
|
||||||
}
|
|
||||||
|
|
||||||
idleFor := now.Sub(lastFrame)
|
|
||||||
if idleFor < 0 {
|
|
||||||
idleFor = sensorSilenceTimeout
|
|
||||||
}
|
|
||||||
|
|
||||||
c.log.Printf("no sensor frames for %v; restarting OI and sensor stream", idleFor)
|
|
||||||
c.recoverSensorStream(idleFor, sensorCommandPause)
|
|
||||||
lastRecovery = now
|
|
||||||
resetTimer()
|
|
||||||
case frame := <-c.sensorFrames:
|
case frame := <-c.sensorFrames:
|
||||||
resetTimer()
|
|
||||||
lastFrame = time.Now()
|
|
||||||
msg := sensorMessage{
|
msg := sensorMessage{
|
||||||
Type: "sensor",
|
Type: "sensor",
|
||||||
Timestamp: time.Now().UnixMilli(),
|
Timestamp: time.Now().UnixMilli(),
|
||||||
@@ -289,39 +258,10 @@ func clamp(value, min, max int) int {
|
|||||||
}
|
}
|
||||||
|
|
||||||
func (c *WSClient) ensureSensorStream() error {
|
func (c *WSClient) ensureSensorStream() error {
|
||||||
return c.kickstartSensorStream(sensorCommandPause)
|
|
||||||
}
|
|
||||||
|
|
||||||
func (c *WSClient) recoverSensorStream(idleFor time.Duration, cmdPause time.Duration) {
|
|
||||||
c.emitEvent("sensorWatchdog.restart", map[string]any{
|
|
||||||
"idleMs": idleFor.Milliseconds(),
|
|
||||||
})
|
|
||||||
|
|
||||||
if err := c.kickstartSensorStream(cmdPause); err != nil {
|
|
||||||
c.log.Printf("sensor stream restart failed: %v", err)
|
|
||||||
c.emitEvent("sensorWatchdog.streamRestart.error", map[string]any{"error": err.Error()})
|
|
||||||
return
|
|
||||||
}
|
|
||||||
|
|
||||||
c.emitEvent("sensorWatchdog.streamRestart.ok", map[string]any{
|
|
||||||
"idleMs": idleFor.Milliseconds(),
|
|
||||||
})
|
|
||||||
}
|
|
||||||
|
|
||||||
func (c *WSClient) kickstartSensorStream(cmdPause time.Duration) error {
|
|
||||||
if err := c.adapter.StartOI(); err != nil {
|
|
||||||
return err
|
|
||||||
}
|
|
||||||
if cmdPause > 0 {
|
|
||||||
time.Sleep(cmdPause)
|
|
||||||
}
|
|
||||||
if err := c.adapter.StartSensorStream(defaultStreamPackets); err != nil {
|
if err := c.adapter.StartSensorStream(defaultStreamPackets); err != nil {
|
||||||
return err
|
return err
|
||||||
}
|
}
|
||||||
if cmdPause > 0 {
|
return c.adapter.PauseSensorStream(false)
|
||||||
time.Sleep(cmdPause)
|
|
||||||
}
|
|
||||||
return nil
|
|
||||||
}
|
}
|
||||||
|
|
||||||
func isModeOpcode(op byte) bool {
|
func isModeOpcode(op byte) bool {
|
||||||
|
|||||||
File diff suppressed because one or more lines are too long
@@ -11,7 +11,7 @@
|
|||||||
<meta name="apple-mobile-web-app-status-bar-style" content="black-translucent" />
|
<meta name="apple-mobile-web-app-status-bar-style" content="black-translucent" />
|
||||||
<meta name="apple-mobile-web-app-title" content="Multi Roomba Rover" />
|
<meta name="apple-mobile-web-app-title" content="Multi Roomba Rover" />
|
||||||
<title>Multi Roomba Rover</title>
|
<title>Multi Roomba Rover</title>
|
||||||
<script type="module" crossorigin src="/assets/index-CwvJUtN6.js"></script>
|
<script type="module" crossorigin src="/assets/index-BI_1Ts67.js"></script>
|
||||||
<link rel="stylesheet" crossorigin href="/assets/index-CsRcYKTY.css">
|
<link rel="stylesheet" crossorigin href="/assets/index-CsRcYKTY.css">
|
||||||
</head>
|
</head>
|
||||||
<body>
|
<body>
|
||||||
|
|||||||
@@ -105,9 +105,10 @@ export function useCommandPipeline() {
|
|||||||
type: 'raw',
|
type: 'raw',
|
||||||
data: { raw: bytesToBase64(bytes) },
|
data: { raw: bytesToBase64(bytes) },
|
||||||
});
|
});
|
||||||
|
enableSensorStream();
|
||||||
return true;
|
return true;
|
||||||
},
|
},
|
||||||
[emitCommand, roverId],
|
[emitCommand, enableSensorStream, roverId],
|
||||||
);
|
);
|
||||||
|
|
||||||
const runMacroSteps = useCallback(
|
const runMacroSteps = useCallback(
|
||||||
@@ -119,9 +120,6 @@ export function useCommandPipeline() {
|
|||||||
case 'oi':
|
case 'oi':
|
||||||
sendOiCommand(step.command);
|
sendOiCommand(step.command);
|
||||||
break;
|
break;
|
||||||
case 'sensorStream':
|
|
||||||
enableSensorStream();
|
|
||||||
break;
|
|
||||||
case 'drive':
|
case 'drive':
|
||||||
sendDriveDirect(step.speeds ?? { left: 0, right: 0 });
|
sendDriveDirect(step.speeds ?? { left: 0, right: 0 });
|
||||||
break;
|
break;
|
||||||
@@ -145,7 +143,7 @@ export function useCommandPipeline() {
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
},
|
},
|
||||||
[roverId, sendOiCommand, sendDriveDirect, sendAuxMotors, sendServoAngle, enableSensorStream],
|
[roverId, sendOiCommand, sendDriveDirect, sendAuxMotors, sendServoAngle],
|
||||||
);
|
);
|
||||||
|
|
||||||
const sendNightVision = useCallback(
|
const sendNightVision = useCallback(
|
||||||
|
|||||||
@@ -53,12 +53,10 @@ export const DEFAULT_MACROS = [
|
|||||||
{
|
{
|
||||||
id: 'drive-sequence',
|
id: 'drive-sequence',
|
||||||
label: 'Drive',
|
label: 'Drive',
|
||||||
description: 'Start OI, request sensors, dock poke, then full mode for driving.',
|
description: 'Start, dock, and full command sequence used by the drive button.',
|
||||||
steps: [
|
steps: [
|
||||||
{ type: 'oi', command: 'start' },
|
{ type: 'oi', command: 'start' },
|
||||||
{ type: 'pause', duration: COMMAND_DELAY_MS },
|
{ type: 'pause', duration: COMMAND_DELAY_MS },
|
||||||
{ type: 'sensorStream', enable: true },
|
|
||||||
{ type: 'pause', duration: COMMAND_DELAY_MS },
|
|
||||||
{ type: 'oi', command: 'dock' },
|
{ type: 'oi', command: 'dock' },
|
||||||
{ type: 'pause', duration: COMMAND_DELAY_MS },
|
{ type: 'pause', duration: COMMAND_DELAY_MS },
|
||||||
{ type: 'oi', command: 'full' },
|
{ type: 'oi', command: 'full' },
|
||||||
|
|||||||
Reference in New Issue
Block a user