diff --git a/build/ros3d.js b/build/ros3d.js
index 0185db35..c16a78f1 100644
--- a/build/ros3d.js
+++ b/build/ros3d.js
@@ -4183,15 +4183,7 @@ ROS3D.SceneNode = function(options) {
 
   // save the TF handler so we can remove it later
   this.tfUpdate = function(msg) {
-
-    // apply the transform
-    var tf = new ROSLIB.Transform(msg);
-    var poseTransformed = new ROSLIB.Pose(that.pose);
-    poseTransformed.applyTransform(tf);
-
-    // update the world
-    that.updatePose(poseTransformed);
-    that.visible = true;
+    that.transformPose(msg);
   };
 
   // listen for TF updates
@@ -4231,6 +4223,7 @@ ROS3D.SceneNode.prototype.transformPose = function(transform) {
 
   // update the world
   this.updatePose(poseTransformed);
+  that.visible = true;
 };
 
 /**
diff --git a/build/ros3d.min.js b/build/ros3d.min.js
index 5d780fbb..13af8581 100644
--- a/build/ros3d.min.js
+++ b/build/ros3d.min.js
@@ -1,3 +1,3 @@
 function setFrame(a,b){null===a.sn&&(a.sn=new ROS3D.SceneNode({frameID:b,tfClient:a.tfClient,object:a.ps}),a.rootObject.add(a.sn))}function finishedUpdate(a,b){null===a.first_size&&(a.first_size=b,a.max_pts=Math.max(a.max_pts,b));for(var c=b;c<a.prev_pts;c++)a.alpha[c]=0;if(a.prev_pts=b,a.geom.verticesNeedUpdate=!0,a.attribs.customColor.needsUpdate=!0,a.attribs.alpha.needsUpdate=!0,b>a.max_pts)throw"Attempted to draw more points than max_pts allows"}function read_point(a,b,c){for(var d=[],e=a.point_step*b,f=0;f<a.fields.length;f++){var g=e+a.fields[f].offset;"rgb"===a.fields[f].name?d.rgb=c.getInt32(g,1):d[a.fields[f].name]=c.getFloat32(g,1)}return d}function decode64(a){for(var b=[],c=0,d=0,e=0,f=a.length;f>e;e++)c+=BASE64.indexOf(a[e]),d+=6,d>=8&&(d-=8,b.push(c>>d),c&=Math.pow(2,d)-1),c<<=6;return b}var ROS3D=ROS3D||{REVISION:"0.17.0-SNAPSHOT"};ROS3D.MARKER_ARROW=0,ROS3D.MARKER_CUBE=1,ROS3D.MARKER_SPHERE=2,ROS3D.MARKER_CYLINDER=3,ROS3D.MARKER_LINE_STRIP=4,ROS3D.MARKER_LINE_LIST=5,ROS3D.MARKER_CUBE_LIST=6,ROS3D.MARKER_SPHERE_LIST=7,ROS3D.MARKER_POINTS=8,ROS3D.MARKER_TEXT_VIEW_FACING=9,ROS3D.MARKER_MESH_RESOURCE=10,ROS3D.MARKER_TRIANGLE_LIST=11,ROS3D.INTERACTIVE_MARKER_KEEP_ALIVE=0,ROS3D.INTERACTIVE_MARKER_POSE_UPDATE=1,ROS3D.INTERACTIVE_MARKER_MENU_SELECT=2,ROS3D.INTERACTIVE_MARKER_BUTTON_CLICK=3,ROS3D.INTERACTIVE_MARKER_MOUSE_DOWN=4,ROS3D.INTERACTIVE_MARKER_MOUSE_UP=5,ROS3D.INTERACTIVE_MARKER_NONE=0,ROS3D.INTERACTIVE_MARKER_MENU=1,ROS3D.INTERACTIVE_MARKER_BUTTON=2,ROS3D.INTERACTIVE_MARKER_MOVE_AXIS=3,ROS3D.INTERACTIVE_MARKER_MOVE_PLANE=4,ROS3D.INTERACTIVE_MARKER_ROTATE_AXIS=5,ROS3D.INTERACTIVE_MARKER_MOVE_ROTATE=6,ROS3D.INTERACTIVE_MARKER_INHERIT=0,ROS3D.INTERACTIVE_MARKER_FIXED=1,ROS3D.INTERACTIVE_MARKER_VIEW_FACING=2,ROS3D.COLLADA_LOADER=1,ROS3D.COLLADA_LOADER_2=2,ROS3D.makeColorMaterial=function(a,b,c,d){var e=new THREE.Color;return e.setRGB(a,b,c),.99>=d?new THREE.MeshBasicMaterial({color:e.getHex(),opacity:d+.1,transparent:!0,depthWrite:!0,blendSrc:THREE.SrcAlphaFactor,blendDst:THREE.OneMinusSrcAlphaFactor,blendEquation:THREE.ReverseSubtractEquation,blending:THREE.NormalBlending}):new THREE.MeshPhongMaterial({color:e.getHex(),opacity:d,blending:THREE.NormalBlending})},ROS3D.intersectPlane=function(a,b,c){var d=new THREE.Vector3,e=new THREE.Vector3;d.subVectors(b,a.origin);var f=a.direction.dot(c);if(Math.abs(f)<a.precision)return void 0;var g=c.dot(d)/f;return e.addVectors(a.origin,a.direction.clone().multiplyScalar(g)),e},ROS3D.findClosestPoint=function(a,b){var c=new THREE.Vector3;c.subVectors(a.origin,b.origin);var d=b.direction.clone(),e=a.direction.clone(),f=c.dot(d),g=d.dot(e),h=c.dot(e),i=d.dot(d),j=e.dot(e),k=j*i-g*g;if(Math.abs(k)<=1e-4)return void 0;var l=f*g-h*i,m=l/k;return m},ROS3D.closestAxisPoint=function(a,b,c){var d=new THREE.Projector,e=a.origin.clone();d.projectVector(e,b);var f=a.direction.clone().add(a.origin);d.projectVector(f,b);var g=f.clone().sub(e),h=new THREE.Vector2,i=h.subVectors(c,e).dot(g)/g.dot(g),j=new THREE.Vector2;j.addVectors(e,g.clone().multiplyScalar(i));var k=new THREE.Vector3(j.x,j.y,.5);d.unprojectVector(k,b);var l=new THREE.Ray(b.position,k.sub(b.position).normalize());return ROS3D.findClosestPoint(a,l)},ROS3D.CloseCloud=function(a){THREE.Object3D.call(this),this.type="CloseCloud",this.options=a||{},this.url=a.url,this.streamType=a.streamType||"vp8",this.f=a.f||526,this.pointSize=a.pointSize||3,this.width=a.width||1024,this.height=a.height||1024,this.whiteness=a.whiteness||0,this.varianceThreshold=a.varianceThreshold||16667e-9;this.isMjpeg="mjpeg"===this.streamType.toLowerCase(),this.video=document.createElement(this.isMjpeg?"img":"video"),this.video.width=this.width,this.video.height=this.height,this.video.addEventListener(this.isMjpeg?"load":"loadedmetadata",this.metaLoaded.bind(this),!1),this.isMjpeg||(this.video.loop=!0),this.video.src=this.url,this.video.crossOrigin="Anonymous",this.video.setAttribute("crossorigin","Anonymous"),this.vertex_shader=["uniform sampler2D map;","","uniform float width;","uniform float height;","","uniform float pointSize;","uniform float zOffset;","","uniform float focallength;","","varying vec2 vUvP;","varying vec2 colorP;","","varying float depthVariance;","varying float maskVal;","","float sampleDepth(vec2 pos)","  {","    float depth;","    ","    vec2 vUv = vec2( pos.x / (width*2.0), pos.y / (height*2.0)+0.5 );","    vec2 vUv2 = vec2( pos.x / (width*2.0)+0.5, pos.y / (height*2.0)+0.5 );","    ","    vec4 depthColor = texture2D( map, vUv );","    ","    depth = ( depthColor.r + depthColor.g + depthColor.b ) / 3.0;","    ","    if (depth > (1.0 - 3.0/255.0) )","    {","      vec4 depthColor2 = texture2D( map, vUv2 );","      float depth2 = ( depthColor2.r + depthColor2.g + depthColor2.b ) / 3.0 ;","      depth += depth2;","    }","    ","    return depth;","  }","","float median(float a, float b, float c)","  {","    float r=a;","    ","    if ( (a<b) && (b<c) )","    {","      r = b;","    }","    if ( (a<c) && (c<b) )","    {","      r = c;","    }","    return r;","  }","","float variance(float d1, float d2, float d3, float d4, float d5, float d6, float d7, float d8, float d9)","  {","    float mean = (d1 + d2 + d3 + d4 + d5 + d6 + d7 + d8 + d9) / 9.0;","    float t1 = (d1-mean);","    float t2 = (d2-mean);","    float t3 = (d3-mean);","    float t4 = (d4-mean);","    float t5 = (d5-mean);","    float t6 = (d6-mean);","    float t7 = (d7-mean);","    float t8 = (d8-mean);","    float t9 = (d9-mean);","    float v = (t1*t1+t2*t2+t3*t3+t4*t4+t5*t5+t6*t6+t7*t7+t8*t8+t9*t9)/9.0;","    return v;","  }","","vec2 decodeDepth(vec2 pos)","  {","    vec2 ret;","    ","    ","    float depth1 = sampleDepth(vec2(position.x-1.0, position.y-1.0));","    float depth2 = sampleDepth(vec2(position.x, position.y-1.0));","    float depth3 = sampleDepth(vec2(position.x+1.0, position.y-1.0));","    float depth4 = sampleDepth(vec2(position.x-1.0, position.y));","    float depth5 = sampleDepth(vec2(position.x, position.y));","    float depth6 = sampleDepth(vec2(position.x+1.0, position.y));","    float depth7 = sampleDepth(vec2(position.x-1.0, position.y+1.0));","    float depth8 = sampleDepth(vec2(position.x, position.y+1.0));","    float depth9 = sampleDepth(vec2(position.x+1.0, position.y+1.0));","    ","    float median1 = median(depth1, depth2, depth3);","    float median2 = median(depth4, depth5, depth6);","    float median3 = median(depth7, depth8, depth9);","    ","    ret.x = median(median1, median2, median3);","    ret.y = variance(depth1, depth2, depth3, depth4, depth5, depth6, depth7, depth8, depth9);","    ","    return ret;","    ","  }","","","void main() {","  ","  vUvP = vec2( position.x / (width*2.0), position.y / (height*2.0)+0.5 );","  colorP = vec2( position.x / (width*2.0)+0.5 , position.y / (height*2.0)  );","  ","  vec4 pos = vec4(0.0,0.0,0.0,0.0);","  depthVariance = 0.0;","  ","  if ( (vUvP.x<0.0)|| (vUvP.x>0.5) || (vUvP.y<0.5) || (vUvP.y>0.0))","  {","    vec2 smp = decodeDepth(vec2(position.x, position.y));","    float depth = smp.x;","    depthVariance = smp.y;","    ","    float z = -depth;","    ","    pos = vec4(","      ( position.x / width - 0.5 ) * z *0.5 * (1000.0/focallength) * -1.0,","      ( position.y / height - 0.5 ) * z *0.5 * (1000.0/focallength),","      (- z + zOffset / 1000.0) * 1.0,","      1.0);","    ","    vec2 maskP = vec2( position.x / (width*2.0), position.y / (height*2.0)  );","    vec4 maskColor = texture2D( map, maskP );","    maskVal = ( maskColor.r + maskColor.g + maskColor.b ) / 3.0 ;","  }","  ","  gl_PointSize = pointSize;","  gl_Position = projectionMatrix * modelViewMatrix * pos;","  ","}"].join("\n"),this.fragment_shader=["uniform sampler2D map;","uniform float varianceThreshold;","uniform float whiteness;","","varying vec2 vUvP;","varying vec2 colorP;","","varying float depthVariance;","varying float maskVal;","","","void main() {","  ","  vec4 color;","  ","  if ( (depthVariance>varianceThreshold) || (maskVal>0.5) ||(vUvP.x<0.0)|| (vUvP.x>0.5) || (vUvP.y<0.5) || (vUvP.y>1.0))","  {  ","    discard;","  }","  else ","  {","    color = texture2D( map, colorP );","    ","    float fader = whiteness /100.0;","    ","    color.r = color.r * (1.0-fader)+ fader;","    ","    color.g = color.g * (1.0-fader)+ fader;","    ","    color.b = color.b * (1.0-fader)+ fader;","    ","    color.a = 1.0;//smoothstep( 20000.0, -20000.0, gl_FragCoord.z / gl_FragCoord.w );","  }","  ","  gl_FragColor = vec4( color.r, color.g, color.b, color.a );","  ","}"].join("\n")},ROS3D.CloseCloud.prototype=Object.create(THREE.Object3D.prototype),ROS3D.CloseCloud.prototype.constructor=ROS3D.CloseCloud,ROS3D.CloseCloud.prototype.clone=function(a,b){return void 0===a&&(a=new ROS3D.CloseCloud(this.options)),THREE.Object3D.prototype.clone.call(this,a,b),a},ROS3D.CloseCloud.prototype.metaLoaded=function(){this.metaLoaded=!0,this.initStreamer()},ROS3D.CloseCloud.prototype.initStreamer=function(){if(this.metaLoaded){this.dctexture=new THREE.Texture(this.video),this.dcgeometry=new THREE.Geometry;for(var a=this.width/2,b=this.height/2,c=0,d=a*b;d>c;c++){var e=new THREE.Vector3;e.x=c%a,e.y=Math.floor(c/a),this.dcgeometry.vertices.push(e)}this.dcmaterial=new THREE.ShaderMaterial({uniforms:{map:{type:"t",value:this.dctexture},width:{type:"f",value:a},height:{type:"f",value:b},focallength:{type:"f",value:this.f},pointSize:{type:"f",value:this.pointSize},zOffset:{type:"f",value:0},whiteness:{type:"f",value:this.whiteness},varianceThreshold:{type:"f",value:this.varianceThreshold}},vertexShader:this.vertex_shader,fragmentShader:this.fragment_shader}),this.dcmaterial.color=new THREE.Color(16777215),this.mesh=new THREE.PointCloud(this.dcgeometry,this.dcmaterial),this.mesh.frustumCulled=!1,this.mesh.position.set(0,0,0),this.add(this.mesh);var f=this;this.interval=setInterval(function(){(f.isMjpeg||f.video.readyState===f.video.HAVE_ENOUGH_DATA)&&(f.dctexture.needsUpdate=!0)},1e3/30)}},ROS3D.CloseCloud.prototype.startStream=function(){this.isMjpeg||this.video.play()},ROS3D.CloseCloud.prototype.stopStream=function(){this.isMjpeg||this.video.pause(),this.video.src="",clearInterval(this.interval)},ROS3D.DepthCloud=function(a){a=a||{},THREE.Object3D.call(this),this.url=a.url,this.streamType=a.streamType||"vp8",this.f=a.f||526,this.pointSize=a.pointSize||3,this.width=a.width||1024,this.height=a.height||1024,this.whiteness=a.whiteness||0,this.varianceThreshold=a.varianceThreshold||16667e-9;this.isMjpeg="mjpeg"===this.streamType.toLowerCase(),this.video=document.createElement(this.isMjpeg?"img":"video"),this.video.addEventListener(this.isMjpeg?"load":"loadedmetadata",this.metaLoaded.bind(this),!1),this.isMjpeg||(this.video.loop=!0),this.video.src=this.url,this.video.crossOrigin="Anonymous",this.video.setAttribute("crossorigin","Anonymous"),this.vertex_shader=["uniform sampler2D map;","","uniform float width;","uniform float height;","uniform float nearClipping, farClipping;","","uniform float pointSize;","uniform float zOffset;","","uniform float focallength;","","varying vec2 vUvP;","varying vec2 colorP;","","varying float depthVariance;","varying float maskVal;","","float sampleDepth(vec2 pos)","  {","    float depth;","    ","    vec2 vUv = vec2( pos.x / (width*2.0), pos.y / (height*2.0)+0.5 );","    vec2 vUv2 = vec2( pos.x / (width*2.0)+0.5, pos.y / (height*2.0)+0.5 );","    ","    vec4 depthColor = texture2D( map, vUv );","    ","    depth = ( depthColor.r + depthColor.g + depthColor.b ) / 3.0 ;","    ","    if (depth>0.99)","    {","      vec4 depthColor2 = texture2D( map, vUv2 );","      float depth2 = ( depthColor2.r + depthColor2.g + depthColor2.b ) / 3.0 ;","      depth = 0.99+depth2;","    }","    ","    return depth;","  }","","float median(float a, float b, float c)","  {","    float r=a;","    ","    if ( (a<b) && (b<c) )","    {","      r = b;","    }","    if ( (a<c) && (c<b) )","    {","      r = c;","    }","    return r;","  }","","float variance(float d1, float d2, float d3, float d4, float d5, float d6, float d7, float d8, float d9)","  {","    float mean = (d1 + d2 + d3 + d4 + d5 + d6 + d7 + d8 + d9) / 9.0;","    float t1 = (d1-mean);","    float t2 = (d2-mean);","    float t3 = (d3-mean);","    float t4 = (d4-mean);","    float t5 = (d5-mean);","    float t6 = (d6-mean);","    float t7 = (d7-mean);","    float t8 = (d8-mean);","    float t9 = (d9-mean);","    float v = (t1*t1+t2*t2+t3*t3+t4*t4+t5*t5+t6*t6+t7*t7+t8*t8+t9*t9)/9.0;","    return v;","  }","","vec2 decodeDepth(vec2 pos)","  {","    vec2 ret;","    ","    ","    float depth1 = sampleDepth(vec2(position.x-1.0, position.y-1.0));","    float depth2 = sampleDepth(vec2(position.x, position.y-1.0));","    float depth3 = sampleDepth(vec2(position.x+1.0, position.y-1.0));","    float depth4 = sampleDepth(vec2(position.x-1.0, position.y));","    float depth5 = sampleDepth(vec2(position.x, position.y));","    float depth6 = sampleDepth(vec2(position.x+1.0, position.y));","    float depth7 = sampleDepth(vec2(position.x-1.0, position.y+1.0));","    float depth8 = sampleDepth(vec2(position.x, position.y+1.0));","    float depth9 = sampleDepth(vec2(position.x+1.0, position.y+1.0));","    ","    float median1 = median(depth1, depth2, depth3);","    float median2 = median(depth4, depth5, depth6);","    float median3 = median(depth7, depth8, depth9);","    ","    ret.x = median(median1, median2, median3);","    ret.y = variance(depth1, depth2, depth3, depth4, depth5, depth6, depth7, depth8, depth9);","    ","    return ret;","    ","  }","","","void main() {","  ","  vUvP = vec2( position.x / (width*2.0), position.y / (height*2.0)+0.5 );","  colorP = vec2( position.x / (width*2.0)+0.5 , position.y / (height*2.0)  );","  ","  vec4 pos = vec4(0.0,0.0,0.0,0.0);","  depthVariance = 0.0;","  ","  if ( (vUvP.x<0.0)|| (vUvP.x>0.5) || (vUvP.y<0.5) || (vUvP.y>0.0))","  {","    vec2 smp = decodeDepth(vec2(position.x, position.y));","    float depth = smp.x;","    depthVariance = smp.y;","    ","    float z = -depth;","    ","    pos = vec4(","      ( position.x / width - 0.5 ) * z * (1000.0/focallength) * -1.0,","      ( position.y / height - 0.5 ) * z * (1000.0/focallength),","      (- z + zOffset / 1000.0) * 2.0,","      1.0);","    ","    vec2 maskP = vec2( position.x / (width*2.0), position.y / (height*2.0)  );","    vec4 maskColor = texture2D( map, maskP );","    maskVal = ( maskColor.r + maskColor.g + maskColor.b ) / 3.0 ;","  }","  ","  gl_PointSize = pointSize;","  gl_Position = projectionMatrix * modelViewMatrix * pos;","  ","}"].join("\n"),this.fragment_shader=["uniform sampler2D map;","uniform float varianceThreshold;","uniform float whiteness;","","varying vec2 vUvP;","varying vec2 colorP;","","varying float depthVariance;","varying float maskVal;","","","void main() {","  ","  vec4 color;","  ","  if ( (depthVariance>varianceThreshold) || (maskVal>0.5) ||(vUvP.x<0.0)|| (vUvP.x>0.5) || (vUvP.y<0.5) || (vUvP.y>1.0))","  {  ","    discard;","  }","  else ","  {","    color = texture2D( map, colorP );","    ","    float fader = whiteness /100.0;","    ","    color.r = color.r * (1.0-fader)+ fader;","    ","    color.g = color.g * (1.0-fader)+ fader;","    ","    color.b = color.b * (1.0-fader)+ fader;","    ","    color.a = 1.0;//smoothstep( 20000.0, -20000.0, gl_FragCoord.z / gl_FragCoord.w );","  }","  ","  gl_FragColor = vec4( color.r, color.g, color.b, color.a );","  ","}"].join("\n")},ROS3D.DepthCloud.prototype.__proto__=THREE.Object3D.prototype,ROS3D.DepthCloud.prototype.metaLoaded=function(){this.metaLoaded=!0,this.initStreamer()},ROS3D.DepthCloud.prototype.initStreamer=function(){if(this.metaLoaded){this.texture=new THREE.Texture(this.video),this.geometry=new THREE.Geometry;for(var a=0,b=this.width*this.height;b>a;a++){var c=new THREE.Vector3;c.x=a%this.width,c.y=Math.floor(a/this.width),this.geometry.vertices.push(c)}this.material=new THREE.ShaderMaterial({uniforms:{map:{type:"t",value:this.texture},width:{type:"f",value:this.width},height:{type:"f",value:this.height},focallength:{type:"f",value:this.f},pointSize:{type:"f",value:this.pointSize},zOffset:{type:"f",value:0},whiteness:{type:"f",value:this.whiteness},varianceThreshold:{type:"f",value:this.varianceThreshold}},vertexShader:this.vertex_shader,fragmentShader:this.fragment_shader}),this.mesh=new THREE.PointCloud(this.geometry,this.material),this.mesh.position.x=0,this.mesh.position.y=0,this.add(this.mesh);var d=this;setInterval(function(){(d.isMjpeg||d.video.readyState===d.video.HAVE_ENOUGH_DATA)&&(d.texture.needsUpdate=!0)},1e3/30)}},ROS3D.DepthCloud.prototype.startStream=function(){this.isMjpeg||this.video.play()},ROS3D.DepthCloud.prototype.stopStream=function(){this.isMjpeg||this.video.pause()},ROS3D.PointCloud=function(a){a=a||{},this.topic=a.topic,this.pointSize=a.pointSize||3,this.width=a.width||640,this.height=a.height||480,this.whiteness=a.whiteness||0,this.queue_length=a.queue_length||0;var b=a.ros,c=a.topic;this.geometry=new THREE.Geometry;for(var d=0,e=this.width*this.height;e>d;d++){var f=new THREE.Vector3;this.geometry.vertices.push(f),this.geometry.colors.push(new THREE.Color)}this.mesh=new THREE.PointCloud(this.geometry,new THREE.PointCloudMaterial({size:this.pointSize/1e3})),this.mesh.material.vertexColors=THREE.VertexColors,this.mesh.frustumCulled=!1,this.rosTopic=new ROSLIB.Topic({ros:b,name:c,messageType:"sensor_msgs/PointCloud2",compression:"png",queue_length:this.queue_length,throttle_rate:500})},ROS3D.PointCloud.prototype.startStream=function(){var a=this;this.rosTopic.subscribe(function(b){for(var c,d=dcodeIO.ByteBuffer.wrap(b.data,"base64",dcodeIO.ByteBuffer.LITTLE_ENDIAN),e=b.width*b.height,f=0;f<a.geometry.vertices.length;f++)if(e>f){switch(a.geometry.vertices[f].x=d.readFloat32(),a.geometry.vertices[f].y=d.readFloat32(),a.geometry.vertices[f].z=d.readFloat32(),d.offset+=4,c=16,b.point_step){case 48:d.offset+=16,c+=16;case 32:a.geometry.colors[f].b=d.readUint8()/255,a.geometry.colors[f].g=d.readUint8()/255,a.geometry.colors[f].r=d.readUint8()/255,c+=3;break;case 16:}d.offset+=b.point_step-c}else a.geometry.vertices[f].x=a.geometry.vertices[f-1].x,a.geometry.vertices[f].y=a.geometry.vertices[f-1].y,a.geometry.vertices[f].z=a.geometry.vertices[f-1].z;a.geometry.verticesNeedUpdate=!0,a.geometry.colorsNeedUpdate=!0})},ROS3D.PointCloud.prototype.stopStream=function(){this.rosTopic.unsubscribe()},ROS3D.InteractiveMarker=function(a){THREE.Object3D.call(this),THREE.EventDispatcher.call(this);var b=this;a=a||{};var c=a.handle;this.name=c.name;var d=a.camera,e=a.path||"/",f=a.loader||ROS3D.COLLADA_LOADER_2;this.dragging=!1,this.onServerSetPose({pose:c.pose}),this.dragStart={position:new THREE.Vector3,orientation:new THREE.Quaternion,positionWorld:new THREE.Vector3,orientationWorld:new THREE.Quaternion,event3d:{}},c.controls.forEach(function(a){b.add(new ROS3D.InteractiveMarkerControl({parent:b,handle:c,message:a,camera:d,path:e,loader:f}))}),c.menuEntries.length>0&&(this.menu=new ROS3D.InteractiveMarkerMenu({menuEntries:c.menuEntries,menuFontSize:c.menuFontSize}),this.menu.addEventListener("menu-select",function(a){b.dispatchEvent(a)}))},ROS3D.InteractiveMarker.prototype.__proto__=THREE.Object3D.prototype,ROS3D.InteractiveMarker.prototype.showMenu=function(a,b){this.menu&&this.menu.show(a,b)},ROS3D.InteractiveMarker.prototype.moveAxis=function(a,b,c){if(this.dragging){var d=a.currentControlOri,e=b.clone().applyQuaternion(d),f=this.dragStart.event3d.intersection.point,g=e.clone().applyQuaternion(this.dragStart.orientationWorld.clone()),h=new THREE.Ray(f,g),i=ROS3D.closestAxisPoint(h,c.camera,c.mousePos),j=new THREE.Vector3;j.addVectors(this.dragStart.position,e.clone().applyQuaternion(this.dragStart.orientation).multiplyScalar(i)),this.setPosition(a,j),c.stopPropagation()}},ROS3D.InteractiveMarker.prototype.movePlane=function(a,b,c){if(this.dragging){var d=a.currentControlOri,e=b.clone().applyQuaternion(d),f=this.dragStart.event3d.intersection.point,g=e.clone().applyQuaternion(this.dragStart.orientationWorld),h=ROS3D.intersectPlane(c.mouseRay,f,g),i=new THREE.Vector3;i.subVectors(h,f),i.add(this.dragStart.positionWorld),this.setPosition(a,i),c.stopPropagation()}},ROS3D.InteractiveMarker.prototype.rotateAxis=function(a,b,c){if(this.dragging){a.updateMatrixWorld();var d=a.currentControlOri,e=d.clone().multiply(b.clone()),f=new THREE.Vector3(1,0,0).applyQuaternion(e),g=this.dragStart.event3d.intersection.point,h=f.applyQuaternion(this.dragStart.orientationWorld),i=ROS3D.intersectPlane(c.mouseRay,g,h),j=new THREE.Ray(this.dragStart.positionWorld,h),k=ROS3D.intersectPlane(j,g,h),l=this.dragStart.orientationWorld.clone().multiply(e),m=l.clone().inverse();i.sub(k),i.applyQuaternion(m);var n=this.dragStart.event3d.intersection.point.clone();n.sub(k),n.applyQuaternion(m);var o=Math.atan2(i.y,i.z),p=Math.atan2(n.y,n.z),q=p-o,r=new THREE.Quaternion;r.setFromAxisAngle(f,q),this.setOrientation(a,r.multiply(this.dragStart.orientationWorld)),c.stopPropagation()}},ROS3D.InteractiveMarker.prototype.feedbackEvent=function(a,b){this.dispatchEvent({type:a,position:this.position.clone(),orientation:this.quaternion.clone(),controlName:b.name})},ROS3D.InteractiveMarker.prototype.startDrag=function(a,b){if(0===b.domEvent.button){b.stopPropagation(),this.dragging=!0,this.updateMatrixWorld(!0);var c=new THREE.Vector3;this.matrixWorld.decompose(this.dragStart.positionWorld,this.dragStart.orientationWorld,c),this.dragStart.position=this.position.clone(),this.dragStart.orientation=this.quaternion.clone(),this.dragStart.event3d=b,this.feedbackEvent("user-mousedown",a)}},ROS3D.InteractiveMarker.prototype.stopDrag=function(a,b){0===b.domEvent.button&&(b.stopPropagation(),this.dragging=!1,this.dragStart.event3d={},this.onServerSetPose(this.bufferedPoseEvent),this.bufferedPoseEvent=void 0,this.feedbackEvent("user-mouseup",a))},ROS3D.InteractiveMarker.prototype.buttonClick=function(a,b){b.stopPropagation(),this.feedbackEvent("user-button-click",a)},ROS3D.InteractiveMarker.prototype.setPosition=function(a,b){this.position.copy(b),this.feedbackEvent("user-pose-change",a)},ROS3D.InteractiveMarker.prototype.setOrientation=function(a,b){b.normalize(),this.quaternion.copy(b),this.feedbackEvent("user-pose-change",a)},ROS3D.InteractiveMarker.prototype.onServerSetPose=function(a){if(void 0!==a)if(this.dragging)this.bufferedPoseEvent=a;else{var b=a.pose;this.position.x=b.position.x,this.position.y=b.position.y,this.position.z=b.position.z,this.quaternion.copy(new THREE.Quaternion(b.orientation.x,b.orientation.y,b.orientation.z,b.orientation.w)),this.updateMatrixWorld(!0)}},ROS3D.InteractiveMarker.prototype.dispose=function(){var a=this;this.children.forEach(function(b){b.children.forEach(function(a){a.dispose(),b.remove(a)}),a.remove(b)})},THREE.EventDispatcher.prototype.apply(ROS3D.InteractiveMarker.prototype),ROS3D.InteractiveMarkerClient=function(a){a=a||{},this.ros=a.ros,this.tfClient=a.tfClient,this.topic=a.topic,this.path=a.path||"/",this.camera=a.camera,this.rootObject=a.rootObject||new THREE.Object3D,this.loader=a.loader||ROS3D.COLLADA_LOADER_2,this.menuFontSize=a.menuFontSize||"0.8em",this.interactiveMarkers={},this.updateTopic=null,this.feedbackTopic=null,this.topic&&this.subscribe(this.topic)},ROS3D.InteractiveMarkerClient.prototype.subscribe=function(a){this.unsubscribe(),this.updateTopic=new ROSLIB.Topic({ros:this.ros,name:a+"/tunneled/update",messageType:"visualization_msgs/InteractiveMarkerUpdate",compression:"png"}),this.updateTopic.subscribe(this.processUpdate.bind(this)),this.feedbackTopic=new ROSLIB.Topic({ros:this.ros,name:a+"/feedback",messageType:"visualization_msgs/InteractiveMarkerFeedback",compression:"png"}),this.feedbackTopic.advertise(),this.initService=new ROSLIB.Service({ros:this.ros,name:a+"/tunneled/get_init",serviceType:"demo_interactive_markers/GetInit"});var b=new ROSLIB.ServiceRequest({});this.initService.callService(b,this.processInit.bind(this))},ROS3D.InteractiveMarkerClient.prototype.unsubscribe=function(){this.updateTopic&&this.updateTopic.unsubscribe(),this.feedbackTopic&&this.feedbackTopic.unadvertise();for(var a in this.interactiveMarkers)this.eraseIntMarker(a);this.interactiveMarkers={}},ROS3D.InteractiveMarkerClient.prototype.processInit=function(a){var b=a.msg;b.erases=[];for(var c in this.interactiveMarkers)b.erases.push(c);b.poses=[],this.processUpdate(b)},ROS3D.InteractiveMarkerClient.prototype.processUpdate=function(a){var b=this;a.erases.forEach(function(a){b.eraseIntMarker(a)}),a.poses.forEach(function(a){var c=b.interactiveMarkers[a.name];c&&c.setPoseFromServer(a.pose)}),a.markers.forEach(function(a){var c=b.interactiveMarkers[a.name];c&&b.eraseIntMarker(c.name);var d=new ROS3D.InteractiveMarkerHandle({message:a,feedbackTopic:b.feedbackTopic,tfClient:b.tfClient,menuFontSize:b.menuFontSize});b.interactiveMarkers[a.name]=d;var e=new ROS3D.InteractiveMarker({handle:d,camera:b.camera,path:b.path,loader:b.loader});e.name=a.name,b.rootObject.add(e),d.on("pose",function(a){e.onServerSetPose({pose:a})}),e.addEventListener("user-pose-change",d.setPoseFromClientBound),e.addEventListener("user-mousedown",d.onMouseDownBound),e.addEventListener("user-mouseup",d.onMouseUpBound),e.addEventListener("user-button-click",d.onButtonClickBound),e.addEventListener("menu-select",d.onMenuSelectBound),d.subscribeTf()})},ROS3D.InteractiveMarkerClient.prototype.eraseIntMarker=function(a){if(this.interactiveMarkers[a]){var b=this.rootObject.getObjectByName(a);this.rootObject.remove(b);var c=this.interactiveMarkers[a];c.unsubscribeTf(),b.removeEventListener("user-pose-change",c.setPoseFromClientBound),b.removeEventListener("user-mousedown",c.onMouseDownBound),b.removeEventListener("user-mouseup",c.onMouseUpBound),b.removeEventListener("user-button-click",c.onButtonClickBound),b.removeEventListener("menu-select",c.onMenuSelectBound),delete this.interactiveMarkers[a],b.dispose()}},ROS3D.InteractiveMarkerControl=function(a){function b(a){a.stopPropagation()}var c=this;THREE.Object3D.call(this),a=a||{},this.parent=a.parent;var d=a.handle,e=a.message;this.name=e.name,this.camera=a.camera,this.path=a.path||"/",this.loader=a.loader||ROS3D.COLLADA_LOADER_2,this.dragging=!1,this.startMousePos=new THREE.Vector2;var f=new THREE.Quaternion(e.orientation.x,e.orientation.y,e.orientation.z,e.orientation.w);f.normalize();var g=new THREE.Vector3(1,0,0);switch(g.applyQuaternion(f),this.currentControlOri=new THREE.Quaternion,e.interaction_mode){case ROS3D.INTERACTIVE_MARKER_MOVE_AXIS:this.addEventListener("mousemove",this.parent.moveAxis.bind(this.parent,this,g)),this.addEventListener("touchmove",this.parent.moveAxis.bind(this.parent,this,g));break;case ROS3D.INTERACTIVE_MARKER_ROTATE_AXIS:this.addEventListener("mousemove",this.parent.rotateAxis.bind(this.parent,this,f));break;case ROS3D.INTERACTIVE_MARKER_MOVE_PLANE:this.addEventListener("mousemove",this.parent.movePlane.bind(this.parent,this,g));break;case ROS3D.INTERACTIVE_MARKER_BUTTON:this.addEventListener("click",this.parent.buttonClick.bind(this.parent,this))}e.interaction_mode!==ROS3D.INTERACTIVE_MARKER_NONE&&(this.addEventListener("mousedown",this.parent.startDrag.bind(this.parent,this)),this.addEventListener("mouseup",this.parent.stopDrag.bind(this.parent,this)),this.addEventListener("contextmenu",this.parent.showMenu.bind(this.parent,this)),this.addEventListener("mouseup",function(a){0===c.startMousePos.distanceToSquared(a.mousePos)&&(a.type="contextmenu",c.dispatchEvent(a))}),this.addEventListener("mouseover",b),this.addEventListener("mouseout",b),this.addEventListener("click",b),this.addEventListener("mousedown",function(a){c.startMousePos=a.mousePos}),this.addEventListener("touchstart",function(a){1===a.domEvent.touches.length&&(a.type="mousedown",a.domEvent.button=0,c.dispatchEvent(a))}),this.addEventListener("touchmove",function(a){1===a.domEvent.touches.length&&(a.type="mousemove",a.domEvent.button=0,c.dispatchEvent(a))}),this.addEventListener("touchend",function(a){0===a.domEvent.touches.length&&(a.domEvent.button=0,a.type="mouseup",c.dispatchEvent(a),a.type="click",c.dispatchEvent(a))}));var h=new THREE.Quaternion;this.parent.position.clone().multiplyScalar(-1);switch(e.orientation_mode){case ROS3D.INTERACTIVE_MARKER_INHERIT:h=this.parent.quaternion.clone().inverse(),this.updateMatrixWorld=function(a){ROS3D.InteractiveMarkerControl.prototype.updateMatrixWorld.call(c,a),c.currentControlOri.copy(c.quaternion),c.currentControlOri.normalize()};break;case ROS3D.INTERACTIVE_MARKER_FIXED:this.updateMatrixWorld=function(a){c.quaternion.copy(c.parent.quaternion.clone().inverse()),c.updateMatrix(),c.matrixWorldNeedsUpdate=!0,ROS3D.InteractiveMarkerControl.prototype.updateMatrixWorld.call(c,a),c.currentControlOri.copy(c.quaternion)};break;case ROS3D.INTERACTIVE_MARKER_VIEW_FACING:var i=e.independent_marker_orientation;this.updateMatrixWorld=function(a){c.camera.updateMatrixWorld();var b=(new THREE.Matrix4).extractRotation(c.camera.matrixWorld),d=new THREE.Matrix4,e=.5*Math.PI,f=new THREE.Euler(-e,0,e);d.makeRotationFromEuler(f);var g=new THREE.Matrix4;g.getInverse(c.parent.matrixWorld),b.multiplyMatrices(b,d),b.multiplyMatrices(g,b),c.currentControlOri.setFromRotationMatrix(b),i||(c.quaternion.copy(c.currentControlOri),c.updateMatrix(),c.matrixWorldNeedsUpdate=!0),ROS3D.InteractiveMarkerControl.prototype.updateMatrixWorld.call(c,a)};break;default:console.error("Unkown orientation mode: "+e.orientation_mode)}var j=new ROSLIB.TFClient({ros:d.tfClient.ros,fixedFrame:d.message.header.frame_id,serverName:d.tfClient.serverName});e.markers.forEach(function(a){var b=function(b){var d=new ROS3D.Marker({message:a,path:c.path,loader:c.loader});if(null!==b){var e=new ROSLIB.Pose({position:d.position,orientation:d.quaternion});e.applyTransform(new ROSLIB.Transform(b)),d.setPose(e),d.updateMatrixWorld(),j.unsubscribe(a.header.frame_id)}c.add(d)};""!==a.header.frame_id?j.subscribe(a.header.frame_id,b):b(null)})},ROS3D.InteractiveMarkerControl.prototype.__proto__=THREE.Object3D.prototype,ROS3D.InteractiveMarkerHandle=function(a){a=a||{},this.message=a.message,this.feedbackTopic=a.feedbackTopic,this.tfClient=a.tfClient,this.menuFontSize=a.menuFontSize||"0.8em",this.name=this.message.name,this.header=this.message.header,this.controls=this.message.controls,this.menuEntries=this.message.menu_entries,this.dragging=!1,this.timeoutHandle=null,this.tfTransform=new ROSLIB.Transform,this.pose=new ROSLIB.Pose,this.setPoseFromClientBound=this.setPoseFromClient.bind(this),this.onMouseDownBound=this.onMouseDown.bind(this),this.onMouseUpBound=this.onMouseUp.bind(this),this.onButtonClickBound=this.onButtonClick.bind(this),this.onMenuSelectBound=this.onMenuSelect.bind(this),this.setPoseFromServer(this.message.pose),this.tfUpdateBound=this.tfUpdate.bind(this)},ROS3D.InteractiveMarkerHandle.prototype.__proto__=EventEmitter2.prototype,ROS3D.InteractiveMarkerHandle.prototype.subscribeTf=function(){0===this.message.header.stamp.secs&&0===this.message.header.stamp.nsecs&&this.tfClient.subscribe(this.message.header.frame_id,this.tfUpdateBound)},ROS3D.InteractiveMarkerHandle.prototype.unsubscribeTf=function(){this.tfClient.unsubscribe(this.message.header.frame_id,this.tfUpdateBound)},ROS3D.InteractiveMarkerHandle.prototype.emitServerPoseUpdate=function(){var a=new ROSLIB.Pose(this.pose);a.applyTransform(this.tfTransform),this.emit("pose",a)},ROS3D.InteractiveMarkerHandle.prototype.setPoseFromServer=function(a){this.pose=new ROSLIB.Pose(a),this.emitServerPoseUpdate()},ROS3D.InteractiveMarkerHandle.prototype.tfUpdate=function(a){this.tfTransform=new ROSLIB.Transform(a),this.emitServerPoseUpdate()},ROS3D.InteractiveMarkerHandle.prototype.setPoseFromClient=function(a){this.pose=new ROSLIB.Pose(a);var b=this.tfTransform.clone();b.rotation.invert(),b.translation.multiplyQuaternion(b.rotation),b.translation.x*=-1,b.translation.y*=-1,b.translation.z*=-1,this.pose.applyTransform(b),this.sendFeedback(ROS3D.INTERACTIVE_MARKER_POSE_UPDATE,void 0,0,a.controlName),this.dragging&&(this.timeoutHandle&&clearTimeout(this.timeoutHandle),
-this.timeoutHandle=setTimeout(this.setPoseFromClient.bind(this,a),250))},ROS3D.InteractiveMarkerHandle.prototype.onButtonClick=function(a){this.sendFeedback(ROS3D.INTERACTIVE_MARKER_BUTTON_CLICK,a.clickPosition,0,a.controlName)},ROS3D.InteractiveMarkerHandle.prototype.onMouseDown=function(a){this.sendFeedback(ROS3D.INTERACTIVE_MARKER_MOUSE_DOWN,a.clickPosition,0,a.controlName),this.dragging=!0},ROS3D.InteractiveMarkerHandle.prototype.onMouseUp=function(a){this.sendFeedback(ROS3D.INTERACTIVE_MARKER_MOUSE_UP,a.clickPosition,0,a.controlName),this.dragging=!1,this.timeoutHandle&&clearTimeout(this.timeoutHandle)},ROS3D.InteractiveMarkerHandle.prototype.onMenuSelect=function(a){this.sendFeedback(ROS3D.INTERACTIVE_MARKER_MENU_SELECT,void 0,a.id,a.controlName)},ROS3D.InteractiveMarkerHandle.prototype.sendFeedback=function(a,b,c,d){var e=void 0!==b;b=b||{x:0,y:0,z:0};var f={header:this.header,client_id:this.clientID,marker_name:this.name,control_name:d,event_type:a,pose:this.pose,mouse_point:b,mouse_point_valid:e,menu_entry_id:c};this.feedbackTopic.publish(f)},ROS3D.InteractiveMarkerMenu=function(a){function b(a,b){this.dispatchEvent({type:"menu-select",domEvent:b,id:a.id,controlName:this.controlName}),this.hide(b)}function c(a,e){var f=document.createElement("ul");a.appendChild(f);for(var g=e.children,h=0;h<g.length;h++){var i=document.createElement("li"),j=document.createElement("div");j.appendChild(document.createTextNode(g[h].title)),f.appendChild(i),i.appendChild(j),g[h].children.length>0?(c(i,g[h]),j.addEventListener("click",d.hide.bind(d)),j.addEventListener("touchstart",d.hide.bind(d))):(j.addEventListener("click",b.bind(d,g[h])),j.addEventListener("touchstart",b.bind(d,g[h])),j.className="default-interactive-marker-menu-entry")}}var d=this;a=a||{};var e=a.menuEntries,f=a.className||"default-interactive-marker-menu",g=(a.entryClassName||"default-interactive-marker-menu-entry",a.overlayClassName||"default-interactive-marker-overlay"),h=a.menuFontSize||"0.8em",i=[];if(i[0]={children:[]},THREE.EventDispatcher.call(this),null===document.getElementById("default-interactive-marker-menu-css")){var j=document.createElement("style");j.id="default-interactive-marker-menu-css",j.type="text/css",j.innerHTML=".default-interactive-marker-menu {background-color: #444444;border: 1px solid #888888;border: 1px solid #888888;padding: 0px 0px 0px 0px;color: #FFFFFF;font-family: sans-serif;font-size: "+h+";z-index: 1002;}.default-interactive-marker-menu ul {padding: 0px 0px 5px 0px;margin: 0px;list-style-type: none;}.default-interactive-marker-menu ul li div {-webkit-touch-callout: none;-webkit-user-select: none;-khtml-user-select: none;-moz-user-select: none;-ms-user-select: none;user-select: none;cursor: default;padding: 3px 10px 3px 10px;}.default-interactive-marker-menu-entry:hover {  background-color: #666666;  cursor: pointer;}.default-interactive-marker-menu ul ul {  font-style: italic;  padding-left: 10px;}.default-interactive-marker-overlay {  position: absolute;  top: 0%;  left: 0%;  width: 100%;  height: 100%;  background-color: black;  z-index: 1001;  -moz-opacity: 0.0;  opacity: .0;  filter: alpha(opacity = 0);}",document.getElementsByTagName("head")[0].appendChild(j)}this.menuDomElem=document.createElement("div"),this.menuDomElem.style.position="absolute",this.menuDomElem.className=f,this.menuDomElem.addEventListener("contextmenu",function(a){a.preventDefault()}),this.overlayDomElem=document.createElement("div"),this.overlayDomElem.className=g,this.hideListener=this.hide.bind(this),this.overlayDomElem.addEventListener("contextmenu",this.hideListener),this.overlayDomElem.addEventListener("click",this.hideListener),this.overlayDomElem.addEventListener("touchstart",this.hideListener);var k,l,m;for(k=0;k<e.length;k++)l=e[k],m=l.id,i[m]={title:l.title,id:m,children:[]};for(k=0;k<e.length;k++){l=e[k],m=l.id;var n=i[m],o=i[l.parent_id];o.children.push(n)}c(this.menuDomElem,i[0])},ROS3D.InteractiveMarkerMenu.prototype.show=function(a,b){b&&b.preventDefault&&b.preventDefault(),this.controlName=a.name,void 0!==b.domEvent.changedTouches?(this.menuDomElem.style.left=b.domEvent.changedTouches[0].pageX+"px",this.menuDomElem.style.top=b.domEvent.changedTouches[0].pageY+"px"):(this.menuDomElem.style.left=b.domEvent.clientX+"px",this.menuDomElem.style.top=b.domEvent.clientY+"px"),document.body.appendChild(this.overlayDomElem),document.body.appendChild(this.menuDomElem)},ROS3D.InteractiveMarkerMenu.prototype.hide=function(a){a&&a.preventDefault&&a.preventDefault(),document.body.removeChild(this.overlayDomElem),document.body.removeChild(this.menuDomElem)},THREE.EventDispatcher.prototype.apply(ROS3D.InteractiveMarkerMenu.prototype),ROS3D.Marker=function(a){a=a||{};var b=a.path||"/",c=a.message,d=a.loader||ROS3D.COLLADA_LOADER_2;"/"!==b.substr(b.length-1)&&(b+="/"),THREE.Object3D.call(this),c.scale?this.msgScale=[c.scale.x,c.scale.y,c.scale.z]:this.msgScale=[1,1,1],this.msgColor=c.color,this.msgMesh=void 0,this.setPose(c.pose);var e=ROS3D.makeColorMaterial(this.msgColor.r,this.msgColor.g,this.msgColor.b,this.msgColor.a);switch(c.type){case ROS3D.MARKER_ARROW:var f,g=c.scale.x,h=.23*g,i=c.scale.y,j=.5*i,k=null;if(2===c.points.length){k=new THREE.Vector3(c.points[0].x,c.points[0].y,c.points[0].z);var l=new THREE.Vector3(c.points[1].x,c.points[1].y,c.points[1].z);f=k.clone().negate().add(l),g=f.length(),i=c.scale.y,j=c.scale.x,0!==c.scale.z&&(h=c.scale.z)}this.add(new ROS3D.Arrow({direction:f,origin:k,length:g,headLength:h,shaftDiameter:j,headDiameter:i,material:e}));break;case ROS3D.MARKER_CUBE:var m=new THREE.BoxGeometry(c.scale.x,c.scale.y,c.scale.z);this.add(new THREE.Mesh(m,e));break;case ROS3D.MARKER_SPHERE:var n=new THREE.SphereGeometry(.5),o=new THREE.Mesh(n,e);o.scale.x=c.scale.x,o.scale.y=c.scale.y,o.scale.z=c.scale.z,this.add(o);break;case ROS3D.MARKER_CYLINDER:var p=new THREE.CylinderGeometry(.5,.5,1,16,1,!1),q=new THREE.Mesh(p,e);q.quaternion.setFromAxisAngle(new THREE.Vector3(1,0,0),.5*Math.PI),q.scale.set(c.scale.x,c.scale.z,c.scale.y),this.add(q);break;case ROS3D.MARKER_LINE_STRIP:var r,s=new THREE.Geometry,t=new THREE.LineBasicMaterial({});for(r=0;r<c.points.length;r++){var u=new THREE.Vector3;u.x=c.points[r].x,u.y=c.points[r].y,u.z=c.points[r].z,s.vertices.push(u)}if(c.colors.length===c.points.length)for(t.vertexColors=!0,r=0;r<c.points.length;r++){var v=new THREE.Color;v.setRGB(c.colors[r].r,c.colors[r].g,c.colors[r].b),s.colors.push(v)}else t.color.setRGB(c.color.r,c.color.g,c.color.b);this.add(new THREE.Line(s,t));break;case ROS3D.MARKER_LINE_LIST:var w,x=new THREE.Geometry,y=new THREE.LineBasicMaterial({});for(w=0;w<c.points.length;w++){var z=new THREE.Vector3;z.x=c.points[w].x,z.y=c.points[w].y,z.z=c.points[w].z,x.vertices.push(z)}if(c.colors.length===c.points.length)for(y.vertexColors=!0,w=0;w<c.points.length;w++){var A=new THREE.Color;A.setRGB(c.colors[w].r,c.colors[w].g,c.colors[w].b),x.colors.push(A)}else y.color.setRGB(c.color.r,c.color.g,c.color.b);this.add(new THREE.Line(x,y,THREE.LinePieces));break;case ROS3D.MARKER_CUBE_LIST:var B,C,D,E,F=new THREE.Object3D,G=c.points.length,H=G===c.colors.length,I=Math.ceil(G/1250);for(B=0;G>B;B+=I)C=new THREE.BoxGeometry(c.scale.x,c.scale.y,c.scale.z),D=H?ROS3D.makeColorMaterial(c.colors[B].r,c.colors[B].g,c.colors[B].b,c.colors[B].a):e,E=new THREE.Mesh(C,D),E.position.x=c.points[B].x,E.position.y=c.points[B].y,E.position.z=c.points[B].z,F.add(E);this.add(F);break;case ROS3D.MARKER_SPHERE_LIST:var J,K,L,M,N=new THREE.Object3D,O=c.points.length,P=O===c.colors.length,Q=Math.ceil(O/1250);for(J=0;O>J;J+=Q)K=new THREE.SphereGeometry(.5,8,8),L=P?ROS3D.makeColorMaterial(c.colors[J].r,c.colors[J].g,c.colors[J].b,c.colors[J].a):e,M=new THREE.Mesh(K,L),M.scale.x=c.scale.x,M.scale.y=c.scale.y,M.scale.z=c.scale.z,M.position.x=c.points[J].x,M.position.y=c.points[J].y,M.position.z=c.points[J].z,N.add(M);this.add(N);break;case ROS3D.MARKER_POINTS:var R,S=new THREE.Geometry,T=new THREE.PointCloudMaterial({size:c.scale.x});for(R=0;R<c.points.length;R++){var U=new THREE.Vector3;U.x=c.points[R].x,U.y=c.points[R].y,U.z=c.points[R].z,S.vertices.push(U)}if(c.colors.length===c.points.length)for(T.vertexColors=!0,R=0;R<c.points.length;R++){var V=new THREE.Color;V.setRGB(c.colors[R].r,c.colors[R].g,c.colors[R].b),S.colors.push(V)}else T.color.setRGB(c.color.r,c.color.g,c.color.b);this.add(new THREE.PointCloud(S,T));break;case ROS3D.MARKER_TEXT_VIEW_FACING:if(c.text.length>0){var W=this.msgColor,X=document.createElement("canvas"),Y=X.getContext("2d"),Z=100,$="normal "+Z+"px sans-serif";Y.font=$;var _=Y.measureText(c.text),aa=_.width;X.width=aa,X.height=1.5*Z,Y.font=$,Y.fillStyle="rgba("+W.r+", "+W.g+", "+W.b+", "+W.a+")",Y.textAlign="left",Y.textBaseline="middle",Y.fillText(c.text,0,X.height/2);var ba=new THREE.Texture(X);ba.needsUpdate=!0;var ca=new THREE.SpriteMaterial({map:ba,useScreenCoordinates:!1}),da=new THREE.Sprite(ca),ea=c.scale.x;da.scale.set(aa/X.height*ea,ea,1),this.add(da)}break;case ROS3D.MARKER_MESH_RESOURCE:var fa=null;(0!==c.color.r||0!==c.color.g||0!==c.color.b||0!==c.color.a)&&(fa=e),this.msgMesh=c.mesh_resource.substr(10);var ga=new ROS3D.MeshResource({path:b,resource:this.msgMesh,material:fa,loader:d});this.add(ga);break;case ROS3D.MARKER_TRIANGLE_LIST:var ha=new ROS3D.TriangleList({material:e,vertices:c.points,colors:c.colors});ha.scale.set(c.scale.x,c.scale.y,c.scale.z),this.add(ha);break;default:console.error("Currently unsupported marker type: "+c.type)}},ROS3D.Marker.prototype.__proto__=THREE.Object3D.prototype,ROS3D.Marker.prototype.setPose=function(a){this.position.x=a.position.x,this.position.y=a.position.y,this.position.z=a.position.z,this.quaternion.set(a.orientation.x,a.orientation.y,a.orientation.z,a.orientation.w),this.quaternion.normalize(),this.updateMatrixWorld()},ROS3D.Marker.prototype.update=function(a){if(this.setPose(a.pose),a.color.r!==this.msgColor.r||a.color.g!==this.msgColor.g||a.color.b!==this.msgColor.b||a.color.a!==this.msgColor.a){var b=ROS3D.makeColorMaterial(a.color.r,a.color.g,a.color.b,a.color.a);switch(a.type){case ROS3D.MARKER_LINE_STRIP:case ROS3D.MARKER_LINE_LIST:case ROS3D.MARKER_POINTS:break;case ROS3D.MARKER_ARROW:case ROS3D.MARKER_CUBE:case ROS3D.MARKER_SPHERE:case ROS3D.MARKER_CYLINDER:case ROS3D.MARKER_TRIANGLE_LIST:case ROS3D.MARKER_TEXT_VIEW_FACING:this.traverse(function(a){a instanceof THREE.Mesh&&(a.material=b)});break;case ROS3D.MARKER_MESH_RESOURCE:var c=null;(0!==a.color.r||0!==a.color.g||0!==a.color.b||0!==a.color.a)&&(c=this.colorMaterial),this.traverse(function(a){a instanceof THREE.Mesh&&(a.material=c)});break;case ROS3D.MARKER_CUBE_LIST:case ROS3D.MARKER_SPHERE_LIST:return!1;default:return!1}this.msgColor=a.color}var d=Math.abs(this.msgScale[0]-a.scale.x)>1e-6||Math.abs(this.msgScale[1]-a.scale.y)>1e-6||Math.abs(this.msgScale[2]-a.scale.z)>1e-6;switch(this.msgScale=[a.scale.x,a.scale.y,a.scale.z],a.type){case ROS3D.MARKER_CUBE:case ROS3D.MARKER_SPHERE:case ROS3D.MARKER_CYLINDER:if(d)return!1;break;case ROS3D.MARKER_TEXT_VIEW_FACING:if(d||this.text!==a.text)return!1;break;case ROS3D.MARKER_MESH_RESOURCE:var e=a.mesh_resource.substr(10);if(e!==this.msgMesh)return!1;if(d)return!1;break;case ROS3D.MARKER_ARROW:case ROS3D.MARKER_LINE_STRIP:case ROS3D.MARKER_LINE_LIST:case ROS3D.MARKER_CUBE_LIST:case ROS3D.MARKER_SPHERE_LIST:case ROS3D.MARKER_POINTS:case ROS3D.MARKER_TRIANGLE_LIST:return!1}return!0},ROS3D.Marker.prototype.dispose=function(){this.children.forEach(function(a){a instanceof ROS3D.MeshResource?a.children.forEach(function(b){void 0!==b.material&&b.material.dispose(),b.children.forEach(function(a){void 0!==a.geometry&&a.geometry.dispose(),void 0!==a.material&&a.material.dispose(),b.remove(a)}),a.remove(b)}):(void 0!==a.geometry&&a.geometry.dispose(),void 0!==a.material&&a.material.dispose()),a.parent.remove(a)})},ROS3D.MarkerArrayClient=function(a){var b=this;a=a||{};var c=a.ros,d=a.topic;this.tfClient=a.tfClient,this.rootObject=a.rootObject||new THREE.Object3D,this.path=a.path||"/",this.loader=a.loader||ROS3D.COLLADA_LOADER_2,this.markers={};var e=new ROSLIB.Topic({ros:c,name:d,messageType:"visualization_msgs/MarkerArray",compression:"png",queue_length:2});e.subscribe(function(a){a.markers.forEach(function(a){if(0===a.action){var c=!1;if(a.ns+a.id in b.markers&&(c=b.markers[a.ns+a.id].children[0].update(a),c||(b.markers[a.ns+a.id].unsubscribeTf(),b.rootObject.remove(b.markers[a.ns+a.id]))),!c){var d=new ROS3D.Marker({message:a,path:b.path,loader:b.loader});b.markers[a.ns+a.id]=new ROS3D.SceneNode({frameID:a.header.frame_id.replace(/^\//,""),tfClient:b.tfClient,object:d}),b.rootObject.add(b.markers[a.ns+a.id])}}else if(1===a.action)console.warn('Received marker message with deprecated action identifier "1"');else if(2===a.action)a.ns+a.id in b.markers&&(b.markers[a.ns+a.id].unsubscribeTf(),b.rootObject.remove(b.markers[a.ns+a.id]),delete b.markers[a.ns+a.id]);else if(3===a.action){for(var e in b.markers)e.unsubscribeTf(),b.rootObject.remove(e);b.markers={}}else console.warn('Received marker message with unknown action identifier "'+a.action+'"')}),b.emit("change")}),this.removeArray=function(){e.unsubscribe();for(var a in b.markers)b.markers.hasOwnProperty(a)&&(b.rootObject.remove(b.markers[a]),b.markers[a].unsubscribeTf())}},ROS3D.MarkerArrayClient.prototype.__proto__=EventEmitter2.prototype,ROS3D.MarkerClient=function(a){var b=this;a=a||{};var c=a.ros,d=a.topic;this.tfClient=a.tfClient,this.rootObject=a.rootObject||new THREE.Object3D,this.path=a.path||"/",this.loader=a.loader||ROS3D.COLLADA_LOADER_2,this.markers={};var e=new ROSLIB.Topic({ros:c,name:d,messageType:"visualization_msgs/Marker",compression:"png"});e.subscribe(function(a){var c=new ROS3D.Marker({message:a,path:b.path,loader:b.loader}),d=b.markers[a.ns+a.id];d&&(d.unsubscribeTf(),b.rootObject.remove(d)),b.markers[a.ns+a.id]=new ROS3D.SceneNode({frameID:a.header.frame_id.replace(/^\//,""),tfClient:b.tfClient,object:c}),b.rootObject.add(b.markers[a.ns+a.id]),b.emit("change")})},ROS3D.MarkerClient.prototype.__proto__=EventEmitter2.prototype,ROS3D.Arrow=function(a){a=a||{};var b=a.origin||new THREE.Vector3(0,0,0),c=a.direction||new THREE.Vector3(1,0,0),d=a.length||1,e=a.headLength||.2,f=a.shaftDiameter||.05,g=a.headDiameter||.1,h=a.material||new THREE.MeshBasicMaterial,i=d-e,j=new THREE.CylinderGeometry(.5*f,.5*f,i,12,1),k=new THREE.Matrix4;k.setPosition(new THREE.Vector3(0,.5*i,0)),j.applyMatrix(k);var l=new THREE.CylinderGeometry(0,.5*g,e,12,1);k.setPosition(new THREE.Vector3(0,i+.5*e,0)),l.applyMatrix(k),j.merge(l),THREE.Mesh.call(this,j,h),this.position.copy(b),this.setDirection(c)},ROS3D.Arrow.prototype.__proto__=THREE.Mesh.prototype,ROS3D.Arrow.prototype.setDirection=function(a){var b=new THREE.Vector3(0,1,0).cross(a),c=Math.acos(new THREE.Vector3(0,1,0).dot(a.clone().normalize()));this.matrix=(new THREE.Matrix4).makeRotationAxis(b.normalize(),c),this.rotation.setFromRotationMatrix(this.matrix,this.rotation.order)},ROS3D.Arrow.prototype.setLength=function(a){this.scale.set(a,a,a)},ROS3D.Arrow.prototype.setColor=function(a){this.material.color.setHex(a)},ROS3D.Axes=function(a){function b(a){var b=new THREE.Color;b.setRGB(a.x,a.y,a.z);var d=new THREE.MeshBasicMaterial({color:b.getHex()}),e=new THREE.Vector3;e.crossVectors(a,new THREE.Vector3(0,-1,0));var f=new THREE.Quaternion;f.setFromAxisAngle(e,.5*Math.PI);var g=new THREE.Mesh(c.headGeom,d);g.position.copy(a),g.position.multiplyScalar(.95),g.quaternion.copy(f),g.updateMatrix(),c.add(g);var h=new THREE.Mesh(c.lineGeom,d);h.position.copy(a),h.position.multiplyScalar(.45),h.quaternion.copy(f),h.updateMatrix(),c.add(h)}var c=this;a=a||{};var d=a.shaftRadius||.008,e=a.headRadius||.023,f=a.headLength||.1,g=a.scale||1;THREE.Object3D.call(this),this.scale.set(g,g,g),this.lineGeom=new THREE.CylinderGeometry(d,d,1-f),this.headGeom=new THREE.CylinderGeometry(0,e,f),b(new THREE.Vector3(1,0,0)),b(new THREE.Vector3(0,1,0)),b(new THREE.Vector3(0,0,1))},ROS3D.Axes.prototype.__proto__=THREE.Object3D.prototype,ROS3D.Grid=function(a){a=a||{};var b=a.num_cells||10,c=a.color||"#cccccc",d=a.lineWidth||1,e=a.cellSize||1;THREE.Object3D.call(this);for(var f=new THREE.LineBasicMaterial({color:c,linewidth:d}),g=0;b>=g;++g){var h=e*b/2,i=h-g*e,j=new THREE.Geometry;j.vertices.push(new THREE.Vector3(-h,i,0),new THREE.Vector3(h,i,0));var k=new THREE.Geometry;k.vertices.push(new THREE.Vector3(i,-h,0),new THREE.Vector3(i,h,0)),this.add(new THREE.Line(j,f)),this.add(new THREE.Line(k,f))}},ROS3D.Grid.prototype.__proto__=THREE.Object3D.prototype,ROS3D.MeshResource=function(a){var b=this;a=a||{};var c=a.path||"/",d=a.resource,e=a.material||null;this.warnings=a.warnings;var f=a.loader||ROS3D.COLLADA_LOADER_2;THREE.Object3D.call(this),"/"!==c.substr(c.length-1)&&(this.path+="/");var g,h=c+d,i=h.substr(-4).toLowerCase();".dae"===i?(g=f===ROS3D.COLLADA_LOADER?new THREE.ColladaLoader:new ColladaLoader2,g.log=function(a){b.warnings&&console.warn(a)},g.load(h,function(a){if(f===ROS3D.COLLADA_LOADER_2&&a.dae.asset.unit){var c=a.dae.asset.unit;a.scene.scale.set(c,c,c)}if(null!==e){var d=function(a,b){if(a.material=b,a.children)for(var c=0;c<a.children.length;c++)d(a.children[c],b)};d(a.scene,e)}b.add(a.scene)})):".stl"===i&&(g=new THREE.STLLoader,g.load(h,function(a){a.computeFaceNormals();var c;c=null!==e?new THREE.Mesh(a,e):new THREE.Mesh(a,new THREE.MeshBasicMaterial({color:10066329})),b.add(c)}))},ROS3D.MeshResource.prototype.__proto__=THREE.Object3D.prototype,ROS3D.TriangleList=function(a){a=a||{};var b=a.material||new THREE.MeshBasicMaterial,c=a.vertices,d=a.colors;THREE.Object3D.call(this),b.side=THREE.DoubleSide;var e=new THREE.Geometry;for(f=0;f<c.length;f++)e.vertices.push(new THREE.Vector3(c[f].x,c[f].y,c[f].z));var f,g;if(d.length===c.length){for(f=0;f<c.length;f+=3){var h=new THREE.Face3(f,f+1,f+2);for(g=3*f;3*f+3>g;f++){var i=new THREE.Color;i.setRGB(d[f].r,d[f].g,d[f].b),h.vertexColors.push(i)}e.faces.push(k)}b.vertexColors=THREE.VertexColors}else if(d.length===c.length/3){for(f=0;f<c.length;f+=3){var j=new THREE.Face3(f,f+1,f+2);j.color.setRGB(d[f/3].r,d[f/3].g,d[f/3].b),e.faces.push(j)}b.vertexColors=THREE.FaceColors}else for(f=0;f<c.length;f+=3){var k=new THREE.Face3(f,f+1,f+2);e.faces.push(k)}e.computeBoundingBox(),e.computeBoundingSphere(),e.computeFaceNormals(),this.add(new THREE.Mesh(e,b))},ROS3D.TriangleList.prototype.__proto__=THREE.Object3D.prototype,ROS3D.TriangleList.prototype.setColor=function(a){this.mesh.material.color.setHex(a)},ROS3D.OccupancyGrid=function(a){a=a||{};var b=a.message,c=a.color||{r:255,g:255,b:255},d=a.opacity||1,e=b.info.width,f=b.info.height,g=new THREE.PlaneGeometry(e,f),h=document.createElement("canvas");h.width=e,h.height=f;for(var i=h.getContext("2d"),j=i.createImageData(e,f),k=0;f>k;k++)for(var l=0;e>l;l++){var m,n=l+(f-k-1)*e,o=b.data[n];m=100===o?0:0===o?255:127;var p=4*(l+k*e);j.data[p]=m*c.r/255,j.data[++p]=m*c.g/255,j.data[++p]=m*c.b/255,j.data[++p]=255}i.putImageData(j,0,0);var q=new THREE.Texture(h);q.needsUpdate=!0;var r=new THREE.MeshBasicMaterial({map:q,transparent:1>d,opacity:d});r.side=THREE.DoubleSide,THREE.Mesh.call(this,g,r),this.quaternion=b.info.origin.orientation,this.position.x=e*b.info.resolution/2+b.info.origin.position.x,this.position.y=f*b.info.resolution/2+b.info.origin.position.y,this.position.z=b.info.origin.position.z,this.scale.x=b.info.resolution,this.scale.y=b.info.resolution},ROS3D.OccupancyGrid.prototype.__proto__=THREE.Mesh.prototype,ROS3D.OccupancyGridClient=function(a){var b=this;a=a||{};var c=a.ros,d=a.topic||"/map";this.continuous=a.continuous,this.tfClient=a.tfClient,this.rootObject=a.rootObject||new THREE.Object3D,this.offsetPose=a.offsetPose||new ROSLIB.Pose,this.color=a.color||{r:255,g:255,b:255},this.opacity=a.opacity||1,this.currentGrid=null;var e=new ROSLIB.Topic({ros:c,name:d,messageType:"nav_msgs/OccupancyGrid",compression:"png"});e.subscribe(function(a){b.currentGrid&&(b.currentGrid.tfClient&&b.currentGrid.unsubscribeTf(),b.rootObject.remove(b.currentGrid));var c=new ROS3D.OccupancyGrid({message:a,color:b.color,opacity:b.opacity});b.tfClient?b.currentGrid=new ROS3D.SceneNode({frameID:a.header.frame_id,tfClient:b.tfClient,object:c,pose:b.offsetPose}):b.currentGrid=c,b.rootObject.add(b.currentGrid),b.emit("change"),b.continuous||e.unsubscribe()})},ROS3D.OccupancyGridClient.prototype.__proto__=EventEmitter2.prototype,ROS3D.Odometry=function(a){this.options=a||{};var b=a.ros,c=a.topic||"/particlecloud";this.tfClient=a.tfClient,this.color=a.color||13369599,this.length=a.length||1,this.rootObject=a.rootObject||new THREE.Object3D,this.keep=a.keep||1;var d=this;THREE.Object3D.call(this),this.sns=[];var e=new ROSLIB.Topic({ros:b,name:c,messageType:"nav_msgs/Odometry"});e.subscribe(function(a){d.sns.length>=d.keep&&(d.sns[0].unsubscribeTf(),d.rootObject.remove(d.sns[0]),d.sns.shift()),d.options.origin=new THREE.Vector3(a.pose.pose.position.x,a.pose.pose.position.y,a.pose.pose.position.z);var b=new THREE.Quaternion(a.pose.pose.orientation.x,a.pose.pose.orientation.y,a.pose.pose.orientation.z,a.pose.pose.orientation.w);d.options.direction=new THREE.Vector3(1,0,0),d.options.direction.applyQuaternion(b),d.options.material=new THREE.MeshBasicMaterial({color:d.color});var c=new ROS3D.Arrow(d.options);d.sns.push(new ROS3D.SceneNode({frameID:a.header.frame_id,tfClient:d.tfClient,object:c})),d.rootObject.add(d.sns[d.sns.length-1])})},ROS3D.Odometry.prototype.__proto__=THREE.Object3D.prototype,ROS3D.Path=function(a){a=a||{};var b=a.ros,c=a.topic||"/path";this.tfClient=a.tfClient,this.color=a.color||13369599,this.rootObject=a.rootObject||new THREE.Object3D;var d=this;THREE.Object3D.call(this),this.sn=null,this.line=null;var e=new ROSLIB.Topic({ros:b,name:c,messageType:"nav_msgs/Path"});e.subscribe(function(a){null!==d.sn&&(d.sn.unsubscribeTf(),d.rootObject.remove(d.sn));for(var b=new THREE.Geometry,c=0;c<a.poses.length;c++){var e=new THREE.Vector3(a.poses[c].pose.position.x,a.poses[c].pose.position.y,a.poses[c].pose.position.z);b.vertices.push(e)}b.computeLineDistances();var f=new THREE.LineBasicMaterial({color:d.color}),g=new THREE.Line(b,f);d.sn=new ROS3D.SceneNode({frameID:a.header.frame_id,tfClient:d.tfClient,object:g}),d.rootObject.add(d.sn)})},ROS3D.Path.prototype.__proto__=THREE.Object3D.prototype,ROS3D.Point=function(a){this.options=a||{};var b=a.ros,c=a.topic||"/point";this.tfClient=a.tfClient,this.color=a.color||13369599,this.rootObject=a.rootObject||new THREE.Object3D,this.radius=a.radius||.2;var d=this;THREE.Object3D.call(this),this.sn=null;var e=new ROSLIB.Topic({ros:b,name:c,messageType:"geometry_msgs/PointStamped"});e.subscribe(function(a){null!==d.sn&&(d.sn.unsubscribeTf(),d.rootObject.remove(d.sn));var b=new THREE.SphereGeometry(d.radius),c=new THREE.MeshBasicMaterial({color:d.color}),e=new THREE.Mesh(b,c);e.position.set(a.point.x,a.point.y,a.point.z),d.sn=new ROS3D.SceneNode({frameID:a.header.frame_id,tfClient:d.tfClient,object:e}),d.rootObject.add(d.sn)})},ROS3D.Point.prototype.__proto__=THREE.Object3D.prototype,ROS3D.Polygon=function(a){a=a||{};var b=a.ros,c=a.topic||"/path";this.tfClient=a.tfClient,this.color=a.color||13369599,this.rootObject=a.rootObject||new THREE.Object3D;var d=this;THREE.Object3D.call(this),this.sn=null,this.line=null;var e=new ROSLIB.Topic({ros:b,name:c,messageType:"geometry_msgs/PolygonStamped"});e.subscribe(function(a){null!==d.sn&&(d.sn.unsubscribeTf(),d.rootObject.remove(d.sn));for(var b,c=new THREE.Geometry,e=0;e<a.polygon.points.length;e++)b=new THREE.Vector3(a.polygon.points[e].x,a.polygon.points[e].y,a.polygon.points[e].z),c.vertices.push(b);b=new THREE.Vector3(a.polygon.points[0].x,a.polygon.points[0].y,a.polygon.points[0].z),c.vertices.push(b),c.computeLineDistances();var f=new THREE.LineBasicMaterial({color:d.color}),g=new THREE.Line(c,f);d.sn=new ROS3D.SceneNode({frameID:a.header.frame_id,tfClient:d.tfClient,object:g}),d.rootObject.add(d.sn)})},ROS3D.Polygon.prototype.__proto__=THREE.Object3D.prototype,ROS3D.Pose=function(a){this.options=a||{};var b=a.ros,c=a.topic||"/pose";this.tfClient=a.tfClient,this.color=a.color||13369599,this.rootObject=a.rootObject||new THREE.Object3D;var d=this;THREE.Object3D.call(this),this.sn=null;var e=new ROSLIB.Topic({ros:b,name:c,messageType:"geometry_msgs/PoseStamped"});e.subscribe(function(a){null!==d.sn&&(d.sn.unsubscribeTf(),d.rootObject.remove(d.sn)),d.options.origin=new THREE.Vector3(a.pose.position.x,a.pose.position.y,a.pose.position.z);var b=new THREE.Quaternion(a.pose.orientation.x,a.pose.orientation.y,a.pose.orientation.z,a.pose.orientation.w);d.options.direction=new THREE.Vector3(1,0,0),d.options.direction.applyQuaternion(b),d.options.material=new THREE.MeshBasicMaterial({color:d.color});var c=new ROS3D.Arrow(d.options);d.sn=new ROS3D.SceneNode({frameID:a.header.frame_id,tfClient:d.tfClient,object:c}),d.rootObject.add(d.sn)})},ROS3D.Pose.prototype.__proto__=THREE.Object3D.prototype,ROS3D.PoseArray=function(a){this.options=a||{};var b=a.ros,c=a.topic||"/particlecloud";this.tfClient=a.tfClient,this.color=a.color||13369599,this.length=a.length||1,this.rootObject=a.rootObject||new THREE.Object3D;var d=this;THREE.Object3D.call(this),this.sn=null;var e=new ROSLIB.Topic({ros:b,name:c,messageType:"geometry_msgs/PoseArray"});e.subscribe(function(a){null!==d.sn&&(d.sn.unsubscribeTf(),d.rootObject.remove(d.sn));for(var b,c=new THREE.Object3D,e=0;e<a.poses.length;e++){var f=new THREE.Geometry,g=new THREE.Vector3(a.poses[e].position.x,a.poses[e].position.y,a.poses[e].position.z);f.vertices.push(g);var h=new THREE.Quaternion(a.poses[e].orientation.x,a.poses[e].orientation.y,a.poses[e].orientation.z,a.poses[e].orientation.w),i=new THREE.Vector3(d.length,0,0),j=new THREE.Vector3(.8*d.length,.2*d.length,0),k=new THREE.Vector3(.8*d.length,.2*-d.length,0);i.applyQuaternion(h),j.applyQuaternion(h),k.applyQuaternion(h),f.vertices.push(i.add(g)),f.vertices.push(j.add(g)),f.vertices.push(k.add(g)),f.vertices.push(i),f.computeLineDistances();var l=new THREE.LineBasicMaterial({color:d.color});b=new THREE.Line(f,l),c.add(b)}d.sn=new ROS3D.SceneNode({frameID:a.header.frame_id,tfClient:d.tfClient,object:c}),d.rootObject.add(d.sn)})},ROS3D.PoseArray.prototype.__proto__=THREE.Object3D.prototype,ROS3D.LaserScan=function(a){a=a||{};var b=a.ros,c=a.topic||"/scan";this.color=a.color||16753920;var d=this;this.particles=new ROS3D.Particles(a);var e=new ROSLIB.Topic({ros:b,name:c,messageType:"sensor_msgs/LaserScan"});e.subscribe(function(a){setFrame(d.particles,a.header.frame_id);for(var b=a.ranges.length,c=0;b>c;c++){var e=a.ranges[c];if(e<a.range_min||e>a.range_max)d.particles.alpha[c]=0;else{var f=a.angle_min+c*a.angle_increment;d.particles.points[c]=new THREE.Vector3(e*Math.cos(f),e*Math.sin(f),0),d.particles.alpha[c]=1}d.particles.colors[c]=new THREE.Color(d.color)}finishedUpdate(d.particles,b)})},ROS3D.LaserScan.prototype.__proto__=THREE.Object3D.prototype,ROS3D.Particles=function(a){a=a||{},this.tfClient=a.tfClient;var b=a.texture||"https://upload.wikimedia.org/wikipedia/commons/a/a2/Pixel-white.png",c=a.size||.05;this.max_pts=a.max_pts||1e4,this.first_size=null,this.prev_pts=0,this.rootObject=a.rootObject||new THREE.Object3D;THREE.Object3D.call(this),this.vertex_shader=["attribute vec3 customColor;","attribute float alpha;","varying vec3 vColor;","varying float falpha;","void main() ","{","    vColor = customColor; // set color associated to vertex; use later in fragment shader","    vec4 mvPosition = modelViewMatrix * vec4( position, 1.0 );","    falpha = alpha; ","","    // option (1): draw particles at constant size on screen","    // gl_PointSize = size;","    // option (2): scale particles as objects in 3D space","    gl_PointSize = ",c,"* ( 300.0 / length( mvPosition.xyz ) );","    gl_Position = projectionMatrix * mvPosition;","}"].join("\n"),this.fragment_shader=["uniform sampler2D texture;","varying vec3 vColor; // colors associated to vertices; assigned by vertex shader","varying float falpha;","void main() ","{","    // calculates a color for the particle","    gl_FragColor = vec4( vColor, falpha );","    // sets particle texture to desired color","    gl_FragColor = gl_FragColor * texture2D( texture, gl_PointCoord );","}"].join("\n"),this.geom=new THREE.Geometry;for(var d=0;d<this.max_pts;d++)this.geom.vertices.push(new THREE.Vector3);var e={texture:{type:"t",value:THREE.ImageUtils.loadTexture(b)}};this.attribs={customColor:{type:"c",value:[]},alpha:{type:"f",value:[]}},this.shaderMaterial=new THREE.ShaderMaterial({uniforms:e,attributes:this.attribs,vertexShader:this.vertex_shader,fragmentShader:this.fragment_shader,transparent:!0,alphaTest:.5}),this.ps=new THREE.PointCloud(this.geom,this.shaderMaterial),this.sn=null,this.points=this.geom.vertices,this.colors=this.attribs.customColor.value,this.alpha=this.attribs.alpha.value};var BASE64="ABCDEFGHIJKLMNOPQRSTUVWXYZabcdefghijklmnopqrstuvwxyz0123456789+/=";ROS3D.PointCloud2=function(a){a=a||{};var b=a.ros,c=a.topic||"/points",d=this;this.particles=new ROS3D.Particles(a);var e=new ROSLIB.Topic({ros:b,name:c,messageType:"sensor_msgs/PointCloud2"});e.subscribe(function(a){setFrame(d.particles,a.header.frame_id);var b,c=a.height*a.width;b=a.data.buffer?a.data.buffer.buffer:Uint8Array.from(decode64(a.data)).buffer;for(var e=new DataView(b),f=0;c>f;f++){var g=read_point(a,f,e);d.particles.points[f]=new THREE.Vector3(g.x,g.y,g.z),d.particles.colors[f]=new THREE.Color(g.rgb),d.particles.alpha[f]=1}finishedUpdate(d.particles,c)})},ROS3D.PointCloud2.prototype.__proto__=THREE.Object3D.prototype,ROS3D.Urdf=function(a){a=a||{};var b=a.urdfModel,c=a.path||"/",d=a.tfClient,e=a.tfPrefix||"",f=a.loader||ROS3D.COLLADA_LOADER_2;THREE.Object3D.call(this);var g=b.links;for(var h in g)for(var i=g[h],j=0;j<i.visuals.length;j++){var k=i.visuals[j];if(k&&k.geometry){var l=e+"/"+i.name,m=null;if(k.material&&k.material.color){var n=k.material&&k.material.color;m=ROS3D.makeColorMaterial(n.r,n.g,n.b,n.a)}if(k.geometry.type===ROSLIB.URDF_MESH){var o=k.geometry.filename,p=o.indexOf("package://");-1!==p&&(o=o.substr(p+"package://".length));var q=o.substr(-4).toLowerCase();if(".dae"===q||".stl"===q){var r=new ROS3D.MeshResource({path:c,resource:o,loader:f,material:m});i.visuals[j].geometry.scale&&r.scale.set(k.geometry.scale.x,k.geometry.scale.y,k.geometry.scale.z);var s=new ROS3D.SceneNode({frameID:l,pose:k.origin,tfClient:d,object:r});this.add(s)}else console.warn("Could not load geometry mesh: "+o)}else{m||(m=ROS3D.makeColorMaterial(0,0,0,1));var t;switch(k.geometry.type){case ROSLIB.URDF_BOX:var u=k.geometry.dimension,v=new THREE.BoxGeometry(u.x,u.y,u.z);t=new THREE.Mesh(v,m);break;case ROSLIB.URDF_CYLINDER:var w=k.geometry.radius,x=k.geometry.length,y=new THREE.CylinderGeometry(w,w,x,16,1,!1);t=new THREE.Mesh(y,m),t.quaternion.setFromAxisAngle(new THREE.Vector3(1,0,0),.5*Math.PI);break;case ROSLIB.URDF_SPHERE:var z=new THREE.SphereGeometry(k.geometry.radius,16);t=new THREE.Mesh(z,m)}var A=new ROS3D.SceneNode({frameID:l,pose:k.origin,tfClient:d,object:t});this.add(A)}}}},ROS3D.Urdf.prototype.__proto__=THREE.Object3D.prototype,ROS3D.UrdfClient=function(a){var b=this;a=a||{};var c=a.ros,d=a.param||"robot_description";this.path=a.path||"/",this.tfClient=a.tfClient,this.rootObject=a.rootObject||new THREE.Object3D;var e=a.tfPrefix||"",f=a.loader||ROS3D.COLLADA_LOADER_2,g=new ROSLIB.Param({ros:c,name:d});g.get(function(a){var c=new ROSLIB.UrdfModel({string:a});b.rootObject.add(new ROS3D.Urdf({urdfModel:c,path:b.path,tfClient:b.tfClient,tfPrefix:e,loader:f}))})},ROS3D.SceneNode=function(a){a=a||{};var b=this;this.tfClient=a.tfClient||null,this.frameID=a.frameID;var c=a.object;this.pose=a.pose||new ROSLIB.Pose,THREE.Object3D.call(this),this.visible=!1,c&&this.add(c),this.updatePose(this.pose),this.tfUpdate=function(a){var c=new ROSLIB.Transform(a),d=new ROSLIB.Pose(b.pose);d.applyTransform(c),b.updatePose(d),b.visible=!0},this.tfClient&&this.tfClient.subscribe(this.frameID,this.tfUpdate)},ROS3D.SceneNode.prototype.__proto__=THREE.Object3D.prototype,ROS3D.SceneNode.prototype.updatePose=function(a){
-this.position.set(a.position.x,a.position.y,a.position.z),this.quaternion.set(a.orientation.x,a.orientation.y,a.orientation.z,a.orientation.w),this.updateMatrixWorld(!0)},ROS3D.SceneNode.prototype.unsubscribeTf=function(){this.tfClient&&this.tfClient.unsubscribe(this.frameID,this.tfUpdate)},ROS3D.SceneNode.prototype.transformPose=function(a){var b=new ROSLIB.Transform(a),c=new ROSLIB.Pose(this.pose);c.applyTransform(b),this.updatePose(c)},ROS3D.Viewer=function(a){function b(){c.cameraControls.update(),c.directionalLight.position.copy(c.camera.localToWorld(new THREE.Vector3(-1,1,0))),c.directionalLight.position.normalize(),c.renderer.clear(!0,!0,!0),c.renderer.render(c.scene,c.camera),requestAnimationFrame(b)}var c=this;a=a||{};var d=a.divID,e=a.width,f=a.height,g=a.background||"#111111",h=a.antialias,i=a.intensity||.66,j=a.near||.01,k=a.far||1e3,l=a.cameraPose||{x:3,y:3,z:3},m=a.cameraZoomSpeed||2.5;this.renderer=new THREE.WebGLRenderer({antialias:h}),this.renderer.setClearColor(parseInt(g.replace("#","0x"),16),1),this.renderer.sortObjects=!1,this.renderer.setSize(e,f),this.renderer.shadowMapEnabled=!1,this.renderer.autoClear=!1,this.scene=new THREE.Scene,this.camera=new THREE.PerspectiveCamera(40,e/f,j,k),this.camera.position.set(l.x,l.y,l.z),this.cameraControls=new ROS3D.OrbitControls({scene:this.scene,camera:this.camera}),this.cameraControls.userZoomSpeed=m,this.scene.add(new THREE.AmbientLight(5592405)),this.directionalLight=new THREE.DirectionalLight(16777215,i),this.scene.add(this.directionalLight),this.selectableObjects=new THREE.Object3D,this.scene.add(this.selectableObjects);var n=new ROS3D.MouseHandler({renderer:this.renderer,camera:this.camera,rootObject:this.selectableObjects,fallbackTarget:this.cameraControls});this.highlighter=new ROS3D.Highlighter({mouseHandler:n}),document.getElementById(d).appendChild(this.renderer.domElement),b()},ROS3D.Viewer.prototype.addObject=function(a,b){b?this.selectableObjects.add(a):this.scene.add(a)},ROS3D.Viewer.prototype.resize=function(a,b){this.camera.aspect=a/b,this.camera.updateProjectionMatrix(),this.renderer.setSize(a,b)},ROS3D.Highlighter=function(a){a=a||{};var b=a.mouseHandler;this.hoverObjs=[],b.addEventListener("mouseover",this.onMouseOver.bind(this)),b.addEventListener("mouseout",this.onMouseOut.bind(this))},ROS3D.Highlighter.prototype.onMouseOver=function(a){this.hoverObjs.push(a.currentTarget)},ROS3D.Highlighter.prototype.onMouseOut=function(a){this.hoverObjs.splice(this.hoverObjs.indexOf(a.currentTarget),1)},ROS3D.Highlighter.prototype.getWebglObjects=function(a,b,c){for(var d=a.__webglObjects,e=0;e<b.length;e++)if(b[e]){for(var f=d.length-1;f>=0;f--)if(d[f].object===b[e]){c.push(d[f]);break}this.getWebglObjects(a,b[e].children,c)}},ROS3D.Highlighter.prototype.renderHighlight=function(a,b,c){var d=[];if(this.getWebglObjects(b,this.hoverObjs,d),0!==d.length){b.overrideMaterial=new THREE.MeshBasicMaterial({fog:!1,opacity:.5,depthTest:!0,depthWrite:!1,polygonOffset:!0,polygonOffsetUnits:-1,side:THREE.DoubleSide});var e=b.__webglObjects;b.__webglObjects=d,a.render(b,c),b.__webglObjects=e,b.overrideMaterial=null}},ROS3D.MouseHandler=function(a){THREE.EventDispatcher.call(this),this.renderer=a.renderer,this.camera=a.camera,this.rootObject=a.rootObject,this.fallbackTarget=a.fallbackTarget,this.lastTarget=this.fallbackTarget,this.dragging=!1;var b=["contextmenu","click","dblclick","mouseout","mousedown","mouseup","mousemove","mousewheel","DOMMouseScroll","touchstart","touchend","touchcancel","touchleave","touchmove"];this.listeners={},b.forEach(function(a){this.listeners[a]=this.processDomEvent.bind(this),this.renderer.domElement.addEventListener(a,this.listeners[a],!1)},this)},ROS3D.MouseHandler.prototype.processDomEvent=function(a){a.preventDefault();var b,c,d=a.target,e=d.getBoundingClientRect();if(-1!==a.type.indexOf("touch")){b=0,c=0;for(var f=0;f<a.touches.length;++f)b+=a.touches[f].clientX,c+=a.touches[f].clientY;b/=a.touches.length,c/=a.touches.length}else b=a.clientX,c=a.clientY;var g=b-e.left-d.clientLeft+d.scrollLeft,h=c-e.top-d.clientTop+d.scrollTop,i=g/d.clientWidth*2-1,j=-h/d.clientHeight*2+1,k=new THREE.Vector3(i,j,.5);k.unproject(this.camera);var l=new THREE.Raycaster(this.camera.position.clone(),k.sub(this.camera.position).normalize());l.linePrecision=.001;var m=l.ray,n={mousePos:new THREE.Vector2(i,j),mouseRay:m,domEvent:a,camera:this.camera,intersection:this.lastIntersection};if("mouseout"===a.type)return this.dragging&&(this.notify(this.lastTarget,"mouseup",n),this.dragging=!1),this.notify(this.lastTarget,"mouseout",n),void(this.lastTarget=null);if("touchleave"===a.type||"touchend"===a.type)return this.dragging&&(this.notify(this.lastTarget,"mouseup",n),this.dragging=!1),this.notify(this.lastTarget,"touchend",n),void(this.lastTarget=null);if(this.dragging)return this.notify(this.lastTarget,a.type,n),void(("mouseup"===a.type&&2===a.button||"click"===a.type||"touchend"===a.type)&&(this.dragging=!1));d=this.lastTarget;var o=[];if(o=l.intersectObject(this.rootObject,!0),o.length>0?(d=o[0].object,n.intersection=this.lastIntersection=o[0]):d=this.fallbackTarget,d!==this.lastTarget&&a.type.match(/mouse/)){var p=this.notify(d,"mouseover",n);p?this.notify(this.lastTarget,"mouseout",n):(d=this.fallbackTarget,d!==this.lastTarget&&(this.notify(d,"mouseover",n),this.notify(this.lastTarget,"mouseout",n)))}if(d!==this.lastTarget&&a.type.match(/touch/)){var q=this.notify(d,a.type,n);q?(this.notify(this.lastTarget,"touchleave",n),this.notify(this.lastTarget,"touchend",n)):(d=this.fallbackTarget,d!==this.lastTarget&&(this.notify(this.lastTarget,"touchmove",n),this.notify(this.lastTarget,"touchend",n)))}this.notify(d,a.type,n),("mousedown"===a.type||"touchstart"===a.type||"touchmove"===a.type)&&(this.dragging=!0),this.lastTarget=d},ROS3D.MouseHandler.prototype.notify=function(a,b,c){for(c.type=b,c.cancelBubble=!1,c.stopPropagation=function(){c.cancelBubble=!0},c.currentTarget=a;c.currentTarget;){if(c.currentTarget.dispatchEvent&&c.currentTarget.dispatchEvent instanceof Function&&(c.currentTarget.dispatchEvent(c),c.cancelBubble))return this.dispatchEvent(c),!0;c.currentTarget=c.currentTarget.parent}return!1},THREE.EventDispatcher.prototype.apply(ROS3D.MouseHandler.prototype),ROS3D.OrbitControls=function(a){function b(a){var b=a.domEvent;switch(b.preventDefault(),b.button){case 0:A=z.ROTATE,n.set(b.clientX,b.clientY);break;case 1:A=z.MOVE,u=new THREE.Vector3(0,0,1);var c=(new THREE.Matrix4).extractRotation(this.camera.matrix);u.applyMatrix4(c),t=j.center.clone(),v=j.camera.position.clone(),w=d(a.mouseRay,t,u),this.showAxes();break;case 2:A=z.ZOOM,q.set(b.clientX,b.clientY),this.showAxes()}}function c(a){var b=a.domEvent;if(A===z.ROTATE)o.set(b.clientX,b.clientY),p.subVectors(o,n),j.rotateLeft(2*Math.PI*p.x/l*j.userRotateSpeed),j.rotateUp(2*Math.PI*p.y/l*j.userRotateSpeed),n.copy(o);else if(A===z.ZOOM)r.set(b.clientX,b.clientY),s.subVectors(r,q),s.y>0?j.zoomIn():j.zoomOut(),q.copy(r),this.showAxes();else if(A===z.MOVE){var c=d(a.mouseRay,j.center,u);if(!c)return;var e=(new THREE.Vector3).subVectors(w.clone(),c.clone());j.center.addVectors(t.clone(),e.clone()),j.camera.position.addVectors(v.clone(),e.clone()),j.update(),j.camera.updateMatrixWorld(),this.showAxes()}}function d(a,b,c){var d=new THREE.Vector3,e=new THREE.Vector3;d.subVectors(b,a.origin);var f=a.direction.dot(c);if(Math.abs(f)<a.precision)return null;var g=c.dot(d)/f;return e=a.direction.clone().multiplyScalar(g)}function e(a){j.userRotate&&(A=z.NONE)}function f(a){if(j.userZoom){var b,c=a.domEvent;b="undefined"!=typeof c.wheelDelta?c.wheelDelta:-c.detail,b>0?j.zoomOut():j.zoomIn(),this.showAxes()}}function g(a){var b=a.domEvent;switch(b.touches.length){case 1:A=z.ROTATE,n.set(b.touches[0].pageX-window.scrollX,b.touches[0].pageY-window.scrollY);break;case 2:A=z.NONE,u=new THREE.Vector3(0,0,1);var c=(new THREE.Matrix4).extractRotation(this.camera.matrix);u.applyMatrix4(c),t=j.center.clone(),v=j.camera.position.clone(),w=d(a.mouseRay,t,u),x[0]=new THREE.Vector2(b.touches[0].pageX,b.touches[0].pageY),x[1]=new THREE.Vector2(b.touches[1].pageX,b.touches[1].pageY),y[0]=new THREE.Vector2(0,0),y[1]=new THREE.Vector2(0,0)}this.showAxes(),b.preventDefault()}function h(a){var b=a.domEvent;if(A===z.ROTATE)o.set(b.touches[0].pageX-window.scrollX,b.touches[0].pageY-window.scrollY),p.subVectors(o,n),j.rotateLeft(2*Math.PI*p.x/l*j.userRotateSpeed),j.rotateUp(2*Math.PI*p.y/l*j.userRotateSpeed),n.copy(o),this.showAxes();else{if(y[0].set(x[0].x-b.touches[0].pageX,x[0].y-b.touches[0].pageY),y[1].set(x[1].x-b.touches[1].pageX,x[1].y-b.touches[1].pageY),y[0].lengthSq()>m&&y[1].lengthSq()>m&&(x[0].set(b.touches[0].pageX,b.touches[0].pageY),x[1].set(b.touches[1].pageX,b.touches[1].pageY),y[0].dot(y[1])>0&&A!==z.ZOOM?A=z.MOVE:y[0].dot(y[1])<0&&A!==z.MOVE&&(A=z.ZOOM),A===z.ZOOM)){var c=new THREE.Vector2;c.subVectors(x[0],x[1]),y[0].dot(c)<0&&y[1].dot(c)>0?j.zoomOut():y[0].dot(c)>0&&y[1].dot(c)<0&&j.zoomIn()}if(A===z.MOVE){var e=d(a.mouseRay,j.center,u);if(!e)return;var f=(new THREE.Vector3).subVectors(w.clone(),e.clone());j.center.addVectors(t.clone(),f.clone()),j.camera.position.addVectors(v.clone(),f.clone()),j.update(),j.camera.updateMatrixWorld()}this.showAxes(),b.preventDefault()}}function i(a){var b=a.domEvent;1===b.touches.length&&A!==z.ROTATE?(A=z.ROTATE,n.set(b.touches[0].pageX-window.scrollX,b.touches[0].pageY-window.scrollY)):A=z.NONE}THREE.EventDispatcher.call(this);var j=this;a=a||{};var k=a.scene;this.camera=a.camera,this.center=new THREE.Vector3,this.userZoom=!0,this.userZoomSpeed=a.userZoomSpeed||1,this.userRotate=!0,this.userRotateSpeed=a.userRotateSpeed||1,this.autoRotate=a.autoRotate,this.autoRotateSpeed=a.autoRotateSpeed||2,this.camera.up=new THREE.Vector3(0,0,1);var l=1800,m=10,n=new THREE.Vector2,o=new THREE.Vector2,p=new THREE.Vector2,q=new THREE.Vector2,r=new THREE.Vector2,s=new THREE.Vector2,t=new THREE.Vector3,u=new THREE.Vector3,v=new THREE.Vector3,w=new THREE.Vector3,x=new Array(2),y=new Array(2);this.phiDelta=0,this.thetaDelta=0,this.scale=1,this.lastPosition=new THREE.Vector3;var z={NONE:-1,ROTATE:0,ZOOM:1,MOVE:2},A=z.NONE;this.axes=new ROS3D.Axes({shaftRadius:.025,headRadius:.07,headLength:.2}),k.add(this.axes),this.axes.traverse(function(a){a.visible=!1}),this.addEventListener("mousedown",b),this.addEventListener("mouseup",e),this.addEventListener("mousemove",c),this.addEventListener("touchstart",g),this.addEventListener("touchmove",h),this.addEventListener("touchend",i),this.addEventListener("mousewheel",f),this.addEventListener("DOMMouseScroll",f)},ROS3D.OrbitControls.prototype.showAxes=function(){var a=this;this.axes.traverse(function(a){a.visible=!0}),this.hideTimeout&&clearTimeout(this.hideTimeout),this.hideTimeout=setTimeout(function(){a.axes.traverse(function(a){a.visible=!1}),a.hideTimeout=!1},300)},ROS3D.OrbitControls.prototype.rotateLeft=function(a){void 0===a&&(a=2*Math.PI/60/60*this.autoRotateSpeed),this.thetaDelta-=a},ROS3D.OrbitControls.prototype.rotateRight=function(a){void 0===a&&(a=2*Math.PI/60/60*this.autoRotateSpeed),this.thetaDelta+=a},ROS3D.OrbitControls.prototype.rotateUp=function(a){void 0===a&&(a=2*Math.PI/60/60*this.autoRotateSpeed),this.phiDelta-=a},ROS3D.OrbitControls.prototype.rotateDown=function(a){void 0===a&&(a=2*Math.PI/60/60*this.autoRotateSpeed),this.phiDelta+=a},ROS3D.OrbitControls.prototype.zoomIn=function(a){void 0===a&&(a=Math.pow(.95,this.userZoomSpeed)),this.scale/=a},ROS3D.OrbitControls.prototype.zoomOut=function(a){void 0===a&&(a=Math.pow(.95,this.userZoomSpeed)),this.scale*=a},ROS3D.OrbitControls.prototype.update=function(){var a=this.camera.position,b=a.clone().sub(this.center),c=Math.atan2(b.y,b.x),d=Math.atan2(Math.sqrt(b.y*b.y+b.x*b.x),b.z);this.autoRotate&&this.rotateLeft(2*Math.PI/60/60*this.autoRotateSpeed),c+=this.thetaDelta,d+=this.phiDelta;var e=1e-6;d=Math.max(e,Math.min(Math.PI-e,d));var f=b.length();b.set(f*Math.sin(d)*Math.cos(c),f*Math.sin(d)*Math.sin(c),f*Math.cos(d)),b.multiplyScalar(this.scale),a.copy(this.center).add(b),this.camera.lookAt(this.center),f=b.length(),this.axes.position.copy(this.center),this.axes.scale.set(.05*f,.05*f,.05*f),this.axes.updateMatrixWorld(!0),this.thetaDelta=0,this.phiDelta=0,this.scale=1,this.lastPosition.distanceTo(this.camera.position)>0&&(this.dispatchEvent({type:"change"}),this.lastPosition.copy(this.camera.position))},THREE.EventDispatcher.prototype.apply(ROS3D.OrbitControls.prototype);
\ No newline at end of file
+this.timeoutHandle=setTimeout(this.setPoseFromClient.bind(this,a),250))},ROS3D.InteractiveMarkerHandle.prototype.onButtonClick=function(a){this.sendFeedback(ROS3D.INTERACTIVE_MARKER_BUTTON_CLICK,a.clickPosition,0,a.controlName)},ROS3D.InteractiveMarkerHandle.prototype.onMouseDown=function(a){this.sendFeedback(ROS3D.INTERACTIVE_MARKER_MOUSE_DOWN,a.clickPosition,0,a.controlName),this.dragging=!0},ROS3D.InteractiveMarkerHandle.prototype.onMouseUp=function(a){this.sendFeedback(ROS3D.INTERACTIVE_MARKER_MOUSE_UP,a.clickPosition,0,a.controlName),this.dragging=!1,this.timeoutHandle&&clearTimeout(this.timeoutHandle)},ROS3D.InteractiveMarkerHandle.prototype.onMenuSelect=function(a){this.sendFeedback(ROS3D.INTERACTIVE_MARKER_MENU_SELECT,void 0,a.id,a.controlName)},ROS3D.InteractiveMarkerHandle.prototype.sendFeedback=function(a,b,c,d){var e=void 0!==b;b=b||{x:0,y:0,z:0};var f={header:this.header,client_id:this.clientID,marker_name:this.name,control_name:d,event_type:a,pose:this.pose,mouse_point:b,mouse_point_valid:e,menu_entry_id:c};this.feedbackTopic.publish(f)},ROS3D.InteractiveMarkerMenu=function(a){function b(a,b){this.dispatchEvent({type:"menu-select",domEvent:b,id:a.id,controlName:this.controlName}),this.hide(b)}function c(a,e){var f=document.createElement("ul");a.appendChild(f);for(var g=e.children,h=0;h<g.length;h++){var i=document.createElement("li"),j=document.createElement("div");j.appendChild(document.createTextNode(g[h].title)),f.appendChild(i),i.appendChild(j),g[h].children.length>0?(c(i,g[h]),j.addEventListener("click",d.hide.bind(d)),j.addEventListener("touchstart",d.hide.bind(d))):(j.addEventListener("click",b.bind(d,g[h])),j.addEventListener("touchstart",b.bind(d,g[h])),j.className="default-interactive-marker-menu-entry")}}var d=this;a=a||{};var e=a.menuEntries,f=a.className||"default-interactive-marker-menu",g=(a.entryClassName||"default-interactive-marker-menu-entry",a.overlayClassName||"default-interactive-marker-overlay"),h=a.menuFontSize||"0.8em",i=[];if(i[0]={children:[]},THREE.EventDispatcher.call(this),null===document.getElementById("default-interactive-marker-menu-css")){var j=document.createElement("style");j.id="default-interactive-marker-menu-css",j.type="text/css",j.innerHTML=".default-interactive-marker-menu {background-color: #444444;border: 1px solid #888888;border: 1px solid #888888;padding: 0px 0px 0px 0px;color: #FFFFFF;font-family: sans-serif;font-size: "+h+";z-index: 1002;}.default-interactive-marker-menu ul {padding: 0px 0px 5px 0px;margin: 0px;list-style-type: none;}.default-interactive-marker-menu ul li div {-webkit-touch-callout: none;-webkit-user-select: none;-khtml-user-select: none;-moz-user-select: none;-ms-user-select: none;user-select: none;cursor: default;padding: 3px 10px 3px 10px;}.default-interactive-marker-menu-entry:hover {  background-color: #666666;  cursor: pointer;}.default-interactive-marker-menu ul ul {  font-style: italic;  padding-left: 10px;}.default-interactive-marker-overlay {  position: absolute;  top: 0%;  left: 0%;  width: 100%;  height: 100%;  background-color: black;  z-index: 1001;  -moz-opacity: 0.0;  opacity: .0;  filter: alpha(opacity = 0);}",document.getElementsByTagName("head")[0].appendChild(j)}this.menuDomElem=document.createElement("div"),this.menuDomElem.style.position="absolute",this.menuDomElem.className=f,this.menuDomElem.addEventListener("contextmenu",function(a){a.preventDefault()}),this.overlayDomElem=document.createElement("div"),this.overlayDomElem.className=g,this.hideListener=this.hide.bind(this),this.overlayDomElem.addEventListener("contextmenu",this.hideListener),this.overlayDomElem.addEventListener("click",this.hideListener),this.overlayDomElem.addEventListener("touchstart",this.hideListener);var k,l,m;for(k=0;k<e.length;k++)l=e[k],m=l.id,i[m]={title:l.title,id:m,children:[]};for(k=0;k<e.length;k++){l=e[k],m=l.id;var n=i[m],o=i[l.parent_id];o.children.push(n)}c(this.menuDomElem,i[0])},ROS3D.InteractiveMarkerMenu.prototype.show=function(a,b){b&&b.preventDefault&&b.preventDefault(),this.controlName=a.name,void 0!==b.domEvent.changedTouches?(this.menuDomElem.style.left=b.domEvent.changedTouches[0].pageX+"px",this.menuDomElem.style.top=b.domEvent.changedTouches[0].pageY+"px"):(this.menuDomElem.style.left=b.domEvent.clientX+"px",this.menuDomElem.style.top=b.domEvent.clientY+"px"),document.body.appendChild(this.overlayDomElem),document.body.appendChild(this.menuDomElem)},ROS3D.InteractiveMarkerMenu.prototype.hide=function(a){a&&a.preventDefault&&a.preventDefault(),document.body.removeChild(this.overlayDomElem),document.body.removeChild(this.menuDomElem)},THREE.EventDispatcher.prototype.apply(ROS3D.InteractiveMarkerMenu.prototype),ROS3D.Marker=function(a){a=a||{};var b=a.path||"/",c=a.message,d=a.loader||ROS3D.COLLADA_LOADER_2;"/"!==b.substr(b.length-1)&&(b+="/"),THREE.Object3D.call(this),c.scale?this.msgScale=[c.scale.x,c.scale.y,c.scale.z]:this.msgScale=[1,1,1],this.msgColor=c.color,this.msgMesh=void 0,this.setPose(c.pose);var e=ROS3D.makeColorMaterial(this.msgColor.r,this.msgColor.g,this.msgColor.b,this.msgColor.a);switch(c.type){case ROS3D.MARKER_ARROW:var f,g=c.scale.x,h=.23*g,i=c.scale.y,j=.5*i,k=null;if(2===c.points.length){k=new THREE.Vector3(c.points[0].x,c.points[0].y,c.points[0].z);var l=new THREE.Vector3(c.points[1].x,c.points[1].y,c.points[1].z);f=k.clone().negate().add(l),g=f.length(),i=c.scale.y,j=c.scale.x,0!==c.scale.z&&(h=c.scale.z)}this.add(new ROS3D.Arrow({direction:f,origin:k,length:g,headLength:h,shaftDiameter:j,headDiameter:i,material:e}));break;case ROS3D.MARKER_CUBE:var m=new THREE.BoxGeometry(c.scale.x,c.scale.y,c.scale.z);this.add(new THREE.Mesh(m,e));break;case ROS3D.MARKER_SPHERE:var n=new THREE.SphereGeometry(.5),o=new THREE.Mesh(n,e);o.scale.x=c.scale.x,o.scale.y=c.scale.y,o.scale.z=c.scale.z,this.add(o);break;case ROS3D.MARKER_CYLINDER:var p=new THREE.CylinderGeometry(.5,.5,1,16,1,!1),q=new THREE.Mesh(p,e);q.quaternion.setFromAxisAngle(new THREE.Vector3(1,0,0),.5*Math.PI),q.scale.set(c.scale.x,c.scale.z,c.scale.y),this.add(q);break;case ROS3D.MARKER_LINE_STRIP:var r,s=new THREE.Geometry,t=new THREE.LineBasicMaterial({});for(r=0;r<c.points.length;r++){var u=new THREE.Vector3;u.x=c.points[r].x,u.y=c.points[r].y,u.z=c.points[r].z,s.vertices.push(u)}if(c.colors.length===c.points.length)for(t.vertexColors=!0,r=0;r<c.points.length;r++){var v=new THREE.Color;v.setRGB(c.colors[r].r,c.colors[r].g,c.colors[r].b),s.colors.push(v)}else t.color.setRGB(c.color.r,c.color.g,c.color.b);this.add(new THREE.Line(s,t));break;case ROS3D.MARKER_LINE_LIST:var w,x=new THREE.Geometry,y=new THREE.LineBasicMaterial({});for(w=0;w<c.points.length;w++){var z=new THREE.Vector3;z.x=c.points[w].x,z.y=c.points[w].y,z.z=c.points[w].z,x.vertices.push(z)}if(c.colors.length===c.points.length)for(y.vertexColors=!0,w=0;w<c.points.length;w++){var A=new THREE.Color;A.setRGB(c.colors[w].r,c.colors[w].g,c.colors[w].b),x.colors.push(A)}else y.color.setRGB(c.color.r,c.color.g,c.color.b);this.add(new THREE.Line(x,y,THREE.LinePieces));break;case ROS3D.MARKER_CUBE_LIST:var B,C,D,E,F=new THREE.Object3D,G=c.points.length,H=G===c.colors.length,I=Math.ceil(G/1250);for(B=0;G>B;B+=I)C=new THREE.BoxGeometry(c.scale.x,c.scale.y,c.scale.z),D=H?ROS3D.makeColorMaterial(c.colors[B].r,c.colors[B].g,c.colors[B].b,c.colors[B].a):e,E=new THREE.Mesh(C,D),E.position.x=c.points[B].x,E.position.y=c.points[B].y,E.position.z=c.points[B].z,F.add(E);this.add(F);break;case ROS3D.MARKER_SPHERE_LIST:var J,K,L,M,N=new THREE.Object3D,O=c.points.length,P=O===c.colors.length,Q=Math.ceil(O/1250);for(J=0;O>J;J+=Q)K=new THREE.SphereGeometry(.5,8,8),L=P?ROS3D.makeColorMaterial(c.colors[J].r,c.colors[J].g,c.colors[J].b,c.colors[J].a):e,M=new THREE.Mesh(K,L),M.scale.x=c.scale.x,M.scale.y=c.scale.y,M.scale.z=c.scale.z,M.position.x=c.points[J].x,M.position.y=c.points[J].y,M.position.z=c.points[J].z,N.add(M);this.add(N);break;case ROS3D.MARKER_POINTS:var R,S=new THREE.Geometry,T=new THREE.PointCloudMaterial({size:c.scale.x});for(R=0;R<c.points.length;R++){var U=new THREE.Vector3;U.x=c.points[R].x,U.y=c.points[R].y,U.z=c.points[R].z,S.vertices.push(U)}if(c.colors.length===c.points.length)for(T.vertexColors=!0,R=0;R<c.points.length;R++){var V=new THREE.Color;V.setRGB(c.colors[R].r,c.colors[R].g,c.colors[R].b),S.colors.push(V)}else T.color.setRGB(c.color.r,c.color.g,c.color.b);this.add(new THREE.PointCloud(S,T));break;case ROS3D.MARKER_TEXT_VIEW_FACING:if(c.text.length>0){var W=this.msgColor,X=document.createElement("canvas"),Y=X.getContext("2d"),Z=100,$="normal "+Z+"px sans-serif";Y.font=$;var _=Y.measureText(c.text),aa=_.width;X.width=aa,X.height=1.5*Z,Y.font=$,Y.fillStyle="rgba("+W.r+", "+W.g+", "+W.b+", "+W.a+")",Y.textAlign="left",Y.textBaseline="middle",Y.fillText(c.text,0,X.height/2);var ba=new THREE.Texture(X);ba.needsUpdate=!0;var ca=new THREE.SpriteMaterial({map:ba,useScreenCoordinates:!1}),da=new THREE.Sprite(ca),ea=c.scale.x;da.scale.set(aa/X.height*ea,ea,1),this.add(da)}break;case ROS3D.MARKER_MESH_RESOURCE:var fa=null;(0!==c.color.r||0!==c.color.g||0!==c.color.b||0!==c.color.a)&&(fa=e),this.msgMesh=c.mesh_resource.substr(10);var ga=new ROS3D.MeshResource({path:b,resource:this.msgMesh,material:fa,loader:d});this.add(ga);break;case ROS3D.MARKER_TRIANGLE_LIST:var ha=new ROS3D.TriangleList({material:e,vertices:c.points,colors:c.colors});ha.scale.set(c.scale.x,c.scale.y,c.scale.z),this.add(ha);break;default:console.error("Currently unsupported marker type: "+c.type)}},ROS3D.Marker.prototype.__proto__=THREE.Object3D.prototype,ROS3D.Marker.prototype.setPose=function(a){this.position.x=a.position.x,this.position.y=a.position.y,this.position.z=a.position.z,this.quaternion.set(a.orientation.x,a.orientation.y,a.orientation.z,a.orientation.w),this.quaternion.normalize(),this.updateMatrixWorld()},ROS3D.Marker.prototype.update=function(a){if(this.setPose(a.pose),a.color.r!==this.msgColor.r||a.color.g!==this.msgColor.g||a.color.b!==this.msgColor.b||a.color.a!==this.msgColor.a){var b=ROS3D.makeColorMaterial(a.color.r,a.color.g,a.color.b,a.color.a);switch(a.type){case ROS3D.MARKER_LINE_STRIP:case ROS3D.MARKER_LINE_LIST:case ROS3D.MARKER_POINTS:break;case ROS3D.MARKER_ARROW:case ROS3D.MARKER_CUBE:case ROS3D.MARKER_SPHERE:case ROS3D.MARKER_CYLINDER:case ROS3D.MARKER_TRIANGLE_LIST:case ROS3D.MARKER_TEXT_VIEW_FACING:this.traverse(function(a){a instanceof THREE.Mesh&&(a.material=b)});break;case ROS3D.MARKER_MESH_RESOURCE:var c=null;(0!==a.color.r||0!==a.color.g||0!==a.color.b||0!==a.color.a)&&(c=this.colorMaterial),this.traverse(function(a){a instanceof THREE.Mesh&&(a.material=c)});break;case ROS3D.MARKER_CUBE_LIST:case ROS3D.MARKER_SPHERE_LIST:return!1;default:return!1}this.msgColor=a.color}var d=Math.abs(this.msgScale[0]-a.scale.x)>1e-6||Math.abs(this.msgScale[1]-a.scale.y)>1e-6||Math.abs(this.msgScale[2]-a.scale.z)>1e-6;switch(this.msgScale=[a.scale.x,a.scale.y,a.scale.z],a.type){case ROS3D.MARKER_CUBE:case ROS3D.MARKER_SPHERE:case ROS3D.MARKER_CYLINDER:if(d)return!1;break;case ROS3D.MARKER_TEXT_VIEW_FACING:if(d||this.text!==a.text)return!1;break;case ROS3D.MARKER_MESH_RESOURCE:var e=a.mesh_resource.substr(10);if(e!==this.msgMesh)return!1;if(d)return!1;break;case ROS3D.MARKER_ARROW:case ROS3D.MARKER_LINE_STRIP:case ROS3D.MARKER_LINE_LIST:case ROS3D.MARKER_CUBE_LIST:case ROS3D.MARKER_SPHERE_LIST:case ROS3D.MARKER_POINTS:case ROS3D.MARKER_TRIANGLE_LIST:return!1}return!0},ROS3D.Marker.prototype.dispose=function(){this.children.forEach(function(a){a instanceof ROS3D.MeshResource?a.children.forEach(function(b){void 0!==b.material&&b.material.dispose(),b.children.forEach(function(a){void 0!==a.geometry&&a.geometry.dispose(),void 0!==a.material&&a.material.dispose(),b.remove(a)}),a.remove(b)}):(void 0!==a.geometry&&a.geometry.dispose(),void 0!==a.material&&a.material.dispose()),a.parent.remove(a)})},ROS3D.MarkerArrayClient=function(a){var b=this;a=a||{};var c=a.ros,d=a.topic;this.tfClient=a.tfClient,this.rootObject=a.rootObject||new THREE.Object3D,this.path=a.path||"/",this.loader=a.loader||ROS3D.COLLADA_LOADER_2,this.markers={};var e=new ROSLIB.Topic({ros:c,name:d,messageType:"visualization_msgs/MarkerArray",compression:"png",queue_length:2});e.subscribe(function(a){a.markers.forEach(function(a){if(0===a.action){var c=!1;if(a.ns+a.id in b.markers&&(c=b.markers[a.ns+a.id].children[0].update(a),c||(b.markers[a.ns+a.id].unsubscribeTf(),b.rootObject.remove(b.markers[a.ns+a.id]))),!c){var d=new ROS3D.Marker({message:a,path:b.path,loader:b.loader});b.markers[a.ns+a.id]=new ROS3D.SceneNode({frameID:a.header.frame_id.replace(/^\//,""),tfClient:b.tfClient,object:d}),b.rootObject.add(b.markers[a.ns+a.id])}}else if(1===a.action)console.warn('Received marker message with deprecated action identifier "1"');else if(2===a.action)a.ns+a.id in b.markers&&(b.markers[a.ns+a.id].unsubscribeTf(),b.rootObject.remove(b.markers[a.ns+a.id]),delete b.markers[a.ns+a.id]);else if(3===a.action){for(var e in b.markers)e.unsubscribeTf(),b.rootObject.remove(e);b.markers={}}else console.warn('Received marker message with unknown action identifier "'+a.action+'"')}),b.emit("change")}),this.removeArray=function(){e.unsubscribe();for(var a in b.markers)b.markers.hasOwnProperty(a)&&(b.rootObject.remove(b.markers[a]),b.markers[a].unsubscribeTf())}},ROS3D.MarkerArrayClient.prototype.__proto__=EventEmitter2.prototype,ROS3D.MarkerClient=function(a){var b=this;a=a||{};var c=a.ros,d=a.topic;this.tfClient=a.tfClient,this.rootObject=a.rootObject||new THREE.Object3D,this.path=a.path||"/",this.loader=a.loader||ROS3D.COLLADA_LOADER_2,this.markers={};var e=new ROSLIB.Topic({ros:c,name:d,messageType:"visualization_msgs/Marker",compression:"png"});e.subscribe(function(a){var c=new ROS3D.Marker({message:a,path:b.path,loader:b.loader}),d=b.markers[a.ns+a.id];d&&(d.unsubscribeTf(),b.rootObject.remove(d)),b.markers[a.ns+a.id]=new ROS3D.SceneNode({frameID:a.header.frame_id.replace(/^\//,""),tfClient:b.tfClient,object:c}),b.rootObject.add(b.markers[a.ns+a.id]),b.emit("change")})},ROS3D.MarkerClient.prototype.__proto__=EventEmitter2.prototype,ROS3D.Arrow=function(a){a=a||{};var b=a.origin||new THREE.Vector3(0,0,0),c=a.direction||new THREE.Vector3(1,0,0),d=a.length||1,e=a.headLength||.2,f=a.shaftDiameter||.05,g=a.headDiameter||.1,h=a.material||new THREE.MeshBasicMaterial,i=d-e,j=new THREE.CylinderGeometry(.5*f,.5*f,i,12,1),k=new THREE.Matrix4;k.setPosition(new THREE.Vector3(0,.5*i,0)),j.applyMatrix(k);var l=new THREE.CylinderGeometry(0,.5*g,e,12,1);k.setPosition(new THREE.Vector3(0,i+.5*e,0)),l.applyMatrix(k),j.merge(l),THREE.Mesh.call(this,j,h),this.position.copy(b),this.setDirection(c)},ROS3D.Arrow.prototype.__proto__=THREE.Mesh.prototype,ROS3D.Arrow.prototype.setDirection=function(a){var b=new THREE.Vector3(0,1,0).cross(a),c=Math.acos(new THREE.Vector3(0,1,0).dot(a.clone().normalize()));this.matrix=(new THREE.Matrix4).makeRotationAxis(b.normalize(),c),this.rotation.setFromRotationMatrix(this.matrix,this.rotation.order)},ROS3D.Arrow.prototype.setLength=function(a){this.scale.set(a,a,a)},ROS3D.Arrow.prototype.setColor=function(a){this.material.color.setHex(a)},ROS3D.Axes=function(a){function b(a){var b=new THREE.Color;b.setRGB(a.x,a.y,a.z);var d=new THREE.MeshBasicMaterial({color:b.getHex()}),e=new THREE.Vector3;e.crossVectors(a,new THREE.Vector3(0,-1,0));var f=new THREE.Quaternion;f.setFromAxisAngle(e,.5*Math.PI);var g=new THREE.Mesh(c.headGeom,d);g.position.copy(a),g.position.multiplyScalar(.95),g.quaternion.copy(f),g.updateMatrix(),c.add(g);var h=new THREE.Mesh(c.lineGeom,d);h.position.copy(a),h.position.multiplyScalar(.45),h.quaternion.copy(f),h.updateMatrix(),c.add(h)}var c=this;a=a||{};var d=a.shaftRadius||.008,e=a.headRadius||.023,f=a.headLength||.1,g=a.scale||1;THREE.Object3D.call(this),this.scale.set(g,g,g),this.lineGeom=new THREE.CylinderGeometry(d,d,1-f),this.headGeom=new THREE.CylinderGeometry(0,e,f),b(new THREE.Vector3(1,0,0)),b(new THREE.Vector3(0,1,0)),b(new THREE.Vector3(0,0,1))},ROS3D.Axes.prototype.__proto__=THREE.Object3D.prototype,ROS3D.Grid=function(a){a=a||{};var b=a.num_cells||10,c=a.color||"#cccccc",d=a.lineWidth||1,e=a.cellSize||1;THREE.Object3D.call(this);for(var f=new THREE.LineBasicMaterial({color:c,linewidth:d}),g=0;b>=g;++g){var h=e*b/2,i=h-g*e,j=new THREE.Geometry;j.vertices.push(new THREE.Vector3(-h,i,0),new THREE.Vector3(h,i,0));var k=new THREE.Geometry;k.vertices.push(new THREE.Vector3(i,-h,0),new THREE.Vector3(i,h,0)),this.add(new THREE.Line(j,f)),this.add(new THREE.Line(k,f))}},ROS3D.Grid.prototype.__proto__=THREE.Object3D.prototype,ROS3D.MeshResource=function(a){var b=this;a=a||{};var c=a.path||"/",d=a.resource,e=a.material||null;this.warnings=a.warnings;var f=a.loader||ROS3D.COLLADA_LOADER_2;THREE.Object3D.call(this),"/"!==c.substr(c.length-1)&&(this.path+="/");var g,h=c+d,i=h.substr(-4).toLowerCase();".dae"===i?(g=f===ROS3D.COLLADA_LOADER?new THREE.ColladaLoader:new ColladaLoader2,g.log=function(a){b.warnings&&console.warn(a)},g.load(h,function(a){if(f===ROS3D.COLLADA_LOADER_2&&a.dae.asset.unit){var c=a.dae.asset.unit;a.scene.scale.set(c,c,c)}if(null!==e){var d=function(a,b){if(a.material=b,a.children)for(var c=0;c<a.children.length;c++)d(a.children[c],b)};d(a.scene,e)}b.add(a.scene)})):".stl"===i&&(g=new THREE.STLLoader,g.load(h,function(a){a.computeFaceNormals();var c;c=null!==e?new THREE.Mesh(a,e):new THREE.Mesh(a,new THREE.MeshBasicMaterial({color:10066329})),b.add(c)}))},ROS3D.MeshResource.prototype.__proto__=THREE.Object3D.prototype,ROS3D.TriangleList=function(a){a=a||{};var b=a.material||new THREE.MeshBasicMaterial,c=a.vertices,d=a.colors;THREE.Object3D.call(this),b.side=THREE.DoubleSide;var e=new THREE.Geometry;for(f=0;f<c.length;f++)e.vertices.push(new THREE.Vector3(c[f].x,c[f].y,c[f].z));var f,g;if(d.length===c.length){for(f=0;f<c.length;f+=3){var h=new THREE.Face3(f,f+1,f+2);for(g=3*f;3*f+3>g;f++){var i=new THREE.Color;i.setRGB(d[f].r,d[f].g,d[f].b),h.vertexColors.push(i)}e.faces.push(k)}b.vertexColors=THREE.VertexColors}else if(d.length===c.length/3){for(f=0;f<c.length;f+=3){var j=new THREE.Face3(f,f+1,f+2);j.color.setRGB(d[f/3].r,d[f/3].g,d[f/3].b),e.faces.push(j)}b.vertexColors=THREE.FaceColors}else for(f=0;f<c.length;f+=3){var k=new THREE.Face3(f,f+1,f+2);e.faces.push(k)}e.computeBoundingBox(),e.computeBoundingSphere(),e.computeFaceNormals(),this.add(new THREE.Mesh(e,b))},ROS3D.TriangleList.prototype.__proto__=THREE.Object3D.prototype,ROS3D.TriangleList.prototype.setColor=function(a){this.mesh.material.color.setHex(a)},ROS3D.OccupancyGrid=function(a){a=a||{};var b=a.message,c=a.color||{r:255,g:255,b:255},d=a.opacity||1,e=b.info.width,f=b.info.height,g=new THREE.PlaneGeometry(e,f),h=document.createElement("canvas");h.width=e,h.height=f;for(var i=h.getContext("2d"),j=i.createImageData(e,f),k=0;f>k;k++)for(var l=0;e>l;l++){var m,n=l+(f-k-1)*e,o=b.data[n];m=100===o?0:0===o?255:127;var p=4*(l+k*e);j.data[p]=m*c.r/255,j.data[++p]=m*c.g/255,j.data[++p]=m*c.b/255,j.data[++p]=255}i.putImageData(j,0,0);var q=new THREE.Texture(h);q.needsUpdate=!0;var r=new THREE.MeshBasicMaterial({map:q,transparent:1>d,opacity:d});r.side=THREE.DoubleSide,THREE.Mesh.call(this,g,r),this.quaternion=b.info.origin.orientation,this.position.x=e*b.info.resolution/2+b.info.origin.position.x,this.position.y=f*b.info.resolution/2+b.info.origin.position.y,this.position.z=b.info.origin.position.z,this.scale.x=b.info.resolution,this.scale.y=b.info.resolution},ROS3D.OccupancyGrid.prototype.__proto__=THREE.Mesh.prototype,ROS3D.OccupancyGridClient=function(a){var b=this;a=a||{};var c=a.ros,d=a.topic||"/map";this.continuous=a.continuous,this.tfClient=a.tfClient,this.rootObject=a.rootObject||new THREE.Object3D,this.offsetPose=a.offsetPose||new ROSLIB.Pose,this.color=a.color||{r:255,g:255,b:255},this.opacity=a.opacity||1,this.currentGrid=null;var e=new ROSLIB.Topic({ros:c,name:d,messageType:"nav_msgs/OccupancyGrid",compression:"png"});e.subscribe(function(a){b.currentGrid&&(b.currentGrid.tfClient&&b.currentGrid.unsubscribeTf(),b.rootObject.remove(b.currentGrid));var c=new ROS3D.OccupancyGrid({message:a,color:b.color,opacity:b.opacity});b.tfClient?b.currentGrid=new ROS3D.SceneNode({frameID:a.header.frame_id,tfClient:b.tfClient,object:c,pose:b.offsetPose}):b.currentGrid=c,b.rootObject.add(b.currentGrid),b.emit("change"),b.continuous||e.unsubscribe()})},ROS3D.OccupancyGridClient.prototype.__proto__=EventEmitter2.prototype,ROS3D.Odometry=function(a){this.options=a||{};var b=a.ros,c=a.topic||"/particlecloud";this.tfClient=a.tfClient,this.color=a.color||13369599,this.length=a.length||1,this.rootObject=a.rootObject||new THREE.Object3D,this.keep=a.keep||1;var d=this;THREE.Object3D.call(this),this.sns=[];var e=new ROSLIB.Topic({ros:b,name:c,messageType:"nav_msgs/Odometry"});e.subscribe(function(a){d.sns.length>=d.keep&&(d.sns[0].unsubscribeTf(),d.rootObject.remove(d.sns[0]),d.sns.shift()),d.options.origin=new THREE.Vector3(a.pose.pose.position.x,a.pose.pose.position.y,a.pose.pose.position.z);var b=new THREE.Quaternion(a.pose.pose.orientation.x,a.pose.pose.orientation.y,a.pose.pose.orientation.z,a.pose.pose.orientation.w);d.options.direction=new THREE.Vector3(1,0,0),d.options.direction.applyQuaternion(b),d.options.material=new THREE.MeshBasicMaterial({color:d.color});var c=new ROS3D.Arrow(d.options);d.sns.push(new ROS3D.SceneNode({frameID:a.header.frame_id,tfClient:d.tfClient,object:c})),d.rootObject.add(d.sns[d.sns.length-1])})},ROS3D.Odometry.prototype.__proto__=THREE.Object3D.prototype,ROS3D.Path=function(a){a=a||{};var b=a.ros,c=a.topic||"/path";this.tfClient=a.tfClient,this.color=a.color||13369599,this.rootObject=a.rootObject||new THREE.Object3D;var d=this;THREE.Object3D.call(this),this.sn=null,this.line=null;var e=new ROSLIB.Topic({ros:b,name:c,messageType:"nav_msgs/Path"});e.subscribe(function(a){null!==d.sn&&(d.sn.unsubscribeTf(),d.rootObject.remove(d.sn));for(var b=new THREE.Geometry,c=0;c<a.poses.length;c++){var e=new THREE.Vector3(a.poses[c].pose.position.x,a.poses[c].pose.position.y,a.poses[c].pose.position.z);b.vertices.push(e)}b.computeLineDistances();var f=new THREE.LineBasicMaterial({color:d.color}),g=new THREE.Line(b,f);d.sn=new ROS3D.SceneNode({frameID:a.header.frame_id,tfClient:d.tfClient,object:g}),d.rootObject.add(d.sn)})},ROS3D.Path.prototype.__proto__=THREE.Object3D.prototype,ROS3D.Point=function(a){this.options=a||{};var b=a.ros,c=a.topic||"/point";this.tfClient=a.tfClient,this.color=a.color||13369599,this.rootObject=a.rootObject||new THREE.Object3D,this.radius=a.radius||.2;var d=this;THREE.Object3D.call(this),this.sn=null;var e=new ROSLIB.Topic({ros:b,name:c,messageType:"geometry_msgs/PointStamped"});e.subscribe(function(a){null!==d.sn&&(d.sn.unsubscribeTf(),d.rootObject.remove(d.sn));var b=new THREE.SphereGeometry(d.radius),c=new THREE.MeshBasicMaterial({color:d.color}),e=new THREE.Mesh(b,c);e.position.set(a.point.x,a.point.y,a.point.z),d.sn=new ROS3D.SceneNode({frameID:a.header.frame_id,tfClient:d.tfClient,object:e}),d.rootObject.add(d.sn)})},ROS3D.Point.prototype.__proto__=THREE.Object3D.prototype,ROS3D.Polygon=function(a){a=a||{};var b=a.ros,c=a.topic||"/path";this.tfClient=a.tfClient,this.color=a.color||13369599,this.rootObject=a.rootObject||new THREE.Object3D;var d=this;THREE.Object3D.call(this),this.sn=null,this.line=null;var e=new ROSLIB.Topic({ros:b,name:c,messageType:"geometry_msgs/PolygonStamped"});e.subscribe(function(a){null!==d.sn&&(d.sn.unsubscribeTf(),d.rootObject.remove(d.sn));for(var b,c=new THREE.Geometry,e=0;e<a.polygon.points.length;e++)b=new THREE.Vector3(a.polygon.points[e].x,a.polygon.points[e].y,a.polygon.points[e].z),c.vertices.push(b);b=new THREE.Vector3(a.polygon.points[0].x,a.polygon.points[0].y,a.polygon.points[0].z),c.vertices.push(b),c.computeLineDistances();var f=new THREE.LineBasicMaterial({color:d.color}),g=new THREE.Line(c,f);d.sn=new ROS3D.SceneNode({frameID:a.header.frame_id,tfClient:d.tfClient,object:g}),d.rootObject.add(d.sn)})},ROS3D.Polygon.prototype.__proto__=THREE.Object3D.prototype,ROS3D.Pose=function(a){this.options=a||{};var b=a.ros,c=a.topic||"/pose";this.tfClient=a.tfClient,this.color=a.color||13369599,this.rootObject=a.rootObject||new THREE.Object3D;var d=this;THREE.Object3D.call(this),this.sn=null;var e=new ROSLIB.Topic({ros:b,name:c,messageType:"geometry_msgs/PoseStamped"});e.subscribe(function(a){null!==d.sn&&(d.sn.unsubscribeTf(),d.rootObject.remove(d.sn)),d.options.origin=new THREE.Vector3(a.pose.position.x,a.pose.position.y,a.pose.position.z);var b=new THREE.Quaternion(a.pose.orientation.x,a.pose.orientation.y,a.pose.orientation.z,a.pose.orientation.w);d.options.direction=new THREE.Vector3(1,0,0),d.options.direction.applyQuaternion(b),d.options.material=new THREE.MeshBasicMaterial({color:d.color});var c=new ROS3D.Arrow(d.options);d.sn=new ROS3D.SceneNode({frameID:a.header.frame_id,tfClient:d.tfClient,object:c}),d.rootObject.add(d.sn)})},ROS3D.Pose.prototype.__proto__=THREE.Object3D.prototype,ROS3D.PoseArray=function(a){this.options=a||{};var b=a.ros,c=a.topic||"/particlecloud";this.tfClient=a.tfClient,this.color=a.color||13369599,this.length=a.length||1,this.rootObject=a.rootObject||new THREE.Object3D;var d=this;THREE.Object3D.call(this),this.sn=null;var e=new ROSLIB.Topic({ros:b,name:c,messageType:"geometry_msgs/PoseArray"});e.subscribe(function(a){null!==d.sn&&(d.sn.unsubscribeTf(),d.rootObject.remove(d.sn));for(var b,c=new THREE.Object3D,e=0;e<a.poses.length;e++){var f=new THREE.Geometry,g=new THREE.Vector3(a.poses[e].position.x,a.poses[e].position.y,a.poses[e].position.z);f.vertices.push(g);var h=new THREE.Quaternion(a.poses[e].orientation.x,a.poses[e].orientation.y,a.poses[e].orientation.z,a.poses[e].orientation.w),i=new THREE.Vector3(d.length,0,0),j=new THREE.Vector3(.8*d.length,.2*d.length,0),k=new THREE.Vector3(.8*d.length,.2*-d.length,0);i.applyQuaternion(h),j.applyQuaternion(h),k.applyQuaternion(h),f.vertices.push(i.add(g)),f.vertices.push(j.add(g)),f.vertices.push(k.add(g)),f.vertices.push(i),f.computeLineDistances();var l=new THREE.LineBasicMaterial({color:d.color});b=new THREE.Line(f,l),c.add(b)}d.sn=new ROS3D.SceneNode({frameID:a.header.frame_id,tfClient:d.tfClient,object:c}),d.rootObject.add(d.sn)})},ROS3D.PoseArray.prototype.__proto__=THREE.Object3D.prototype,ROS3D.LaserScan=function(a){a=a||{};var b=a.ros,c=a.topic||"/scan";this.color=a.color||16753920;var d=this;this.particles=new ROS3D.Particles(a);var e=new ROSLIB.Topic({ros:b,name:c,messageType:"sensor_msgs/LaserScan"});e.subscribe(function(a){setFrame(d.particles,a.header.frame_id);for(var b=a.ranges.length,c=0;b>c;c++){var e=a.ranges[c];if(e<a.range_min||e>a.range_max)d.particles.alpha[c]=0;else{var f=a.angle_min+c*a.angle_increment;d.particles.points[c]=new THREE.Vector3(e*Math.cos(f),e*Math.sin(f),0),d.particles.alpha[c]=1}d.particles.colors[c]=new THREE.Color(d.color)}finishedUpdate(d.particles,b)})},ROS3D.LaserScan.prototype.__proto__=THREE.Object3D.prototype,ROS3D.Particles=function(a){a=a||{},this.tfClient=a.tfClient;var b=a.texture||"https://upload.wikimedia.org/wikipedia/commons/a/a2/Pixel-white.png",c=a.size||.05;this.max_pts=a.max_pts||1e4,this.first_size=null,this.prev_pts=0,this.rootObject=a.rootObject||new THREE.Object3D;THREE.Object3D.call(this),this.vertex_shader=["attribute vec3 customColor;","attribute float alpha;","varying vec3 vColor;","varying float falpha;","void main() ","{","    vColor = customColor; // set color associated to vertex; use later in fragment shader","    vec4 mvPosition = modelViewMatrix * vec4( position, 1.0 );","    falpha = alpha; ","","    // option (1): draw particles at constant size on screen","    // gl_PointSize = size;","    // option (2): scale particles as objects in 3D space","    gl_PointSize = ",c,"* ( 300.0 / length( mvPosition.xyz ) );","    gl_Position = projectionMatrix * mvPosition;","}"].join("\n"),this.fragment_shader=["uniform sampler2D texture;","varying vec3 vColor; // colors associated to vertices; assigned by vertex shader","varying float falpha;","void main() ","{","    // calculates a color for the particle","    gl_FragColor = vec4( vColor, falpha );","    // sets particle texture to desired color","    gl_FragColor = gl_FragColor * texture2D( texture, gl_PointCoord );","}"].join("\n"),this.geom=new THREE.Geometry;for(var d=0;d<this.max_pts;d++)this.geom.vertices.push(new THREE.Vector3);var e={texture:{type:"t",value:THREE.ImageUtils.loadTexture(b)}};this.attribs={customColor:{type:"c",value:[]},alpha:{type:"f",value:[]}},this.shaderMaterial=new THREE.ShaderMaterial({uniforms:e,attributes:this.attribs,vertexShader:this.vertex_shader,fragmentShader:this.fragment_shader,transparent:!0,alphaTest:.5}),this.ps=new THREE.PointCloud(this.geom,this.shaderMaterial),this.sn=null,this.points=this.geom.vertices,this.colors=this.attribs.customColor.value,this.alpha=this.attribs.alpha.value};var BASE64="ABCDEFGHIJKLMNOPQRSTUVWXYZabcdefghijklmnopqrstuvwxyz0123456789+/=";ROS3D.PointCloud2=function(a){a=a||{};var b=a.ros,c=a.topic||"/points",d=this;this.particles=new ROS3D.Particles(a);var e=new ROSLIB.Topic({ros:b,name:c,messageType:"sensor_msgs/PointCloud2"});e.subscribe(function(a){setFrame(d.particles,a.header.frame_id);var b,c=a.height*a.width;b=a.data.buffer?a.data.buffer.buffer:Uint8Array.from(decode64(a.data)).buffer;for(var e=new DataView(b),f=0;c>f;f++){var g=read_point(a,f,e);d.particles.points[f]=new THREE.Vector3(g.x,g.y,g.z),d.particles.colors[f]=new THREE.Color(g.rgb),d.particles.alpha[f]=1}finishedUpdate(d.particles,c)})},ROS3D.PointCloud2.prototype.__proto__=THREE.Object3D.prototype,ROS3D.Urdf=function(a){a=a||{};var b=a.urdfModel,c=a.path||"/",d=a.tfClient,e=a.tfPrefix||"",f=a.loader||ROS3D.COLLADA_LOADER_2;THREE.Object3D.call(this);var g=b.links;for(var h in g)for(var i=g[h],j=0;j<i.visuals.length;j++){var k=i.visuals[j];if(k&&k.geometry){var l=e+"/"+i.name,m=null;if(k.material&&k.material.color){var n=k.material&&k.material.color;m=ROS3D.makeColorMaterial(n.r,n.g,n.b,n.a)}if(k.geometry.type===ROSLIB.URDF_MESH){var o=k.geometry.filename,p=o.indexOf("package://");-1!==p&&(o=o.substr(p+"package://".length));var q=o.substr(-4).toLowerCase();if(".dae"===q||".stl"===q){var r=new ROS3D.MeshResource({path:c,resource:o,loader:f,material:m});i.visuals[j].geometry.scale&&r.scale.set(k.geometry.scale.x,k.geometry.scale.y,k.geometry.scale.z);var s=new ROS3D.SceneNode({frameID:l,pose:k.origin,tfClient:d,object:r});this.add(s)}else console.warn("Could not load geometry mesh: "+o)}else{m||(m=ROS3D.makeColorMaterial(0,0,0,1));var t;switch(k.geometry.type){case ROSLIB.URDF_BOX:var u=k.geometry.dimension,v=new THREE.BoxGeometry(u.x,u.y,u.z);t=new THREE.Mesh(v,m);break;case ROSLIB.URDF_CYLINDER:var w=k.geometry.radius,x=k.geometry.length,y=new THREE.CylinderGeometry(w,w,x,16,1,!1);t=new THREE.Mesh(y,m),t.quaternion.setFromAxisAngle(new THREE.Vector3(1,0,0),.5*Math.PI);break;case ROSLIB.URDF_SPHERE:var z=new THREE.SphereGeometry(k.geometry.radius,16);t=new THREE.Mesh(z,m)}var A=new ROS3D.SceneNode({frameID:l,pose:k.origin,tfClient:d,object:t});this.add(A)}}}},ROS3D.Urdf.prototype.__proto__=THREE.Object3D.prototype,ROS3D.UrdfClient=function(a){var b=this;a=a||{};var c=a.ros,d=a.param||"robot_description";this.path=a.path||"/",this.tfClient=a.tfClient,this.rootObject=a.rootObject||new THREE.Object3D;var e=a.tfPrefix||"",f=a.loader||ROS3D.COLLADA_LOADER_2,g=new ROSLIB.Param({ros:c,name:d});g.get(function(a){var c=new ROSLIB.UrdfModel({string:a});b.rootObject.add(new ROS3D.Urdf({urdfModel:c,path:b.path,tfClient:b.tfClient,tfPrefix:e,loader:f}))})},ROS3D.SceneNode=function(a){a=a||{};var b=this;this.tfClient=a.tfClient||null,this.frameID=a.frameID;var c=a.object;this.pose=a.pose||new ROSLIB.Pose,THREE.Object3D.call(this),this.visible=!1,c&&this.add(c),this.updatePose(this.pose),this.tfUpdate=function(a){b.transformPose(a)},this.tfClient&&this.tfClient.subscribe(this.frameID,this.tfUpdate)},ROS3D.SceneNode.prototype.__proto__=THREE.Object3D.prototype,ROS3D.SceneNode.prototype.updatePose=function(a){this.position.set(a.position.x,a.position.y,a.position.z),
+this.quaternion.set(a.orientation.x,a.orientation.y,a.orientation.z,a.orientation.w),this.updateMatrixWorld(!0)},ROS3D.SceneNode.prototype.unsubscribeTf=function(){this.tfClient&&this.tfClient.unsubscribe(this.frameID,this.tfUpdate)},ROS3D.SceneNode.prototype.transformPose=function(a){var b=new ROSLIB.Transform(a),c=new ROSLIB.Pose(this.pose);c.applyTransform(b),this.updatePose(c),that.visible=!0},ROS3D.Viewer=function(a){function b(){c.cameraControls.update(),c.directionalLight.position.copy(c.camera.localToWorld(new THREE.Vector3(-1,1,0))),c.directionalLight.position.normalize(),c.renderer.clear(!0,!0,!0),c.renderer.render(c.scene,c.camera),requestAnimationFrame(b)}var c=this;a=a||{};var d=a.divID,e=a.width,f=a.height,g=a.background||"#111111",h=a.antialias,i=a.intensity||.66,j=a.near||.01,k=a.far||1e3,l=a.cameraPose||{x:3,y:3,z:3},m=a.cameraZoomSpeed||2.5;this.renderer=new THREE.WebGLRenderer({antialias:h}),this.renderer.setClearColor(parseInt(g.replace("#","0x"),16),1),this.renderer.sortObjects=!1,this.renderer.setSize(e,f),this.renderer.shadowMapEnabled=!1,this.renderer.autoClear=!1,this.scene=new THREE.Scene,this.camera=new THREE.PerspectiveCamera(40,e/f,j,k),this.camera.position.set(l.x,l.y,l.z),this.cameraControls=new ROS3D.OrbitControls({scene:this.scene,camera:this.camera}),this.cameraControls.userZoomSpeed=m,this.scene.add(new THREE.AmbientLight(5592405)),this.directionalLight=new THREE.DirectionalLight(16777215,i),this.scene.add(this.directionalLight),this.selectableObjects=new THREE.Object3D,this.scene.add(this.selectableObjects);var n=new ROS3D.MouseHandler({renderer:this.renderer,camera:this.camera,rootObject:this.selectableObjects,fallbackTarget:this.cameraControls});this.highlighter=new ROS3D.Highlighter({mouseHandler:n}),document.getElementById(d).appendChild(this.renderer.domElement),b()},ROS3D.Viewer.prototype.addObject=function(a,b){b?this.selectableObjects.add(a):this.scene.add(a)},ROS3D.Viewer.prototype.resize=function(a,b){this.camera.aspect=a/b,this.camera.updateProjectionMatrix(),this.renderer.setSize(a,b)},ROS3D.Highlighter=function(a){a=a||{};var b=a.mouseHandler;this.hoverObjs=[],b.addEventListener("mouseover",this.onMouseOver.bind(this)),b.addEventListener("mouseout",this.onMouseOut.bind(this))},ROS3D.Highlighter.prototype.onMouseOver=function(a){this.hoverObjs.push(a.currentTarget)},ROS3D.Highlighter.prototype.onMouseOut=function(a){this.hoverObjs.splice(this.hoverObjs.indexOf(a.currentTarget),1)},ROS3D.Highlighter.prototype.getWebglObjects=function(a,b,c){for(var d=a.__webglObjects,e=0;e<b.length;e++)if(b[e]){for(var f=d.length-1;f>=0;f--)if(d[f].object===b[e]){c.push(d[f]);break}this.getWebglObjects(a,b[e].children,c)}},ROS3D.Highlighter.prototype.renderHighlight=function(a,b,c){var d=[];if(this.getWebglObjects(b,this.hoverObjs,d),0!==d.length){b.overrideMaterial=new THREE.MeshBasicMaterial({fog:!1,opacity:.5,depthTest:!0,depthWrite:!1,polygonOffset:!0,polygonOffsetUnits:-1,side:THREE.DoubleSide});var e=b.__webglObjects;b.__webglObjects=d,a.render(b,c),b.__webglObjects=e,b.overrideMaterial=null}},ROS3D.MouseHandler=function(a){THREE.EventDispatcher.call(this),this.renderer=a.renderer,this.camera=a.camera,this.rootObject=a.rootObject,this.fallbackTarget=a.fallbackTarget,this.lastTarget=this.fallbackTarget,this.dragging=!1;var b=["contextmenu","click","dblclick","mouseout","mousedown","mouseup","mousemove","mousewheel","DOMMouseScroll","touchstart","touchend","touchcancel","touchleave","touchmove"];this.listeners={},b.forEach(function(a){this.listeners[a]=this.processDomEvent.bind(this),this.renderer.domElement.addEventListener(a,this.listeners[a],!1)},this)},ROS3D.MouseHandler.prototype.processDomEvent=function(a){a.preventDefault();var b,c,d=a.target,e=d.getBoundingClientRect();if(-1!==a.type.indexOf("touch")){b=0,c=0;for(var f=0;f<a.touches.length;++f)b+=a.touches[f].clientX,c+=a.touches[f].clientY;b/=a.touches.length,c/=a.touches.length}else b=a.clientX,c=a.clientY;var g=b-e.left-d.clientLeft+d.scrollLeft,h=c-e.top-d.clientTop+d.scrollTop,i=g/d.clientWidth*2-1,j=-h/d.clientHeight*2+1,k=new THREE.Vector3(i,j,.5);k.unproject(this.camera);var l=new THREE.Raycaster(this.camera.position.clone(),k.sub(this.camera.position).normalize());l.linePrecision=.001;var m=l.ray,n={mousePos:new THREE.Vector2(i,j),mouseRay:m,domEvent:a,camera:this.camera,intersection:this.lastIntersection};if("mouseout"===a.type)return this.dragging&&(this.notify(this.lastTarget,"mouseup",n),this.dragging=!1),this.notify(this.lastTarget,"mouseout",n),void(this.lastTarget=null);if("touchleave"===a.type||"touchend"===a.type)return this.dragging&&(this.notify(this.lastTarget,"mouseup",n),this.dragging=!1),this.notify(this.lastTarget,"touchend",n),void(this.lastTarget=null);if(this.dragging)return this.notify(this.lastTarget,a.type,n),void(("mouseup"===a.type&&2===a.button||"click"===a.type||"touchend"===a.type)&&(this.dragging=!1));d=this.lastTarget;var o=[];if(o=l.intersectObject(this.rootObject,!0),o.length>0?(d=o[0].object,n.intersection=this.lastIntersection=o[0]):d=this.fallbackTarget,d!==this.lastTarget&&a.type.match(/mouse/)){var p=this.notify(d,"mouseover",n);p?this.notify(this.lastTarget,"mouseout",n):(d=this.fallbackTarget,d!==this.lastTarget&&(this.notify(d,"mouseover",n),this.notify(this.lastTarget,"mouseout",n)))}if(d!==this.lastTarget&&a.type.match(/touch/)){var q=this.notify(d,a.type,n);q?(this.notify(this.lastTarget,"touchleave",n),this.notify(this.lastTarget,"touchend",n)):(d=this.fallbackTarget,d!==this.lastTarget&&(this.notify(this.lastTarget,"touchmove",n),this.notify(this.lastTarget,"touchend",n)))}this.notify(d,a.type,n),("mousedown"===a.type||"touchstart"===a.type||"touchmove"===a.type)&&(this.dragging=!0),this.lastTarget=d},ROS3D.MouseHandler.prototype.notify=function(a,b,c){for(c.type=b,c.cancelBubble=!1,c.stopPropagation=function(){c.cancelBubble=!0},c.currentTarget=a;c.currentTarget;){if(c.currentTarget.dispatchEvent&&c.currentTarget.dispatchEvent instanceof Function&&(c.currentTarget.dispatchEvent(c),c.cancelBubble))return this.dispatchEvent(c),!0;c.currentTarget=c.currentTarget.parent}return!1},THREE.EventDispatcher.prototype.apply(ROS3D.MouseHandler.prototype),ROS3D.OrbitControls=function(a){function b(a){var b=a.domEvent;switch(b.preventDefault(),b.button){case 0:A=z.ROTATE,n.set(b.clientX,b.clientY);break;case 1:A=z.MOVE,u=new THREE.Vector3(0,0,1);var c=(new THREE.Matrix4).extractRotation(this.camera.matrix);u.applyMatrix4(c),t=j.center.clone(),v=j.camera.position.clone(),w=d(a.mouseRay,t,u),this.showAxes();break;case 2:A=z.ZOOM,q.set(b.clientX,b.clientY),this.showAxes()}}function c(a){var b=a.domEvent;if(A===z.ROTATE)o.set(b.clientX,b.clientY),p.subVectors(o,n),j.rotateLeft(2*Math.PI*p.x/l*j.userRotateSpeed),j.rotateUp(2*Math.PI*p.y/l*j.userRotateSpeed),n.copy(o);else if(A===z.ZOOM)r.set(b.clientX,b.clientY),s.subVectors(r,q),s.y>0?j.zoomIn():j.zoomOut(),q.copy(r),this.showAxes();else if(A===z.MOVE){var c=d(a.mouseRay,j.center,u);if(!c)return;var e=(new THREE.Vector3).subVectors(w.clone(),c.clone());j.center.addVectors(t.clone(),e.clone()),j.camera.position.addVectors(v.clone(),e.clone()),j.update(),j.camera.updateMatrixWorld(),this.showAxes()}}function d(a,b,c){var d=new THREE.Vector3,e=new THREE.Vector3;d.subVectors(b,a.origin);var f=a.direction.dot(c);if(Math.abs(f)<a.precision)return null;var g=c.dot(d)/f;return e=a.direction.clone().multiplyScalar(g)}function e(a){j.userRotate&&(A=z.NONE)}function f(a){if(j.userZoom){var b,c=a.domEvent;b="undefined"!=typeof c.wheelDelta?c.wheelDelta:-c.detail,b>0?j.zoomOut():j.zoomIn(),this.showAxes()}}function g(a){var b=a.domEvent;switch(b.touches.length){case 1:A=z.ROTATE,n.set(b.touches[0].pageX-window.scrollX,b.touches[0].pageY-window.scrollY);break;case 2:A=z.NONE,u=new THREE.Vector3(0,0,1);var c=(new THREE.Matrix4).extractRotation(this.camera.matrix);u.applyMatrix4(c),t=j.center.clone(),v=j.camera.position.clone(),w=d(a.mouseRay,t,u),x[0]=new THREE.Vector2(b.touches[0].pageX,b.touches[0].pageY),x[1]=new THREE.Vector2(b.touches[1].pageX,b.touches[1].pageY),y[0]=new THREE.Vector2(0,0),y[1]=new THREE.Vector2(0,0)}this.showAxes(),b.preventDefault()}function h(a){var b=a.domEvent;if(A===z.ROTATE)o.set(b.touches[0].pageX-window.scrollX,b.touches[0].pageY-window.scrollY),p.subVectors(o,n),j.rotateLeft(2*Math.PI*p.x/l*j.userRotateSpeed),j.rotateUp(2*Math.PI*p.y/l*j.userRotateSpeed),n.copy(o),this.showAxes();else{if(y[0].set(x[0].x-b.touches[0].pageX,x[0].y-b.touches[0].pageY),y[1].set(x[1].x-b.touches[1].pageX,x[1].y-b.touches[1].pageY),y[0].lengthSq()>m&&y[1].lengthSq()>m&&(x[0].set(b.touches[0].pageX,b.touches[0].pageY),x[1].set(b.touches[1].pageX,b.touches[1].pageY),y[0].dot(y[1])>0&&A!==z.ZOOM?A=z.MOVE:y[0].dot(y[1])<0&&A!==z.MOVE&&(A=z.ZOOM),A===z.ZOOM)){var c=new THREE.Vector2;c.subVectors(x[0],x[1]),y[0].dot(c)<0&&y[1].dot(c)>0?j.zoomOut():y[0].dot(c)>0&&y[1].dot(c)<0&&j.zoomIn()}if(A===z.MOVE){var e=d(a.mouseRay,j.center,u);if(!e)return;var f=(new THREE.Vector3).subVectors(w.clone(),e.clone());j.center.addVectors(t.clone(),f.clone()),j.camera.position.addVectors(v.clone(),f.clone()),j.update(),j.camera.updateMatrixWorld()}this.showAxes(),b.preventDefault()}}function i(a){var b=a.domEvent;1===b.touches.length&&A!==z.ROTATE?(A=z.ROTATE,n.set(b.touches[0].pageX-window.scrollX,b.touches[0].pageY-window.scrollY)):A=z.NONE}THREE.EventDispatcher.call(this);var j=this;a=a||{};var k=a.scene;this.camera=a.camera,this.center=new THREE.Vector3,this.userZoom=!0,this.userZoomSpeed=a.userZoomSpeed||1,this.userRotate=!0,this.userRotateSpeed=a.userRotateSpeed||1,this.autoRotate=a.autoRotate,this.autoRotateSpeed=a.autoRotateSpeed||2,this.camera.up=new THREE.Vector3(0,0,1);var l=1800,m=10,n=new THREE.Vector2,o=new THREE.Vector2,p=new THREE.Vector2,q=new THREE.Vector2,r=new THREE.Vector2,s=new THREE.Vector2,t=new THREE.Vector3,u=new THREE.Vector3,v=new THREE.Vector3,w=new THREE.Vector3,x=new Array(2),y=new Array(2);this.phiDelta=0,this.thetaDelta=0,this.scale=1,this.lastPosition=new THREE.Vector3;var z={NONE:-1,ROTATE:0,ZOOM:1,MOVE:2},A=z.NONE;this.axes=new ROS3D.Axes({shaftRadius:.025,headRadius:.07,headLength:.2}),k.add(this.axes),this.axes.traverse(function(a){a.visible=!1}),this.addEventListener("mousedown",b),this.addEventListener("mouseup",e),this.addEventListener("mousemove",c),this.addEventListener("touchstart",g),this.addEventListener("touchmove",h),this.addEventListener("touchend",i),this.addEventListener("mousewheel",f),this.addEventListener("DOMMouseScroll",f)},ROS3D.OrbitControls.prototype.showAxes=function(){var a=this;this.axes.traverse(function(a){a.visible=!0}),this.hideTimeout&&clearTimeout(this.hideTimeout),this.hideTimeout=setTimeout(function(){a.axes.traverse(function(a){a.visible=!1}),a.hideTimeout=!1},300)},ROS3D.OrbitControls.prototype.rotateLeft=function(a){void 0===a&&(a=2*Math.PI/60/60*this.autoRotateSpeed),this.thetaDelta-=a},ROS3D.OrbitControls.prototype.rotateRight=function(a){void 0===a&&(a=2*Math.PI/60/60*this.autoRotateSpeed),this.thetaDelta+=a},ROS3D.OrbitControls.prototype.rotateUp=function(a){void 0===a&&(a=2*Math.PI/60/60*this.autoRotateSpeed),this.phiDelta-=a},ROS3D.OrbitControls.prototype.rotateDown=function(a){void 0===a&&(a=2*Math.PI/60/60*this.autoRotateSpeed),this.phiDelta+=a},ROS3D.OrbitControls.prototype.zoomIn=function(a){void 0===a&&(a=Math.pow(.95,this.userZoomSpeed)),this.scale/=a},ROS3D.OrbitControls.prototype.zoomOut=function(a){void 0===a&&(a=Math.pow(.95,this.userZoomSpeed)),this.scale*=a},ROS3D.OrbitControls.prototype.update=function(){var a=this.camera.position,b=a.clone().sub(this.center),c=Math.atan2(b.y,b.x),d=Math.atan2(Math.sqrt(b.y*b.y+b.x*b.x),b.z);this.autoRotate&&this.rotateLeft(2*Math.PI/60/60*this.autoRotateSpeed),c+=this.thetaDelta,d+=this.phiDelta;var e=1e-6;d=Math.max(e,Math.min(Math.PI-e,d));var f=b.length();b.set(f*Math.sin(d)*Math.cos(c),f*Math.sin(d)*Math.sin(c),f*Math.cos(d)),b.multiplyScalar(this.scale),a.copy(this.center).add(b),this.camera.lookAt(this.center),f=b.length(),this.axes.position.copy(this.center),this.axes.scale.set(.05*f,.05*f,.05*f),this.axes.updateMatrixWorld(!0),this.thetaDelta=0,this.phiDelta=0,this.scale=1,this.lastPosition.distanceTo(this.camera.position)>0&&(this.dispatchEvent({type:"change"}),this.lastPosition.copy(this.camera.position))},THREE.EventDispatcher.prototype.apply(ROS3D.OrbitControls.prototype);
\ No newline at end of file
diff --git a/src/visualization/SceneNode.js b/src/visualization/SceneNode.js
index 0d3a98cf..a95548a6 100644
--- a/src/visualization/SceneNode.js
+++ b/src/visualization/SceneNode.js
@@ -35,15 +35,7 @@ ROS3D.SceneNode = function(options) {
 
   // save the TF handler so we can remove it later
   this.tfUpdate = function(msg) {
-
-    // apply the transform
-    var tf = new ROSLIB.Transform(msg);
-    var poseTransformed = new ROSLIB.Pose(that.pose);
-    poseTransformed.applyTransform(tf);
-
-    // update the world
-    that.updatePose(poseTransformed);
-    that.visible = true;
+    that.transformPose(msg);
   };
 
   // listen for TF updates
@@ -83,4 +75,5 @@ ROS3D.SceneNode.prototype.transformPose = function(transform) {
 
   // update the world
   this.updatePose(poseTransformed);
+  this.visible = true;
 };