source: flair-src/trunk/lib/FlairSimulator/src/SimuCameraGL.cpp@ 162

Last change on this file since 162 was 162, checked in by Sanahuja Guillaume, 5 years ago

modifs pb crash fin simulateur

File size: 7.7 KB
Line 
1// %flair:license{
2// This file is part of the Flair framework distributed under the
3// CECILL-C License, Version 1.0.
4// %flair:license}
5// created: 2014/03/07
6// filename: SimuCameraGL.cpp
7//
8// author: Guillaume Sanahuja
9// Copyright Heudiasyc UMR UTC/CNRS 7253
10// pbo code from Song Ho Ahn (song.ahn@gmail.com)
11//
12// version: $Id: $
13//
14// purpose: Class for a simulation camera
15//
16//
17/*********************************************************************/
18#ifdef GL
19
20#include "SimuCameraGL.h"
21#include "Model.h"
22#include <SharedMem.h>
23#include <TabWidget.h>
24#include <Tab.h>
25#include <DoubleSpinBox.h>
26#include <Vector3DSpinBox.h>
27#include <Gui.h>
28#include <Euler.h>
29
30#include <ISceneManager.h>
31#include <ICameraSceneNode.h>
32#include <IVideoDriver.h>
33
34#define PBO_COUNT 2
35
36using namespace irr;
37using namespace irr::scene;
38using namespace irr::core;
39using namespace flair::core;
40using namespace flair::gui;
41using namespace flair::simulator;
42
43namespace flair {
44namespace sensor {
45
46SimuCameraGL::SimuCameraGL(const Model *parent, std::string name, int width,
47 int height, int x, int y, uint32_t modelId,uint32_t deviceId)
48 : SimuCamera(parent, name, width, height, 3, modelId,deviceId), SensorGL(parent) {
49 smgr = getGui()->getSceneManager();
50 camera = smgr->addCameraSceneNode();
51 camera->addAnimator(this);
52 camera->setAspectRatio((float)width /(float)height); // on force a cause du view port
53
54 this->width = width;
55 this->height = height;
56 this->x = x;
57 this->y = y;
58
59 index = 0;
60
61 // user interface
62 Tab *setup_tab = new Tab(parent->GetTabWidget(), name);
63 position = new Vector3DSpinBox(setup_tab->NewRow(), "position", -2, 2, .01);
64 direction = new Vector3DSpinBox(setup_tab->NewRow(), "direction", -2, 2, .01);
65 up = new Vector3DSpinBox(setup_tab->NewRow(), "up", -2, 2, .01);
66 fov = new DoubleSpinBox(setup_tab->NewRow(), "fov:", 0, 180, 5);
67
68 if (strcmp((char *)glGetString(GL_VENDOR),
69 "Intel Open Source Technology Center") == 0) {
70 //Thread::Warn("disabling cameras output for Intel card (bug with PBO)\n");
71 Thread::Warn("camera output for Intel card may have bugs with PBO\n");
72 //disable_output = true;
73 disable_output = false;
74 } else {
75 disable_output = false;
76 }
77
78 if (isGlExtensionSupported("GL_ARB_pixel_buffer_object")) {
79 use_pbo = true;
80 // create 2 pixel buffer objects, you need to delete them when program
81 // exits.
82 // glBufferDataARB with NULL pointer reserves only memory space.
83 pboIds = (GLuint *)malloc(PBO_COUNT * sizeof(GLuint));
84 glGenBuffersARB(PBO_COUNT, pboIds);
85 glBindBufferARB(GL_PIXEL_PACK_BUFFER_ARB, pboIds[0]);
86 glBufferDataARB(GL_PIXEL_PACK_BUFFER_ARB, width * height * 3+sizeof(Time), 0,
87 GL_STREAM_READ_ARB);
88 glBindBufferARB(GL_PIXEL_PACK_BUFFER_ARB, pboIds[1]);
89 glBufferDataARB(GL_PIXEL_PACK_BUFFER_ARB, width * height * 3+sizeof(Time), 0,
90 GL_STREAM_READ_ARB);
91
92 glBindBufferARB(GL_PIXEL_PACK_BUFFER_ARB, 0);
93 } else {
94 use_pbo = false;
95 buffer = (char *)malloc(width * height * 3+sizeof(Time));
96 Thread::Warn("GL_ARB_pixel_buffer_object is not suppoorted\n");
97 }
98 if (isGlExtensionSupported("GL_PACK_INVERT_MESA")) {
99 invert_pixel = false;
100 Thread::Warn("GL_PACK_INVERT_MESA is suppoorted\n");
101 } else {
102 invert_pixel = true;
103 }
104}
105
106SimuCameraGL::~SimuCameraGL() {
107 if (use_pbo) {
108 glDeleteBuffersARB(PBO_COUNT, pboIds);
109 free(pboIds);
110 } else {
111 free(buffer);
112 }
113 camera->removeAnimator(this);
114 camera->drop();
115}
116
117void SimuCameraGL::setNearValue(float zn) { camera->setNearValue(zn); }
118
119void SimuCameraGL::setFarValue(float zf) { camera->setFarValue(zf); }
120
121void SimuCameraGL::UpdateFrom(const io_data *data) {
122 if (noGui() == false && data == NULL) {
123 smgr->setActiveCamera(camera);
124 smgr->getVideoDriver()->setViewPort(rect<s32>(x, y, x + width, y + height));
125 smgr->drawAll();
126 // use_pbo=false;
127 getImage();
128 }
129}
130
131void SimuCameraGL::getImage(void) {
132 if (disable_output)
133 return;
134 // convert from irrlicht top left origin to gl bottom left origin
135 int y = smgr->getVideoDriver()->getScreenSize().Height - height - this->y;
136
137 // We want to read the front buffer to get the latest render finished.
138 Time a = GetTime();
139 glReadBuffer(GL_FRONT);
140 if (use_pbo) // with PBO
141 {
142 // increment current index first then get the next index
143 // "index" is used to read pixels from a framebuffer to a PBO
144 // "nextIndex" is used to process pixels in the other PBO
145 index = (index + 1) % PBO_COUNT;
146 int nextIndex = (index + 1) % PBO_COUNT;
147
148 // copy pixels from framebuffer to PBO
149 // Use offset instead of pointer.
150 // OpenGL should perform asynch DMA transfer, so glReadPixels() will return
151 // immediately.
152 glBindBufferARB(GL_PIXEL_PACK_BUFFER_ARB, pboIds[index]);
153 glReadPixels(x, y, width, height, GL_BGR, GL_UNSIGNED_BYTE, 0);
154 Time time=GetTime();
155 // map the PBO that contain framebuffer pixels before processing it
156 glBindBufferARB(GL_PIXEL_PACK_BUFFER_ARB, pboIds[nextIndex]);
157 GLubyte *src = (GLubyte *)glMapBufferARB(
158 GL_PIXEL_PACK_BUFFER_ARB, GL_READ_WRITE_ARB); // GL_READ_ONLY_ARB);
159 if (src) {
160 putImage((char *)src,time);
161 glUnmapBufferARB(
162 GL_PIXEL_PACK_BUFFER_ARB); // release pointer to the mapped buffer
163 }
164 glBindBufferARB(GL_PIXEL_PACK_BUFFER_ARB, 0);
165 } else {
166 glReadPixels(x, y, width, height, GL_BGR, GL_UNSIGNED_BYTE, buffer);
167 putImage(buffer,GetTime());
168 }
169
170 glReadBuffer(GL_BACK);
171 Time b = GetTime();
172 Time c = b - a;
173 // printf("%s %f\n",Thread::ObjectName().c_str(),(float)(c/1000000.));
174}
175
176void SimuCameraGL::putImage(char *buf,Time imageTime) {
177 if (invert_pixel == true) {
178 // opengl images are horizontally flipped, so we have to fix that here.
179 const s32 pitch = width * 3;
180 char *pixels = buf;
181 char *p2 = pixels + (height - 1) * pitch;
182 char *tmpBuffer = new char[pitch];
183 for (int i = 0; i < height; i += 2) {
184 memcpy(tmpBuffer, pixels, pitch);
185 memcpy(pixels, p2, pitch);
186 memcpy(p2, tmpBuffer, pitch);
187 pixels += pitch;
188 p2 -= pitch;
189 }
190 delete[] tmpBuffer;
191 }
192 memcpy(buf+width * height * 3,&imageTime,sizeof(Time));
193 shmem->Write(buf, width * height * 3+sizeof(Time));
194}
195
196void SimuCameraGL::animateNode(ISceneNode *node, u32 timeMs) {
197 ICameraSceneNode *camera = static_cast<ICameraSceneNode *>(node);
198
199 matrix4 m;
200 m.setRotationDegrees(Node()->getRotation());
201
202 // transform forward vector of camera
203 vector3df frv = ToIrrlichtCoordinates(direction->Value());
204 m.transformVect(frv);
205
206 // transform upvector of camera
207 vector3df upv = ToIrrlichtCoordinates(up->Value());
208 m.transformVect(upv);
209
210 // transform camera offset (thanks to Zeuss for finding it was missing)
211 vector3df offset = ToIrrlichtCoordinates(position->Value());
212 m.transformVect(offset);
213
214 // set camera
215 camera->setPosition(Node()->getPosition() +
216 offset); // position camera in front of the ship
217 camera->setUpVector(upv); // set up vector of camera >> Zeuss - tested with
218 // +node->getPostion() and it didnt work, but this
219 // works fine.
220 camera->setTarget(Node()->getPosition() + offset + frv); // set target of
221 // camera (look at
222 // point) >> Zeuss -
223 // Dont forget to add
224 // the node positiob
225
226 camera->setFOV(Euler::ToRadian(fov->Value()));
227}
228
229ISceneNodeAnimator *SimuCameraGL::createClone(ISceneNode *node,
230 ISceneManager *newManager) {
231 return NULL;
232}
233
234} // end namespace sensor
235} // end namespace flair
236#endif
Note: See TracBrowser for help on using the repository browser.