forked from Blendman974/faceclaw
893 lines
30 KiB
TypeScript
893 lines
30 KiB
TypeScript
/**
|
|
* Navigate app worker: voice/tool-set destination, Mapbox routing, and
|
|
* turn-by-turn guidance with a live map pane.
|
|
*
|
|
* The BLE frame budget shapes the layout (see notes/navigate-app-design.md):
|
|
* the map bitmap (left pane) refreshes on a slow staleness policy, while the
|
|
* guidance text (right pane) updates per GPS fix and ships as small deltas.
|
|
*/
|
|
import "@nativescript/core/globals";
|
|
import { GrayImage } from "../graphics/image";
|
|
import { getDefaultSmallFont, getFont } from "../graphics/bdffont";
|
|
import * as frameTimings from "../native/frame-timings";
|
|
import type { DashboardInputEvent } from "../ui/layers";
|
|
import { defaultWindowMenuItems, WindowMenu } from "../ui/window-menu";
|
|
import type { WorkerAppMessage, WorkerAppReply } from "../ui/shell/worker-window";
|
|
import type { ToolSpec, ToolResult } from "../assistant/tool-registry";
|
|
import { GESTURE_CLICK, GESTURE_DOUBLE_CLICK, GESTURE_SCROLL } from "../ui/gestures";
|
|
import { LocationTracker, type TrackedLocation } from "../native/location-tracker";
|
|
import {
|
|
fetchRoute,
|
|
fetchStaticMapGray,
|
|
geocodeForward,
|
|
isMapboxConfigured,
|
|
type GeocodeCandidate,
|
|
type Route,
|
|
type RouteProfile,
|
|
type StaticMapCamera,
|
|
} from "../native/mapbox";
|
|
import { bearingDegrees, haversineMeters, RouteFollower, type RouteProgress } from "../navigate/route-follower";
|
|
import { drawManeuverGlyph } from "../navigate/maneuver-icons";
|
|
|
|
declare const global: any;
|
|
declare const com: any;
|
|
|
|
const MAP_SIZE = 260;
|
|
const PANEL_X = MAP_SIZE + 10;
|
|
/** Map refetch policy knobs (design doc: never per-fix, only when stale). */
|
|
const BEARING_BUCKET_DEG = 15;
|
|
const MOVE_REFRESH_FRACTION = 0.15;
|
|
const IDLE_REFRESH_MS = 5_000;
|
|
const IDLE_REFRESH_MIN_MOVE_M = 10;
|
|
const MAP_RETRY_BACKOFF_MS = 5_000;
|
|
const REROUTE_MIN_INTERVAL_MS = 20_000;
|
|
const FIRST_FIX_TIMEOUT_MS = 10_000;
|
|
const LOCATION_INTERVAL_MS = 1_000;
|
|
/** Above this speed a GPS bearing is trustworthy for heading-up. */
|
|
const BEARING_MIN_SPEED_MPS = 2.5;
|
|
|
|
const largeFont = getFont("terminus32");
|
|
const mediumFont = getFont("terminus24");
|
|
const smallFont = getDefaultSmallFont();
|
|
|
|
type NavPhase = "idle" | "acquiring" | "routing" | "navigating" | "arrived";
|
|
type MapMode = "follow" | "overview";
|
|
|
|
type NavWindow = {
|
|
windowId: string;
|
|
surfaceId: string;
|
|
viewportWidth: number;
|
|
viewportHeight: number;
|
|
foreground: boolean;
|
|
focused: boolean;
|
|
menu: WindowMenu | null;
|
|
lastSubmittedFingerprint: string;
|
|
};
|
|
|
|
const NAVIGATE_TOOLS: ToolSpec[] = [
|
|
{
|
|
name: "start_route",
|
|
description:
|
|
"Start turn-by-turn navigation to a destination. Give the destination as free text (a place name, business, or address); it is resolved near the user's current location. Returns the resolved destination, distance, and estimated time. If the wrong place was picked, call again with a more specific query.",
|
|
inputSchema: {
|
|
type: "object",
|
|
properties: {
|
|
query: { type: "string", description: "Destination to search for, e.g. 'Golden Gate Park' or '410 Townsend St'." },
|
|
profile: {
|
|
type: "string",
|
|
enum: ["driving", "walking", "cycling"],
|
|
description: "Travel mode (default driving).",
|
|
},
|
|
},
|
|
required: ["query"],
|
|
additionalProperties: false,
|
|
},
|
|
availability: "open",
|
|
// Under the 15 s host backstop; first GPS fix + two API calls can be slow.
|
|
timeoutMs: 14_000,
|
|
},
|
|
{
|
|
name: "stop_route",
|
|
description: "Stop the current navigation session.",
|
|
inputSchema: { type: "object", properties: {}, additionalProperties: false },
|
|
availability: "open",
|
|
},
|
|
{
|
|
name: "route_status",
|
|
description:
|
|
"Get the current navigation status: next maneuver, distance to it, remaining distance/time, and ETA.",
|
|
inputSchema: { type: "object", properties: {}, additionalProperties: false },
|
|
availability: "open",
|
|
},
|
|
];
|
|
|
|
// Singleton window; navigation state outlives foreground/background flips.
|
|
let window: NavWindow | null = null;
|
|
let screenOn = true;
|
|
|
|
let phase: NavPhase = "idle";
|
|
let statusMessage = "";
|
|
let destinationName = "";
|
|
let destinationPlace = "";
|
|
let destination: { longitude: number; latitude: number } | null = null;
|
|
let profile: RouteProfile = "driving";
|
|
let follower: RouteFollower | null = null;
|
|
let progress: RouteProgress | null = null;
|
|
let lastFix: TrackedLocation | null = null;
|
|
let lastBearingDeg = 0;
|
|
let lastRerouteAtMs = 0;
|
|
let rerouteInFlight = false;
|
|
/** Bumped on every new route/mode so stale map fetches can be discarded. */
|
|
let routeGeneration = 0;
|
|
|
|
let mapMode: MapMode = "follow";
|
|
let zoomOffset = 0;
|
|
let mapImage: GrayImage | null = null;
|
|
let mapFetchedKey = "";
|
|
let mapInFlight = false;
|
|
let mapLastFetchAtMs = 0;
|
|
let mapLastFetchCenter: [number, number] | null = null;
|
|
let mapNextRetryAtMs = 0;
|
|
let mapLastError = "";
|
|
|
|
let tickTimer: ReturnType<typeof setInterval> | null = null;
|
|
let firstFixWaiters: Array<(fix: TrackedLocation) => void> = [];
|
|
|
|
const tracker = new LocationTracker({
|
|
onLocation: (fix) => handleFix(fix),
|
|
onError: (message) => {
|
|
statusMessage = message;
|
|
if (phase === "acquiring") phase = "idle";
|
|
render();
|
|
},
|
|
});
|
|
|
|
function post(message: WorkerAppReply): void {
|
|
global.postMessage(message);
|
|
}
|
|
|
|
global.onmessage = (event: { data: WorkerAppMessage }) => {
|
|
const message = event.data;
|
|
switch (message.type) {
|
|
case "open-window":
|
|
window = {
|
|
windowId: message.windowId,
|
|
surfaceId: message.surfaceId,
|
|
viewportWidth: message.viewport.width,
|
|
viewportHeight: message.viewport.height,
|
|
foreground: false,
|
|
focused: false,
|
|
menu: null,
|
|
lastSubmittedFingerprint: "",
|
|
};
|
|
post({ type: "set-tools", windowId: message.windowId, tools: NAVIGATE_TOOLS });
|
|
break;
|
|
case "close-window":
|
|
stopNavigation("");
|
|
window = null;
|
|
break;
|
|
case "input":
|
|
if (!window || window.windowId !== message.windowId) {
|
|
frameTimings.finishFrame(message.frameId, "discarded: unknown navigate window");
|
|
break;
|
|
}
|
|
window.focused = message.focused;
|
|
handleInput(window, message.event as DashboardInputEvent, message.frameId);
|
|
break;
|
|
case "text-input":
|
|
// Voice input / typed text sets a destination directly.
|
|
if (message.text.trim()) {
|
|
void startNavigation(message.text.trim(), profile).catch(() => {});
|
|
}
|
|
break;
|
|
case "render":
|
|
if (!window) break;
|
|
window.focused = message.focused;
|
|
render();
|
|
break;
|
|
case "foreground":
|
|
if (!window) break;
|
|
window.foreground = message.foreground;
|
|
window.focused = message.focused;
|
|
if (window.foreground) {
|
|
maybeRefreshMap();
|
|
render();
|
|
}
|
|
break;
|
|
case "screen":
|
|
screenOn = message.on;
|
|
if (screenOn && window?.foreground) {
|
|
maybeRefreshMap();
|
|
render();
|
|
}
|
|
break;
|
|
case "tool-call": {
|
|
const callId = message.callId;
|
|
Promise.resolve(handleNavigateTool(message.name, message.args))
|
|
.then((result) => post({ type: "tool-result", callId, result }))
|
|
.catch((error) =>
|
|
post({
|
|
type: "tool-result",
|
|
callId,
|
|
result: { ok: false, error: String((error as Error)?.message ?? error) },
|
|
}),
|
|
);
|
|
break;
|
|
}
|
|
}
|
|
};
|
|
|
|
// ---------------------------------------------------------------------------
|
|
// Navigation state machine
|
|
|
|
async function startNavigation(query: string, requestedProfile: RouteProfile): Promise<string> {
|
|
if (!isMapboxConfigured()) {
|
|
statusMessage = "Set a Mapbox token in Settings > API Keys.";
|
|
phase = "idle";
|
|
render();
|
|
throw new Error(statusMessage);
|
|
}
|
|
const hadActiveRoute = phase === "navigating" && follower !== null;
|
|
const previous = {
|
|
destination,
|
|
destinationName,
|
|
destinationPlace,
|
|
profile,
|
|
};
|
|
try {
|
|
profile = requestedProfile;
|
|
phase = "acquiring";
|
|
statusMessage = `Locating you for "${query}"...`;
|
|
render();
|
|
ensureTracking();
|
|
const fix = await waitForFix();
|
|
|
|
phase = "routing";
|
|
statusMessage = `Finding ${query}...`;
|
|
render();
|
|
const candidates = await geocodeForward(query, fix, 5);
|
|
if (!candidates.length) {
|
|
throw new Error(`No places found matching "${query}".`);
|
|
}
|
|
const picked = candidates[0]!;
|
|
destination = { longitude: picked.longitude, latitude: picked.latitude };
|
|
destinationName = picked.name;
|
|
destinationPlace = picked.placeFormatted;
|
|
|
|
statusMessage = `Routing to ${picked.name}...`;
|
|
render();
|
|
const route = await fetchRoute(fix, destination, profile);
|
|
adoptRoute(route);
|
|
if (window) post({ type: "focus-window", windowId: window.windowId });
|
|
return startSummary(picked, candidates, route);
|
|
} catch (error) {
|
|
const message = String((error as Error)?.message ?? error);
|
|
statusMessage = message;
|
|
// A failed new destination shouldn't kill guidance that was already
|
|
// running; fall back to the ongoing route (and its destination, which
|
|
// the geocode step may have partially overwritten).
|
|
if (hadActiveRoute) {
|
|
phase = "navigating";
|
|
destination = previous.destination;
|
|
destinationName = previous.destinationName;
|
|
destinationPlace = previous.destinationPlace;
|
|
profile = previous.profile;
|
|
} else {
|
|
phase = "idle";
|
|
}
|
|
stopTrackingIfIdle();
|
|
render();
|
|
throw error;
|
|
}
|
|
}
|
|
|
|
function adoptRoute(route: Route): void {
|
|
follower = new RouteFollower(route);
|
|
progress = null;
|
|
phase = "navigating";
|
|
mapMode = "follow";
|
|
zoomOffset = 0;
|
|
statusMessage = "";
|
|
routeGeneration++;
|
|
resetMapState();
|
|
ensureTracking();
|
|
ensureTickTimer();
|
|
if (lastFix) handleFix(lastFix);
|
|
maybeRefreshMap();
|
|
render();
|
|
}
|
|
|
|
function stopNavigation(finalStatus: string): void {
|
|
phase = "idle";
|
|
statusMessage = finalStatus;
|
|
follower = null;
|
|
progress = null;
|
|
destination = null;
|
|
destinationName = "";
|
|
destinationPlace = "";
|
|
routeGeneration++;
|
|
resetMapState();
|
|
stopTrackingIfIdle();
|
|
ensureTickTimer();
|
|
}
|
|
|
|
function handleFix(fix: TrackedLocation): void {
|
|
lastFix = fix;
|
|
if (fix.bearingDeg !== null && (fix.speedMps ?? 0) >= BEARING_MIN_SPEED_MPS) {
|
|
lastBearingDeg = fix.bearingDeg;
|
|
}
|
|
for (const waiter of firstFixWaiters.splice(0)) waiter(fix);
|
|
|
|
if (phase !== "navigating" || !follower) return;
|
|
progress = follower.update(fix.longitude, fix.latitude);
|
|
|
|
if (progress.arrived) {
|
|
phase = "arrived";
|
|
statusMessage = "";
|
|
stopTrackingIfIdle();
|
|
ensureTickTimer();
|
|
render();
|
|
return;
|
|
}
|
|
if (progress.offRoute) {
|
|
void maybeReroute(fix);
|
|
}
|
|
maybeRefreshMap();
|
|
render();
|
|
}
|
|
|
|
async function maybeReroute(fix: TrackedLocation): Promise<void> {
|
|
if (rerouteInFlight || !destination) return;
|
|
if (Date.now() - lastRerouteAtMs < REROUTE_MIN_INTERVAL_MS) return;
|
|
rerouteInFlight = true;
|
|
lastRerouteAtMs = Date.now();
|
|
statusMessage = "Rerouting...";
|
|
render();
|
|
try {
|
|
const route = await fetchRoute(fix, destination, profile);
|
|
if (phase === "navigating") adoptRoute(route);
|
|
} catch (error) {
|
|
statusMessage = `Reroute failed: ${String((error as Error)?.message ?? error)}`;
|
|
render();
|
|
} finally {
|
|
rerouteInFlight = false;
|
|
}
|
|
}
|
|
|
|
function ensureTracking(): void {
|
|
if (!tracker.isRunning()) tracker.start(LOCATION_INTERVAL_MS);
|
|
}
|
|
|
|
function stopTrackingIfIdle(): void {
|
|
if (phase === "idle" || phase === "arrived") {
|
|
tracker.stop();
|
|
firstFixWaiters = [];
|
|
}
|
|
}
|
|
|
|
function waitForFix(): Promise<TrackedLocation> {
|
|
if (lastFix && Date.now() - lastFix.timestampMs < 60_000) {
|
|
return Promise.resolve(lastFix);
|
|
}
|
|
return new Promise<TrackedLocation>((resolve, reject) => {
|
|
const timer = setTimeout(() => {
|
|
firstFixWaiters = firstFixWaiters.filter((waiter) => waiter !== onFix);
|
|
reject(new Error("Couldn't get a GPS fix yet; try again in a moment."));
|
|
}, FIRST_FIX_TIMEOUT_MS);
|
|
const onFix = (fix: TrackedLocation) => {
|
|
clearTimeout(timer);
|
|
resolve(fix);
|
|
};
|
|
firstFixWaiters.push(onFix);
|
|
});
|
|
}
|
|
|
|
function ensureTickTimer(): void {
|
|
const shouldRun = phase === "navigating";
|
|
if (shouldRun && tickTimer === null) {
|
|
tickTimer = setInterval(() => {
|
|
maybeRefreshMap();
|
|
render(); // ETA/minute updates; fingerprint dedup keeps the wire quiet.
|
|
}, 2_000);
|
|
} else if (!shouldRun && tickTimer !== null) {
|
|
clearInterval(tickTimer);
|
|
tickTimer = null;
|
|
}
|
|
}
|
|
|
|
// ---------------------------------------------------------------------------
|
|
// Map pane
|
|
|
|
function resetMapState(): void {
|
|
mapImage = null;
|
|
mapFetchedKey = "";
|
|
mapInFlight = false;
|
|
mapLastFetchAtMs = 0;
|
|
mapLastFetchCenter = null;
|
|
mapNextRetryAtMs = 0;
|
|
mapLastError = "";
|
|
}
|
|
|
|
function currentPosition(): [number, number] | null {
|
|
if (progress) return progress.snapped;
|
|
if (lastFix) return [lastFix.longitude, lastFix.latitude];
|
|
return null;
|
|
}
|
|
|
|
function currentBearing(): number {
|
|
if (lastFix && lastFix.bearingDeg !== null && (lastFix.speedMps ?? 0) >= BEARING_MIN_SPEED_MPS) {
|
|
return lastFix.bearingDeg;
|
|
}
|
|
if (lastBearingDeg) return lastBearingDeg;
|
|
// Fall back to the direction the route heads from here.
|
|
if (follower && progress) {
|
|
const slice = follower.routeSliceAround(progress.alongMeters, 0, 120);
|
|
if (slice.length >= 2) return bearingDegrees(slice[0]!, slice[slice.length - 1]!);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
function currentZoom(): number {
|
|
let zoom: number;
|
|
if (profile === "walking") {
|
|
zoom = 16.5;
|
|
} else if (progress && progress.metersToNextManeuver < 250) {
|
|
zoom = 16.5;
|
|
} else if (progress && progress.metersToNextManeuver < 1000) {
|
|
zoom = 15.5;
|
|
} else {
|
|
zoom = 14.5;
|
|
}
|
|
return Math.max(11, Math.min(18, zoom + zoomOffset));
|
|
}
|
|
|
|
function metersPerPixel(zoom: number, latitude: number): number {
|
|
return (156543.03392 * Math.cos((latitude * Math.PI) / 180)) / Math.pow(2, zoom);
|
|
}
|
|
|
|
function desiredMapView(): { camera: StaticMapCamera; key: string; path: Array<[number, number]> } | null {
|
|
if (mapMode === "overview" && follower) {
|
|
return {
|
|
camera: { kind: "auto" },
|
|
key: `auto|${routeGeneration}`,
|
|
path: simplifyPath(follower.route.coordinates, 100),
|
|
};
|
|
}
|
|
const position = currentPosition();
|
|
if (!position) return null;
|
|
const zoom = currentZoom();
|
|
const bearing = Math.round(currentBearing() / BEARING_BUCKET_DEG) * BEARING_BUCKET_DEG;
|
|
const path =
|
|
follower && progress
|
|
? simplifyPath(follower.routeSliceAround(progress.alongMeters, 250, 3000), 80)
|
|
: [];
|
|
return {
|
|
camera: { kind: "center", longitude: position[0], latitude: position[1], zoom, bearingDeg: bearing },
|
|
key: `c|${zoom.toFixed(2)}|${bearing}|${routeGeneration}`,
|
|
path,
|
|
};
|
|
}
|
|
|
|
/**
|
|
* Refetch the map only when meaningfully stale: camera key changed (zoom /
|
|
* bearing bucket / mode / route), moved a good fraction of the viewport, or
|
|
* a few seconds passed while moving. Single-flight with failure backoff.
|
|
*/
|
|
function maybeRefreshMap(): void {
|
|
if (!window || !window.foreground || !screenOn) return;
|
|
if (mapInFlight || Date.now() < mapNextRetryAtMs) return;
|
|
if (!isMapboxConfigured()) return;
|
|
const view = desiredMapView();
|
|
if (!view) return;
|
|
|
|
let stale = mapImage === null || view.key !== mapFetchedKey;
|
|
if (!stale && view.camera.kind === "center" && mapLastFetchCenter) {
|
|
const moved = haversineMeters(mapLastFetchCenter, [view.camera.longitude, view.camera.latitude]);
|
|
const viewportMeters = MAP_SIZE * metersPerPixel(view.camera.zoom, view.camera.latitude);
|
|
if (moved > viewportMeters * MOVE_REFRESH_FRACTION) stale = true;
|
|
else if (Date.now() - mapLastFetchAtMs > IDLE_REFRESH_MS && moved > IDLE_REFRESH_MIN_MOVE_M) stale = true;
|
|
}
|
|
if (!stale) return;
|
|
|
|
mapInFlight = true;
|
|
const generation = routeGeneration;
|
|
fetchStaticMapGray({
|
|
camera: view.camera,
|
|
width: MAP_SIZE,
|
|
height: MAP_SIZE,
|
|
routePath: view.path.length >= 2 ? view.path : undefined,
|
|
})
|
|
.then((image) => {
|
|
mapInFlight = false;
|
|
if (generation !== routeGeneration) return; // Route/mode changed mid-fetch.
|
|
boostContrast(image);
|
|
mapImage = image;
|
|
mapFetchedKey = view.key;
|
|
mapLastFetchAtMs = Date.now();
|
|
mapLastFetchCenter = view.camera.kind === "center" ? [view.camera.longitude, view.camera.latitude] : null;
|
|
mapLastError = "";
|
|
render();
|
|
})
|
|
.catch((error) => {
|
|
mapInFlight = false;
|
|
mapNextRetryAtMs = Date.now() + MAP_RETRY_BACKOFF_MS;
|
|
mapLastError = String((error as Error)?.message ?? error);
|
|
render();
|
|
});
|
|
}
|
|
|
|
/** Keep every Nth point (ends always included) to bound the overlay URL size. */
|
|
function simplifyPath(path: Array<[number, number]>, maxPoints: number): Array<[number, number]> {
|
|
if (path.length <= maxPoints) return path;
|
|
const step = (path.length - 1) / (maxPoints - 1);
|
|
const out: Array<[number, number]> = [];
|
|
for (let i = 0; i < maxPoints; i++) {
|
|
out.push(path[Math.round(i * step)]!);
|
|
}
|
|
return out;
|
|
}
|
|
|
|
/** Stretch the dark-style render so roads survive 4bpp quantization. */
|
|
function boostContrast(image: GrayImage): void {
|
|
for (let i = 0; i < image.pixels.length; i++) {
|
|
const value = image.pixels[i]!;
|
|
image.pixels[i] = Math.max(0, Math.min(255, Math.round((value - 12) * 1.7)));
|
|
}
|
|
}
|
|
|
|
// ---------------------------------------------------------------------------
|
|
// Tools
|
|
|
|
async function handleNavigateTool(name: string, args: any): Promise<ToolResult> {
|
|
switch (name) {
|
|
case "start_route": {
|
|
const query = String(args?.query ?? "").trim();
|
|
if (!query) return { ok: false, error: "start_route requires a destination query" };
|
|
const requested = String(args?.profile ?? "driving");
|
|
const routeProfile: RouteProfile =
|
|
requested === "walking" || requested === "cycling" ? requested : "driving";
|
|
try {
|
|
const summary = await startNavigation(query, routeProfile);
|
|
return { ok: true, content: summary };
|
|
} catch (error) {
|
|
return { ok: false, error: String((error as Error)?.message ?? error) };
|
|
}
|
|
}
|
|
case "stop_route":
|
|
if (phase === "idle") return { ok: true, content: "Navigation was not active." };
|
|
stopNavigation("Navigation stopped.");
|
|
render();
|
|
return { ok: true, content: "Navigation stopped." };
|
|
case "route_status":
|
|
return { ok: true, content: describeRouteStatus() };
|
|
default:
|
|
return { ok: false, error: `Unknown navigate tool: ${name}` };
|
|
}
|
|
}
|
|
|
|
function startSummary(picked: GeocodeCandidate, candidates: GeocodeCandidate[], route: Route): string {
|
|
const parts = [
|
|
`Navigating to ${picked.name}${picked.placeFormatted ? ` (${picked.placeFormatted})` : ""}: ` +
|
|
`${formatDistance(route.distanceMeters)}, about ${formatDurationLong(route.durationSec)}, ` +
|
|
`arriving ${formatClock(Date.now() + route.durationSec * 1000)}.`,
|
|
];
|
|
const alternates = candidates.slice(1, 3);
|
|
if (alternates.length) {
|
|
parts.push(
|
|
`Other matches: ${alternates
|
|
.map((c) => `${c.name}${c.placeFormatted ? ` (${c.placeFormatted})` : ""}`)
|
|
.join("; ")}. Call start_route with a more specific query to pick one of these instead.`,
|
|
);
|
|
}
|
|
return parts.join(" ");
|
|
}
|
|
|
|
function describeRouteStatus(): string {
|
|
if (phase === "arrived") return `Arrived at ${destinationName}.`;
|
|
if (phase !== "navigating" || !follower) return "Navigation is not active.";
|
|
if (!progress) return `Navigating to ${destinationName}; waiting for a GPS fix.`;
|
|
const step = follower.route.steps[progress.nextStepIndex]!;
|
|
return (
|
|
`Next: ${step.instruction || step.maneuverType} in ${formatDistance(progress.metersToNextManeuver)}. ` +
|
|
`${formatDistance(progress.remainingMeters)} and ${formatDurationLong(progress.remainingSec)} remaining; ` +
|
|
`ETA ${formatClock(Date.now() + progress.remainingSec * 1000)}.`
|
|
);
|
|
}
|
|
|
|
// ---------------------------------------------------------------------------
|
|
// Input
|
|
|
|
function windowMenu(win: NavWindow): WindowMenu {
|
|
if (!win.menu) {
|
|
win.menu = new WindowMenu({
|
|
size: { width: win.viewportWidth, height: win.viewportHeight },
|
|
paintBase: () => paintContent(win),
|
|
isFocused: () => win.focused,
|
|
});
|
|
}
|
|
return win.menu;
|
|
}
|
|
|
|
function handleInput(win: NavWindow, event: DashboardInputEvent, frameId: number): void {
|
|
if (win.menu?.isOpen()) {
|
|
win.menu
|
|
.handleInput(event)
|
|
.catch((error) => console.error(`navigate menu input failed: ${error}`))
|
|
.then(() => renderAndSubmit(win, frameId));
|
|
return;
|
|
}
|
|
if (event.type === "long-press") {
|
|
const items = [...defaultWindowMenuItems(win.windowId, post)];
|
|
if (phase === "navigating" || phase === "arrived") {
|
|
items.unshift({
|
|
label: "Stop navigation",
|
|
onSelect: (ctx: any) => {
|
|
ctx.stack.pop();
|
|
stopNavigation("Navigation stopped.");
|
|
render();
|
|
},
|
|
});
|
|
}
|
|
windowMenu(win).open(items);
|
|
renderAndSubmit(win, frameId);
|
|
return;
|
|
}
|
|
if (event.type === "double-click") {
|
|
frameTimings.finishFrame(frameId, "discarded: navigate yielded focus");
|
|
post({ type: "yield-focus", windowId: win.windowId });
|
|
return;
|
|
}
|
|
if (event.type === "click") {
|
|
if (phase === "navigating") {
|
|
mapMode = mapMode === "follow" ? "overview" : "follow";
|
|
resetMapState();
|
|
maybeRefreshMap();
|
|
} else if (phase === "arrived") {
|
|
stopNavigation("");
|
|
} else {
|
|
frameTimings.finishFrame(frameId, "discarded: navigate ignored click");
|
|
return;
|
|
}
|
|
renderAndSubmit(win, frameId);
|
|
return;
|
|
}
|
|
if (event.type === "scroll-up" || event.type === "scroll-down") {
|
|
if (phase === "navigating" && mapMode === "follow") {
|
|
zoomOffset = Math.max(-3, Math.min(2, zoomOffset + (event.type === "scroll-up" ? 0.5 : -0.5)));
|
|
maybeRefreshMap();
|
|
renderAndSubmit(win, frameId);
|
|
} else {
|
|
frameTimings.finishFrame(frameId, "discarded: navigate ignored scroll");
|
|
}
|
|
return;
|
|
}
|
|
frameTimings.finishFrame(frameId, "discarded: navigate ignored input");
|
|
}
|
|
|
|
// ---------------------------------------------------------------------------
|
|
// Painting
|
|
|
|
function paint(win: NavWindow): GrayImage {
|
|
if (win.menu?.isOpen()) return win.menu.paint();
|
|
return paintContent(win);
|
|
}
|
|
|
|
function paintContent(win: NavWindow): GrayImage {
|
|
const image = new GrayImage(win.viewportWidth, win.viewportHeight, 0);
|
|
if (phase === "idle" || phase === "acquiring" || phase === "routing") {
|
|
paintIdle(image);
|
|
} else {
|
|
paintNavigating(image, win);
|
|
}
|
|
return image;
|
|
}
|
|
|
|
function paintIdle(image: GrayImage): void {
|
|
image.drawText(mediumFont, 24, 16, "Navigate", 245);
|
|
const busy = phase !== "idle";
|
|
const hint = isMapboxConfigured()
|
|
? "Ask the voice assistant to navigate somewhere, or use Voice input from the long-press menu to say a destination."
|
|
: "Set a Mapbox token in Settings > API Keys to enable navigation.";
|
|
image.drawTextWrapped({ font: smallFont, x: 24, y: 64, width: image.width - 48, text: hint, value: 170 });
|
|
if (statusMessage) {
|
|
image.drawTextWrapped({
|
|
font: smallFont,
|
|
x: 24,
|
|
y: 130,
|
|
width: image.width - 48,
|
|
text: statusMessage,
|
|
value: busy ? 220 : 190,
|
|
});
|
|
}
|
|
drawFooter(image, `${GESTURE_DOUBLE_CLICK} back`);
|
|
}
|
|
|
|
function paintNavigating(image: GrayImage, win: NavWindow): void {
|
|
// Map pane (left).
|
|
if (mapImage) {
|
|
image.bitBlt(mapImage, 0, 0);
|
|
if (mapMode === "follow") drawChevron(image, MAP_SIZE / 2, MAP_SIZE / 2);
|
|
} else {
|
|
image.drawRect(0, 0, MAP_SIZE, MAP_SIZE, 60);
|
|
const text = mapLastError ? "Map unavailable" : "Loading map...";
|
|
image.drawText(smallFont, 24, MAP_SIZE / 2 - 8, text, 120);
|
|
}
|
|
|
|
// Guidance panel (right) — its own region so text deltas never overlap the map's.
|
|
const panelWidth = win.viewportWidth - PANEL_X;
|
|
if (phase === "arrived") {
|
|
drawManeuverGlyph(image, PANEL_X + 8, 14, 56, "arrive", "", 245);
|
|
image.drawText(mediumFont, PANEL_X + 76, 26, "Arrived", 245);
|
|
image.drawTextWrapped({
|
|
font: smallFont,
|
|
x: PANEL_X + 8,
|
|
y: 84,
|
|
width: panelWidth - 16,
|
|
text: destinationName,
|
|
value: 200,
|
|
});
|
|
drawFooter(image, `${GESTURE_CLICK} done ${GESTURE_DOUBLE_CLICK} back`);
|
|
return;
|
|
}
|
|
|
|
const step = follower && progress ? follower.route.steps[progress.nextStepIndex] : null;
|
|
if (step && progress) {
|
|
drawManeuverGlyph(image, PANEL_X + 8, 14, 56, step.maneuverType, step.maneuverModifier, 245);
|
|
if (step.exit !== null && (step.maneuverType === "roundabout" || step.maneuverType === "rotary")) {
|
|
image.drawText(smallFont, PANEL_X + 30, 46, String(step.exit), 245);
|
|
}
|
|
image.drawText(largeFont, PANEL_X + 76, 24, formatDistanceShort(progress.metersToNextManeuver), 250);
|
|
image.drawTextWrapped({
|
|
font: mediumFont,
|
|
x: PANEL_X + 8,
|
|
y: 84,
|
|
width: panelWidth - 16,
|
|
text: step.instruction || step.name || step.maneuverType,
|
|
value: 220,
|
|
});
|
|
const eta = `${formatDistance(progress.remainingMeters)} · ${formatDurationShort(progress.remainingSec)} · ${formatClock(
|
|
Date.now() + progress.remainingSec * 1000,
|
|
)}`;
|
|
image.drawText(smallFont, PANEL_X + 8, win.viewportHeight - 62, eta, 170);
|
|
} else {
|
|
image.drawTextWrapped({
|
|
font: mediumFont,
|
|
x: PANEL_X + 8,
|
|
y: 24,
|
|
width: panelWidth - 16,
|
|
text: `Waiting for GPS...`,
|
|
value: 200,
|
|
});
|
|
}
|
|
if (statusMessage) {
|
|
image.drawText(smallFont, PANEL_X + 8, win.viewportHeight - 44, statusMessage, 200);
|
|
}
|
|
const modeHint = mapMode === "follow" ? "overview" : "follow";
|
|
drawFooter(image, `${GESTURE_SCROLL} zoom ${GESTURE_CLICK} ${modeHint} ${GESTURE_DOUBLE_CLICK} back`, PANEL_X + 8);
|
|
}
|
|
|
|
/** Position chevron, fixed at the map center (heading-up: it always points up). */
|
|
function drawChevron(image: GrayImage, cx: number, cy: number): void {
|
|
// Black halo first so it reads over bright roads.
|
|
fillTriangle(image, cx, cy - 11, cx - 9, cy + 9, cx + 9, cy + 9, 0);
|
|
fillTriangle(image, cx, cy - 8, cx - 6, cy + 6, cx + 6, cy + 6, 255);
|
|
}
|
|
|
|
function fillTriangle(image: GrayImage, x0: number, y0: number, x1: number, y1: number, x2: number, y2: number, value: number): void {
|
|
const minY = Math.max(0, Math.floor(Math.min(y0, y1, y2)));
|
|
const maxY = Math.min(image.height - 1, Math.ceil(Math.max(y0, y1, y2)));
|
|
for (let y = minY; y <= maxY; y++) {
|
|
let minX = Number.POSITIVE_INFINITY;
|
|
let maxX = Number.NEGATIVE_INFINITY;
|
|
const edges: Array<[[number, number], [number, number]]> = [
|
|
[[x0, y0], [x1, y1]],
|
|
[[x1, y1], [x2, y2]],
|
|
[[x2, y2], [x0, y0]],
|
|
];
|
|
for (const [[ax, ay], [bx, by]] of edges) {
|
|
if ((ay <= y && by >= y) || (by <= y && ay >= y)) {
|
|
if (Math.abs(by - ay) < 0.0001) {
|
|
minX = Math.min(minX, ax, bx);
|
|
maxX = Math.max(maxX, ax, bx);
|
|
} else {
|
|
const t = (y - ay) / (by - ay);
|
|
const x = ax + t * (bx - ax);
|
|
minX = Math.min(minX, x);
|
|
maxX = Math.max(maxX, x);
|
|
}
|
|
}
|
|
}
|
|
if (minX <= maxX) {
|
|
image.fillRect(Math.round(minX), y, Math.round(maxX - minX) + 1, 1, value);
|
|
}
|
|
}
|
|
}
|
|
|
|
function drawFooter(image: GrayImage, text: string, x = 16): void {
|
|
image.drawText(smallFont, x, image.height - 22, text, 115);
|
|
}
|
|
|
|
// ---------------------------------------------------------------------------
|
|
// Formatting (imperial; matches the rest of the UI)
|
|
|
|
function formatDistanceShort(meters: number): string {
|
|
const feet = meters * 3.28084;
|
|
if (feet < 900) return `${Math.max(0, Math.round(feet / 50) * 50)} ft`;
|
|
return `${(feet / 5280).toFixed(1)} mi`;
|
|
}
|
|
|
|
function formatDistance(meters: number): string {
|
|
const feet = meters * 3.28084;
|
|
if (feet < 1000) return `${Math.max(0, Math.round(feet / 50) * 50)} ft`;
|
|
const miles = feet / 5280;
|
|
return miles >= 10 ? `${Math.round(miles)} mi` : `${miles.toFixed(1)} mi`;
|
|
}
|
|
|
|
function formatDurationShort(seconds: number): string {
|
|
const minutes = Math.round(seconds / 60);
|
|
if (minutes < 60) return `${Math.max(1, minutes)} min`;
|
|
return `${Math.floor(minutes / 60)}h${String(minutes % 60).padStart(2, "0")}`;
|
|
}
|
|
|
|
function formatDurationLong(seconds: number): string {
|
|
const minutes = Math.round(seconds / 60);
|
|
if (minutes < 60) return `${Math.max(1, minutes)} minutes`;
|
|
const hours = Math.floor(minutes / 60);
|
|
return `${hours}h ${minutes % 60}m`;
|
|
}
|
|
|
|
function formatClock(timestampMs: number): string {
|
|
const date = new Date(timestampMs);
|
|
let hours = date.getHours();
|
|
const minutes = String(date.getMinutes()).padStart(2, "0");
|
|
const meridiem = hours >= 12 ? "PM" : "AM";
|
|
hours = hours % 12;
|
|
if (hours === 0) hours = 12;
|
|
return `${hours}:${minutes} ${meridiem}`;
|
|
}
|
|
|
|
// ---------------------------------------------------------------------------
|
|
// Render plumbing
|
|
|
|
function render(): void {
|
|
if (window) renderAndSubmit(window, 0);
|
|
}
|
|
|
|
function renderAndSubmit(win: NavWindow, inputFrameId: number): void {
|
|
if (!win.foreground && inputFrameId === 0) return;
|
|
const frameId = inputFrameId > 0 ? inputFrameId : frameTimings.startFrame(`render:${win.windowId}`);
|
|
try {
|
|
const paintStartedAtMs = Date.now();
|
|
const image = frameTimings.span(frameId, "paint", () =>
|
|
frameTimings.runWithFrame(frameId, () => paint(win)),
|
|
);
|
|
const paintMs = Date.now() - paintStartedAtMs;
|
|
const fingerprint = image.fingerprint();
|
|
if (fingerprint === win.lastSubmittedFingerprint) {
|
|
frameTimings.finishFrame(frameId, "discarded: navigate content unchanged");
|
|
return;
|
|
}
|
|
const communicator = com.faceclaw.app.FaceclawBleCommunicator.getActive();
|
|
if (!communicator) {
|
|
frameTimings.finishFrame(frameId, "discarded: no active communicator");
|
|
return;
|
|
}
|
|
const buffer = image.to8bppBuffer();
|
|
communicator.submitSurfaceFrame(
|
|
buffer.buffer,
|
|
win.surfaceId,
|
|
0,
|
|
0,
|
|
image.width,
|
|
image.height,
|
|
fingerprint,
|
|
paintMs,
|
|
frameId,
|
|
);
|
|
win.lastSubmittedFingerprint = fingerprint;
|
|
} catch (error) {
|
|
frameTimings.finishFrame(frameId, "discarded: navigate render failed");
|
|
console.error(`navigate worker render failed: ${error}`);
|
|
}
|
|
}
|