Changeset 288 in flair-src for trunk/lib/FlairSimulator/src/VisualizationCamera.cpp

Timestamp:

01/08/19 14:45:15 (5 years ago)

Author:

Sanahuja Guillaume

Message:

added earth frame axis

File:

• trunk/lib/FlairSimulator/src/VisualizationCamera.cpp (modified) (3 diffs)

trunk/lib/FlairSimulator/src/VisualizationCamera.cpp

@@ -27 +27 @@
 #include <IrrlichtDevice.h>
 #include <ISceneManager.h>
+#include <IGUIEnvironment.h>
+#include <IGUIFont.h>
 
 using namespace irr;
@@ -36 +38 @@
 namespace flair {
 namespace simulator {
+
+class AxisSceneNode: public ISceneNode {
+    public:
+      AxisSceneNode(ISceneManager *axis_scenemanager):ISceneNode(axis_scenemanager->getRootSceneNode(), axis_scenemanager, -1) {
+        //draw ned axis
+        IAnimatedMesh* arrowMeshRed = axis_scenemanager->addArrowMesh( "x_axisArrow",video::SColor(255, 255, 0, 0),video::SColor(255, 255, 0, 0));
+        nodeX = axis_scenemanager->addMeshSceneNode(arrowMeshRed,this);
+        nodeX->setMaterialFlag(video::EMF_LIGHTING, false);
+        nodeX->setRotation(vector3df(0,0,-90));//use vrpn yaw rotation from earth
+        nodeX->setScale(vector3df(1,3,1));
+        
+        IAnimatedMesh* arrowMeshGreen = axis_scenemanager->addArrowMesh( "y_axisArrow",video::SColor(255, 0, 255, 0),video::SColor(255, 0, 255, 0));
+        nodeY = axis_scenemanager->addMeshSceneNode(arrowMeshGreen,this);
+        nodeY->setMaterialFlag(video::EMF_LIGHTING, false);
+        nodeY->setScale(vector3df(1,3,1));
+        
+        IAnimatedMesh* arrowMeshBlue = axis_scenemanager->addArrowMesh( "z_axisArrow",video::SColor(255, 0, 0, 255),video::SColor(255, 0, 0, 255));
+        nodeZ = axis_scenemanager->addMeshSceneNode(arrowMeshBlue,this);
+        nodeZ->setMaterialFlag(video::EMF_LIGHTING, false);
+        nodeZ->setRotation(vector3df(-90,0,0));//irrlicht is left handed, draw a right handed axis
+        nodeZ->setScale(vector3df(1,3,1));  
+      }
+      
+      void render(void) {
+        IVideoDriver *driver = SceneManager->getVideoDriver();
+        driver->setTransform(ETS_WORLD, AbsoluteTransformation);
+      }
+
+      void OnRegisterSceneNode(void) {
+        if (IsVisible)
+          SceneManager->registerNodeForRendering(this);
+
+        ISceneNode::OnRegisterSceneNode();
+      }
+      
+      const aabbox3d<f32> &getBoundingBox(void) const {
+        return box;
+      }
+      
+    private:
+      aabbox3d<f32> box;
+      ISceneNode *nodeX,*nodeY,*nodeZ;
+};
 
 VisualizationCamera::VisualizationCamera(std::string inName) {
@@ -54 +99 @@
   axis_scenemanager=getGui()->getSceneManager()->createNewSceneManager();
   axis_camera= axis_scenemanager->addCameraSceneNode();
-  axis_camera->setAspectRatio(1);  // same as texture ratio, TODO: get it from texture in renderAxisToTexture
   axis_camera->setUpVector(vector3df(0, 0, 1));
   axis_camera->setFOV(PI / 2.5f);
   axis_scenemanager->setActiveCamera(axis_camera);
   
-  //draw ned axis
-  IAnimatedMesh* arrowMeshRed = axis_scenemanager->addArrowMesh( "x_axisArrow",video::SColor(255, 255, 0, 0),video::SColor(255, 255, 0, 0));
-  nodeX = axis_scenemanager->addMeshSceneNode(arrowMeshRed);
-  nodeX->setMaterialFlag(video::EMF_LIGHTING, false);
-  nodeX->setRotation(vector3df(0,0,-90+core::Euler::ToDegree(getSimulator()->Yaw())));//use vrpn yaw rotation from earth
-  nodeX->setScale(vector3df(1,3,1));
-  
-  IAnimatedMesh* arrowMeshGreen = axis_scenemanager->addArrowMesh( "y_axisArrow",video::SColor(255, 0, 255, 0),video::SColor(255, 0, 255, 0));
-  nodeY = axis_scenemanager->addMeshSceneNode(arrowMeshGreen);
-  nodeY->setMaterialFlag(video::EMF_LIGHTING, false);
-  nodeY->setRotation(vector3df(0,0,core::Euler::ToDegree(getSimulator()->Yaw())));//use vrpn yaw rotation from earth
-  nodeY->setScale(vector3df(1,3,1));
-  
-  IAnimatedMesh* arrowMeshBlue = axis_scenemanager->addArrowMesh( "z_axisArrow",video::SColor(255, 0, 0, 255),video::SColor(255, 0, 0, 255));
-  nodeZ = axis_scenemanager->addMeshSceneNode(arrowMeshBlue);
-  nodeZ->setMaterialFlag(video::EMF_LIGHTING, false);
-  nodeZ->setRotation(vector3df(-90,0,0));//irrlicht is left handed, draw a right handed axis
-  nodeZ->setScale(vector3df(1,3,1));
+  vrpnSceneNode=new AxisSceneNode(axis_scenemanager);
+  vrpnSceneNode->setRotation(vector3df(0,0,core::Euler::ToDegree(getSimulator()->Yaw())));//use vrpn yaw rotation from earth
+  earthSceneNode=new AxisSceneNode(axis_scenemanager);
 }
 
 VisualizationCamera::~VisualizationCamera() {}
 
-void VisualizationCamera::renderAxisToTexture(ITexture* texture) {
+
+void VisualizationCamera::renderAxisToTexture(ITexture* texture,IGUIFont *font,AxisType axisType) {
   //put axis at a "normalized" distance
   vector3df direction=camera->getTarget()-camera->getPosition();
   direction.normalize();
-  nodeX->setPosition(camera->getPosition()+direction*6);
-  nodeY->setPosition(camera->getPosition()+direction*6);
-  nodeZ->setPosition(camera->getPosition()+direction*6);
-
+  vrpnSceneNode->setPosition(camera->getPosition()+direction*6);
+  earthSceneNode->setPosition(camera->getPosition()+direction*6);
+  
+  stringw axisText;
+  switch(axisType) {
+    case AxisType::vrpn:
+      vrpnSceneNode->setVisible(true);
+      earthSceneNode->setVisible(false);
+      axisText="VRPN";
+      break;
+    case AxisType::earth:
+      vrpnSceneNode->setVisible(false);
+      earthSceneNode->setVisible(true);
+      axisText="earth";
+      break;
+    case AxisType::none:
+      vrpnSceneNode->setVisible(false);
+      earthSceneNode->setVisible(false);
+      break;
+  }
+  
   axis_camera->setPosition(camera->getPosition());
   axis_camera->setRotation(camera->getRotation());
   axis_camera->setTarget(camera->getTarget());
+  axis_camera->setAspectRatio((float)(texture->getSize().Width)/(float)(texture->getSize().Height));  // same as texture ratio
+
   
   axis_scenemanager->getVideoDriver()->setRenderTarget(texture, true, true, SColor(0,0,0,0));
   axis_scenemanager->drawAll();
+  
+  if(font && axisType!=AxisType::none) {
+    font->draw(axisText,rect<s32>(10,texture->getSize().Height-25,texture->getSize().Width,texture->getSize().Height),SColor(255,255,255,255));
+    font->draw("X",rect<s32>(60,texture->getSize().Height-25,texture->getSize().Width,texture->getSize().Height),SColor(255,255,0,0));
+    font->draw("Y",rect<s32>(70,texture->getSize().Height-25,texture->getSize().Width,texture->getSize().Height),SColor(255,0,255,0));
+    font->draw("Z",rect<s32>(80,texture->getSize().Height-25,texture->getSize().Width,texture->getSize().Height),SColor(255,0,0,255));
+    getGui()->getDevice()->getGUIEnvironment()->drawAll();
+  }
+  
   axis_scenemanager->getVideoDriver()->setRenderTarget(0, true, true, 0);
 }