UR7e-Policy-Lab / app.js
devkumarhf's picture
Publish browser-local SAC inference and DLS comparison
590673f verified
Raw History Blame Contribute Delete
5.81 kB
import {Actor,Environment,chainPoints,dls} from './core.js';
const $=s=>document.querySelector(s),canvas=$('#scene'),ctx=canvas.getContext('2d');let actor,config,cases,env,running=false,loadReady=false,yaw=.6,pitch=.34,zoom=1.1,drag=null,lastLatency=0,noiseState=1;
const random=()=>{noiseState=(Math.imul(1664525,noiseState)+1013904223)>>>0;return(noiseState+.5)/4294967296;};
const normal=()=>Math.sqrt(-2*Math.log(random()))*Math.cos(2*Math.PI*random());
function selectedCase(){const subset=cases.filter(c=>c.shape===$('#shape').value);return subset[Number($('#example').value)];}
function reset(){if(!loadReady)return;running=false;const c=selectedCase();env=new Environment(config,c.target);noiseState=c.seed>>>0;$('#example-label').textContent=`${Number($('#example').value)+1} / 20`;$('#run').textContent='Run';$('#status').textContent=`Seed ${c.seed} · Ready`;lastLatency=0;update();draw();}
function update(){if(!env)return;$('#progress').textContent=`${Math.round(env.cursor/59*100)}%`;$('#rms').textContent=env.rms===null?'—':`${env.rms.toFixed(2)} mm`;$('#steps').textContent=`${env.steps} / 800`;$('#latency').textContent=lastLatency?`${lastLatency.toFixed(2)} ms`:'—';}
function step(){const o=env.observation(),noise=Number($('#noise').value);if(noise){for(let i=0;i<6;i++)o[i]+=normal()*noise/config.limits[i][1];for(let i=6;i<9;i++)o[i]+=normal()*noise;}const st=performance.now();const action=$('#controller').value==='sac'?actor.predict(o):dls(config,o);lastLatency=performance.now()-st;env.step(action);}
function size(){const rect=canvas.getBoundingClientRect(),dpr=Math.min(2,devicePixelRatio||1);if(canvas.width!==Math.round(rect.width*dpr)||canvas.height!==Math.round(rect.height*dpr)){canvas.width=Math.round(rect.width*dpr);canvas.height=Math.round(rect.height*dpr);}ctx.setTransform(dpr,0,0,dpr,0,0);return[rect.width,rect.height];}
function draw(){const[w,h]=size();ctx.clearRect(0,0,w,h);if(!env)return;const scale=Math.min(w*.65,h*.63)*zoom;
const project=p=>{let x=p[0]-.17,y=p[1],z=p[2]-.29;const rx=Math.cos(yaw)*x-Math.sin(yaw)*y,depth=Math.sin(yaw)*x+Math.cos(yaw)*y;const ry=Math.cos(pitch)*z-Math.sin(pitch)*depth,d=Math.cos(pitch)*depth+Math.sin(pitch)*z,k=2.8/(2.8-d);return[w*.48+rx*scale*k,h*.53-ry*scale*k];};
const line=(points,color,width=1)=>{if(!points.length)return;ctx.beginPath();points.forEach((p,i)=>{const[x,y]=project(p);i?ctx.lineTo(x,y):ctx.moveTo(x,y);});ctx.strokeStyle=color;ctx.lineWidth=width;ctx.lineCap='round';ctx.lineJoin='round';ctx.stroke();};
for(let i=-4;i<=4;i++){const t=i*.2;line([[-.8,t,0],[.8,t,0]],'#24332c',.6);line([[t,-.8,0],[t,.8,0]],'#24332c',.6);}
line([[.45,-.39,.21],[.45,.39,.21],[.45,.39,.79],[.45,-.39,.79],[.45,-.39,.21]],'#3a5144');line(env.target,'#a5cf93',2);line(env.path,'#83b7d1',1.8);
const points=chainPoints(config,env.q);line(points,'#17231d',15);line(points,'#aabbb0',8);for(const p of points){const[x,y]=project(p);ctx.beginPath();ctx.arc(x,y,4,0,Math.PI*2);ctx.fillStyle='#263c31';ctx.fill();ctx.strokeStyle='#c0d3c5';ctx.lineWidth=1;ctx.stroke();}
const tcp=project(points.at(-1));ctx.beginPath();ctx.arc(...tcp,5,0,Math.PI*2);ctx.fillStyle='#8bcce9';ctx.fill();const target=project(env.target[env.cursor]);ctx.beginPath();ctx.arc(...target,4,0,Math.PI*2);ctx.strokeStyle='#d1edb9';ctx.lineWidth=1.5;ctx.stroke();
ctx.font='10px ui-monospace,monospace';for(const[end,label,color]of[[[.15,0,0],'X','#b98a80'],[[0,.15,0],'Y','#8aaa8a'],[[0,0,.15],'Z','#89adcc']]){line([[0,0,0],end],color,2);const[x,y]=project(end);ctx.fillStyle=color;ctx.fillText(label,x+5,y-4);}ctx.fillStyle='#7d9586';ctx.fillText('POSITION-ONLY DEFAULT KINEMATICS',20,h-47);
}
canvas.addEventListener('pointerdown',e=>{drag={x:e.clientX,y:e.clientY};canvas.setPointerCapture(e.pointerId);});canvas.addEventListener('pointermove',e=>{if(!drag)return;yaw+=(e.clientX-drag.x)*.009;pitch=Math.max(-1.1,Math.min(1.2,pitch+(e.clientY-drag.y)*.007));drag={x:e.clientX,y:e.clientY};draw();});canvas.addEventListener('pointerup',()=>drag=null);canvas.addEventListener('pointercancel',()=>drag=null);canvas.addEventListener('wheel',e=>{e.preventDefault();zoom=Math.max(.5,Math.min(2.4,zoom*Math.exp(-e.deltaY*.001)));draw();},{passive:false});canvas.addEventListener('keydown',e=>{if(!['ArrowLeft','ArrowRight','ArrowUp','ArrowDown','+','-'].includes(e.key))return;e.preventDefault();if(e.key==='ArrowLeft')yaw-=.1;if(e.key==='ArrowRight')yaw+=.1;if(e.key==='ArrowUp')pitch-=.08;if(e.key==='ArrowDown')pitch+=.08;if(e.key==='+')zoom=Math.min(2.4,zoom*1.1);if(e.key==='-')zoom=Math.max(.5,zoom/1.1);draw();});
$('#run').addEventListener('click',()=>{if(!loadReady)return;if(env.done)reset();running=!running;$('#run').textContent=running?'Pause':'Run';if(!running)$('#status').textContent='Paused';});$('#reset').addEventListener('click',reset);for(const id of ['controller','shape','example','noise'])$('#'+id).addEventListener('input',reset);new ResizeObserver(draw).observe(canvas);
function frame(){if(running&&env&&!document.hidden){for(let i=0;i<4&&!env.done;i++)step();$('#status').textContent=env.done?env.reason:env.phase?'Tracking the target':'Approaching the first point';if(env.done){running=false;$('#run').textContent='Run again';}update();draw();}requestAnimationFrame(frame);}requestAnimationFrame(frame);
try{const results=await Promise.all([fetch('actor.bin').then(r=>{if(!r.ok)throw Error('Actor download failed');return r.arrayBuffer();}),fetch('kinematics.json').then(r=>r.json()),fetch('cases.json').then(r=>r.json())]);actor=new Actor(results[0]);config=results[1];cases=results[2];loadReady=true;$('#run').disabled=false;reset();window.policyLab={actor,config,cases,get environment(){return env;},step,reset};}catch(e){$('#status').textContent='Could not load local assets. Please reload.';console.error(e);}