CoordsysNode.cc 20.7 KB
Newer Older
Jan Möbius's avatar
Jan Möbius committed
1 2 3
/*===========================================================================*\
 *                                                                           *
 *                              OpenFlipper                                  *
Jan Möbius's avatar
Jan Möbius committed
4
 *      Copyright (C) 2001-2011 by Computer Graphics Group, RWTH Aachen      *
Jan Möbius's avatar
Jan Möbius committed
5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36
 *                           www.openflipper.org                             *
 *                                                                           *
 *---------------------------------------------------------------------------*
 *  This file is part of OpenFlipper.                                        *
 *                                                                           *
 *  OpenFlipper is free software: you can redistribute it and/or modify      *
 *  it under the terms of the GNU Lesser General Public License as           *
 *  published by the Free Software Foundation, either version 3 of           *
 *  the License, or (at your option) any later version with the              *
 *  following exceptions:                                                    *
 *                                                                           *
 *  If other files instantiate templates or use macros                       *
 *  or inline functions from this file, or you compile this file and         *
 *  link it with other files to produce an executable, this file does        *
 *  not by itself cause the resulting executable to be covered by the        *
 *  GNU Lesser General Public License. This exception does not however       *
 *  invalidate any other reasons why the executable file might be            *
 *  covered by the GNU Lesser General Public License.                        *
 *                                                                           *
 *  OpenFlipper is distributed in the hope that it will be useful,           *
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of           *
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the            *
 *  GNU Lesser General Public License for more details.                      *
 *                                                                           *
 *  You should have received a copy of the GNU LesserGeneral Public          *
 *  License along with OpenFlipper. If not,                                  *
 *  see <http://www.gnu.org/licenses/>.                                      *
 *                                                                           *
\*===========================================================================*/

/*===========================================================================*\
 *                                                                           *
Jan Möbius's avatar
Jan Möbius committed
37
 *   $Revision$                                                       *
Jan Möbius's avatar
Jan Möbius committed
38 39 40 41
 *   $Author$                                                      *
 *   $Date$                   *
 *                                                                           *
\*===========================================================================*/
Jan Möbius's avatar
 
Jan Möbius committed
42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70




//=============================================================================
//
//  CLASS CoordsysNode - IMPLEMENTATION
//
//=============================================================================

//== INCLUDES =================================================================

#include "CoordsysNode.hh"
#include "../GL/gl.hh"
#include <iostream>
#include <math.h>


//== NAMESPACES ===============================================================

namespace ACG {
namespace SceneGraph {


//== IMPLEMENTATION ==========================================================


void
CoordsysNode::
71
boundingBox(Vec3d& /*_bbMin*/, Vec3d& /*_bbMax*/)
Jan Möbius's avatar
 
Jan Möbius committed
72 73 74 75 76 77 78 79
{
	//_bbMin.minimize( Vect3f  )
}


//----------------------------------------------------------------------------


Jan Möbius's avatar
Jan Möbius committed
80
DrawModes::DrawMode
Jan Möbius's avatar
 
Jan Möbius committed
81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109
CoordsysNode::
availableDrawModes() const
{
  return ( DrawModes::POINTS |
	        DrawModes::POINTS_SHADED |
	        DrawModes::POINTS_COLORED );
}


//----------------------------------------------------------------------------

void
CoordsysNode::
drawCoordsys( GLState&  _state) {

  double topRadius = 0.01;
  double arrowLength = 0.04;
  double bodyRadius = 0.004;
  double bodyLength = 0.06;
  int slices = 10;
  int stacks = 10;
  int loops = 10;
  double sphereRadius = 0.01;

  GLUquadricObj *quadric = gluNewQuadric();

  // Origin
  glColor3f(0.5, 0.5, 0.5);
  gluSphere( quadric, sphereRadius, slices, stacks );
110
  
Jan Möbius's avatar
 
Jan Möbius committed
111 112
  // X-Axis
  glColor3f(1.0, 0.0, 0.0);
Jan Möbius's avatar
Dennis:  
Jan Möbius committed
113 114 115
  _state.push_modelview_matrix ();
  _state.rotate (-90, 0, 1, 0);
  _state.translate ( 0, 0, -bodyLength );
Jan Möbius's avatar
 
Jan Möbius committed
116 117
  gluCylinder( quadric, bodyRadius, bodyRadius, bodyLength, slices, stacks );
  gluDisk( quadric, 0, topRadius, slices, loops );
Jan Möbius's avatar
Dennis:  
Jan Möbius committed
118
  _state.translate ( 0, 0, -arrowLength );
Jan Möbius's avatar
 
Jan Möbius committed
119
  gluCylinder( quadric, 0, topRadius, arrowLength, slices, stacks );
Jan Möbius's avatar
Dennis:  
Jan Möbius committed
120
  _state.pop_modelview_matrix ();
Jan Möbius's avatar
 
Jan Möbius committed
121 122 123

  // Y-Axis
  glColor3f(0.0, 1.0, 0.0);
Jan Möbius's avatar
Dennis:  
Jan Möbius committed
124 125 126
  _state.push_modelview_matrix ();
  _state.rotate (90, 1, 0, 0);
  _state.translate ( 0, 0, -bodyLength );
Jan Möbius's avatar
 
Jan Möbius committed
127 128
  gluCylinder( quadric, bodyRadius, bodyRadius, bodyLength, slices, stacks );
  gluDisk( quadric, 0, topRadius, slices, loops );
Jan Möbius's avatar
Dennis:  
Jan Möbius committed
129
  _state.translate ( 0, 0, -arrowLength );
Jan Möbius's avatar
 
Jan Möbius committed
130
  gluCylinder( quadric, 0, topRadius, arrowLength, slices, stacks );
Jan Möbius's avatar
Dennis:  
Jan Möbius committed
131
  _state.pop_modelview_matrix ();
Jan Möbius's avatar
 
Jan Möbius committed
132 133 134

  // Z-Axis
  glColor3f(0.0, 0.0, 1.0);
Jan Möbius's avatar
Dennis:  
Jan Möbius committed
135 136 137
  _state.push_modelview_matrix ();
  _state.rotate (180, 0, 1, 0);
  _state.translate ( 0, 0, -bodyLength );
Jan Möbius's avatar
 
Jan Möbius committed
138 139
  gluCylinder( quadric, bodyRadius, bodyRadius, bodyLength, slices, stacks );
  gluDisk( quadric, 0, topRadius, slices, loops );
Jan Möbius's avatar
Dennis:  
Jan Möbius committed
140
  _state.translate ( 0, 0, -arrowLength );
Jan Möbius's avatar
 
Jan Möbius committed
141
  gluCylinder( quadric, 0, topRadius, arrowLength, slices, stacks );
Jan Möbius's avatar
Dennis:  
Jan Möbius committed
142
  _state.pop_modelview_matrix ();
Jan Möbius's avatar
 
Jan Möbius committed
143 144 145 146 147 148 149 150 151

  gluDeleteQuadric(quadric);
}

//============================================================================

void
CoordsysNode::drawCoordsysPick( GLState&  _state) {

Jan Möbius's avatar
Dennis:  
Jan Möbius committed
152 153 154 155 156 157 158 159
  double topRadius = 0.01;
  double arrowLength = 0.04;
  double bodyRadius = 0.004;
  double bodyLength = 0.06;
  int slices = 10;
  int stacks = 10;
  int loops = 10;
  double sphereRadius = 0.01;
Jan Möbius's avatar
 
Jan Möbius committed
160

Jan Möbius's avatar
Dennis:  
Jan Möbius committed
161
  GLUquadricObj *quadric = gluNewQuadric();
Jan Möbius's avatar
 
Jan Möbius committed
162 163

  // Origin
Jan Möbius's avatar
Dennis:  
Jan Möbius committed
164 165
  _state.pick_set_name (1);
  gluSphere( quadric, sphereRadius, slices, stacks );
Jan Möbius's avatar
 
Jan Möbius committed
166 167

  // X-Axis
Jan Möbius's avatar
Dennis:  
Jan Möbius committed
168 169 170 171 172 173 174 175 176
  _state.pick_set_name (2);
  _state.push_modelview_matrix ();
  _state.rotate (-90, 0, 1, 0);
  _state.translate ( 0, 0, -bodyLength );
  gluCylinder( quadric, bodyRadius, bodyRadius, bodyLength, slices, stacks );
  gluDisk( quadric, 0, topRadius, slices, loops );
  _state.translate ( 0, 0, -arrowLength );
  gluCylinder( quadric, 0, topRadius, arrowLength, slices, stacks );
  _state.pop_modelview_matrix ();
Jan Möbius's avatar
 
Jan Möbius committed
177 178

  // Y-Axis
Jan Möbius's avatar
Dennis:  
Jan Möbius committed
179 180 181 182 183 184 185 186 187
  _state.pick_set_name (3);
  _state.push_modelview_matrix ();
  _state.rotate (90, 1, 0, 0);
  _state.translate ( 0, 0, -bodyLength );
  gluCylinder( quadric, bodyRadius, bodyRadius, bodyLength, slices, stacks );
  gluDisk( quadric, 0, topRadius, slices, loops );
  _state.translate ( 0, 0, -arrowLength );
  gluCylinder( quadric, 0, topRadius, arrowLength, slices, stacks );
  _state.pop_modelview_matrix ();
Jan Möbius's avatar
 
Jan Möbius committed
188 189

  // Z-Axis
Jan Möbius's avatar
Dennis:  
Jan Möbius committed
190 191 192 193 194 195 196 197 198 199 200 201
  _state.pick_set_name (4);
  _state.push_modelview_matrix ();
  _state.rotate (180, 0, 1, 0);
  _state.translate ( 0, 0, -bodyLength );
  gluCylinder( quadric, bodyRadius, bodyRadius, bodyLength, slices, stacks );
  gluDisk( quadric, 0, topRadius, slices, loops );
  _state.translate ( 0, 0, -arrowLength );
  gluCylinder( quadric, 0, topRadius, arrowLength, slices, stacks );
  _state.pop_modelview_matrix ();


  gluDeleteQuadric(quadric);
Jan Möbius's avatar
 
Jan Möbius committed
202 203 204 205 206 207 208 209 210

}


//============================================================================


void
CoordsysNode::
Jan Möbius's avatar
Jan Möbius committed
211
draw(GLState&  _state  , DrawModes::DrawMode /*_drawMode*/)
Jan Möbius's avatar
 
Jan Möbius committed
212
{
213 214
  GLenum prev_depth = _state.depthFunc();
    
Jan Möbius's avatar
Dennis:  
Jan Möbius committed
215 216 217
  GLboolean colorMask[4];
  glGetBooleanv (GL_COLOR_WRITEMASK, colorMask);
  
Jan Möbius's avatar
 
Jan Möbius committed
218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234
  // Push Modelview-Matrix
  _state.push_modelview_matrix();

  Vec4f lastBaseColor = _state.base_color();

  glPushAttrib( GL_LIGHTING_BIT ); // STACK_ATTRIBUTES <- LIGHTING_ATTRIBUTE
  glEnable(GL_LIGHTING);
  glColorMaterial ( GL_FRONT_AND_BACK, GL_AMBIENT_AND_DIFFUSE ) ;
  glEnable(GL_COLOR_MATERIAL);
  glShadeModel(GL_SMOOTH);

  // Init state - changes when mode_ != POSITION
  Vec3d pos3D(0.0,0.0,0.0);

  if ( mode_ == SCREENPOS ) {

    int left, bottom, width, height;
235
    double aspect = _state.aspect();
236

Jan Möbius's avatar
 
Jan Möbius committed
237 238 239 240
    _state.get_viewport(left, bottom, width, height);

    // Projection reset
    _state.push_projection_matrix();
Jan Möbius's avatar
Dennis:  
Jan Möbius committed
241
    _state.reset_projection();
Jan Möbius's avatar
 
Jan Möbius committed
242

243 244 245
    if (projectionMode_ == PERSPECTIVE_PROJECTION)
        _state.perspective(45.0, aspect, 0.8, 20.0);
    else
246
        _state.ortho(-0.65*aspect, 0.65*aspect, -0.65, 0.65, 0.8, 20.0);
Jan Möbius's avatar
 
Jan Möbius committed
247

Jan Möbius's avatar
Dennis:  
Jan Möbius committed
248 249
    _state.push_modelview_matrix();
    _state.reset_modelview();
Jan Möbius's avatar
 
Jan Möbius committed
250

251 252 253 254 255 256
    float rel_size = 50.0;
    float projdist = sqrt ( (width*height) / rel_size );

    float posx = left + width - projdist ;
    float posy = bottom + height - projdist ;

257
    // get our desired coordsys position in scene coordinates
Jan Möbius's avatar
Dennis:  
Jan Möbius committed
258 259
    pos3D = _state.unproject (Vec3d (posx, posy, 0.5));
    _state.pop_modelview_matrix();
Jan Möbius's avatar
 
Jan Möbius committed
260

Jan Möbius's avatar
Dennis:  
Jan Möbius committed
261
    // reset scene translation
262
    // we want only the scene rotation to rotate the coordsys
Jan Möbius's avatar
Dennis:  
Jan Möbius committed
263
    GLMatrixd modelview = _state.modelview();
Jan Möbius's avatar
 
Jan Möbius committed
264

Jan Möbius's avatar
Dennis:  
Jan Möbius committed
265 266 267
    modelview(0,3) = 0.0;
    modelview(1,3) = 0.0;
    modelview(2,3) = 0.0;
Jan Möbius's avatar
 
Jan Möbius committed
268

Jan Möbius's avatar
Dennis:  
Jan Möbius committed
269
    _state.set_modelview (modelview);
270
    _state.translate (pos3D[0], pos3D[1], pos3D[2], MULT_FROM_LEFT);
Jan Möbius's avatar
 
Jan Möbius committed
271

272 273

    // clear the depth buffer behind the coordsys
274 275 276 277
    glDepthRange (1.0, 1.0);
    glDepthFunc (GL_ALWAYS);

    drawCoordsys(_state);
278

279 280
    glDepthRange (0.0, 1.0);
    glDepthFunc (GL_LESS);
Jan Möbius's avatar
Dennis:  
Jan Möbius committed
281

282
    // draw coordsys
Jan Möbius's avatar
 
Jan Möbius committed
283 284
    drawCoordsys(_state);

285
    // set depth buffer to 0 so that nothing can paint over cordsys
286 287 288
    glDepthRange (0.0, 0.0);
    glDepthFunc (GL_ALWAYS);
    glColorMask(GL_FALSE,GL_FALSE,GL_FALSE,GL_FALSE);
289

290 291 292 293
    // Koordinatensystem zeichnen
    drawCoordsys(_state);

    glDepthRange (0.0, 1.0);
294
    glDepthFunc (prev_depth);
Jan Möbius's avatar
Dennis:  
Jan Möbius committed
295
    glColorMask (colorMask[0], colorMask[1], colorMask[2], colorMask[3]);
296

Jan Möbius's avatar
 
Jan Möbius committed
297 298
    // Projection reload
    _state.pop_projection_matrix();
Jan Möbius's avatar
Dennis:  
Jan Möbius committed
299

Jan Möbius's avatar
 
Jan Möbius committed
300 301 302

  } else if (mode_ == POSITION) { /* mode_ == POSITION */

Jan Möbius's avatar
Dennis:  
Jan Möbius committed
303 304 305 306 307 308 309
    GLMatrixd modelview = _state.modelview();

    modelview(0,3) = 0.0;
    modelview(1,3) = 0.0;
    modelview(2,3) = 0.0;

    _state.set_modelview (modelview);
Jan Möbius's avatar
Dennis:  
Jan Möbius committed
310

311 312 313 314 315 316 317 318 319 320
    // clear depth buffer in coordsys region
    glDepthRange (1.0, 1.0);
    glDepthFunc (GL_ALWAYS);

    // Koordinatensystem zeichnen
    drawCoordsys(_state);

    // draw coordsys in normal mode
    glDepthRange (0.0, 1.0);
    glDepthFunc (GL_LESS);
321

322
    // Koordinatensystem zeichnen
Jan Möbius's avatar
 
Jan Möbius committed
323 324
    drawCoordsys(_state);

325
    // set depth buffer to 0 so that nothing can paint over cordsys
326 327 328 329 330 331
    glDepthRange (0.0, 0.0);
    glDepthFunc (GL_ALWAYS);
    glColorMask(GL_FALSE,GL_FALSE,GL_FALSE,GL_FALSE);

    // Koordinatensystem zeichnen
    drawCoordsys(_state);
332

333 334
    // reset to default
    glDepthRange (0.0, 1.0);
335
    glDepthFunc (prev_depth);
Jan Möbius's avatar
Dennis:  
Jan Möbius committed
336
    glColorMask (colorMask[0], colorMask[1], colorMask[2], colorMask[3]);
Jan Möbius's avatar
 
Jan Möbius committed
337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354
  }

  glPopAttrib();

  glColor4fv(lastBaseColor.data());

  // Reload old configuration
  _state.pop_modelview_matrix();
}


void
CoordsysNode::
setMode(const CoordsysMode _mode)
{
  mode_ = _mode;
}

355 356 357 358 359 360 361
void
CoordsysNode::
setProjectionMode(const ProjectionMode _mode)
{
  projectionMode_ = _mode;
}

Jan Möbius's avatar
 
Jan Möbius committed
362 363 364 365 366 367 368 369 370 371 372 373 374 375
void
CoordsysNode::
setPosition(const Vec3f& _pos)
{
  pos3f_ = _pos;
}

CoordsysNode::CoordsysMode
CoordsysNode::
getMode() const
{
  return mode_;
}

376 377 378 379 380 381 382
CoordsysNode::ProjectionMode
CoordsysNode::
getProjectionMode() const
{
  return projectionMode_;
}

Jan Möbius's avatar
 
Jan Möbius committed
383 384 385
void
CoordsysNode::pick(GLState& _state, PickTarget _target)
{
386 387
  GLenum prev_depth = _state.depthFunc();  
    
Jan Möbius's avatar
Jan Möbius committed
388 389
  if (_target == PICK_ANYTHING) {

Jan Möbius's avatar
Jan Möbius committed
390 391
    GLdouble mat[16];

Jan Möbius's avatar
 
Jan Möbius committed
392
    // Push Modelview-Matrix
Jan Möbius's avatar
Jan Möbius committed
393
    _state.push_modelview_matrix();
Jan Möbius's avatar
Dennis:  
Jan Möbius committed
394
    _state.pick_set_maximum (5);
Jan Möbius's avatar
Dennis:  
Jan Möbius committed
395
    _state.pick_set_name (0);
Jan Möbius's avatar
 
Jan Möbius committed
396 397

    // Init state - changes when mode_ != POSITION
Jan Möbius's avatar
Jan Möbius committed
398
    Vec3d pos3D(0.0,0.0,0.0);
Jan Möbius's avatar
 
Jan Möbius committed
399

Jan Möbius's avatar
Jan Möbius committed
400
    if ( mode_ == SCREENPOS ) {
Jan Möbius's avatar
 
Jan Möbius committed
401

Jan Möbius's avatar
Jan Möbius committed
402
      int left, bottom, width, height;
403
      double aspect = _state.aspect();
404

Jan Möbius's avatar
Jan Möbius committed
405
      _state.get_viewport(left, bottom, width, height);
406
      
Jan Möbius's avatar
Jan Möbius committed
407 408
      // Projection reset
      _state.push_projection_matrix();
Jan Möbius's avatar
Dennis:  
Jan Möbius committed
409
      _state.reset_projection();
Jan Möbius's avatar
 
Jan Möbius committed
410

411 412 413
      if (projectionMode_ == PERSPECTIVE_PROJECTION)
        _state.perspective(45.0, aspect, 0.8, 20.0);
      else
414
        _state.ortho(-0.65*aspect, 0.65*aspect, -0.65, 0.65, 0.8, 20.0);
Jan Möbius's avatar
 
Jan Möbius committed
415

Jan Möbius's avatar
Dennis:  
Jan Möbius committed
416 417
      _state.push_modelview_matrix();
      _state.reset_modelview();
Jan Möbius's avatar
 
Jan Möbius committed
418

419 420 421 422 423 424 425
      float rel_size = 50.0;
      float projdist = sqrt ( (width*height) / rel_size );

      float posx = left + width - projdist ;
      float posy = bottom + height - projdist ;

      // get our desired coordsys position in scene coordinates
Jan Möbius's avatar
Dennis:  
Jan Möbius committed
426 427
      pos3D = _state.unproject (Vec3d (posx, posy, 0.5));
      _state.pop_modelview_matrix();
Jan Möbius's avatar
 
Jan Möbius committed
428

Jan Möbius's avatar
Dennis:  
Jan Möbius committed
429 430
      // reset scene translation
      GLMatrixd modelview = _state.modelview();
Jan Möbius's avatar
 
Jan Möbius committed
431

Jan Möbius's avatar
Dennis:  
Jan Möbius committed
432 433 434
      modelview(0,3) = 0.0;
      modelview(1,3) = 0.0;
      modelview(2,3) = 0.0;
Jan Möbius's avatar
 
Jan Möbius committed
435

Jan Möbius's avatar
Dennis:  
Jan Möbius committed
436
      _state.set_modelview (modelview);
437
      _state.translate (pos3D[0], pos3D[1], pos3D[2], MULT_FROM_LEFT);
Jan Möbius's avatar
 
Jan Möbius committed
438

439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477
      // We don't have access to the pick matrix used during selection buffer picking
      // so we can't draw our pick area circle in this case
      if (_state.color_picking ())
      {
        // clear depth buffer behind coordsys node
        clearPickArea(_state, true, 1.0);

        // Koordinatensystem zeichnen
        drawCoordsysPick(_state);

        // set depth buffer to 0.0 so that nothing can paint above
        clearPickArea(_state, false, 0.0);
      }
      else
      {
        // clear depth buffer in coordsys region
        glDepthRange (1.0, 1.0);
        glDepthFunc (GL_ALWAYS);

        // Koordinatensystem zeichnen
        drawCoordsys(_state);

        // draw coordsys in normal mode
        glDepthRange (0.0, 1.0);
        glDepthFunc (GL_LESS);

        // Koordinatensystem zeichnen
        drawCoordsys(_state);

        // set depth buffer to 0 so tah nothing can paint over cordsys
        glDepthRange (0.0, 0.0);
        glDepthFunc (GL_ALWAYS);
        glColorMask(GL_FALSE,GL_FALSE,GL_FALSE,GL_FALSE);

        // Koordinatensystem zeichnen
        drawCoordsys(_state);

        // reset to default
        glDepthRange (0.0, 1.0);
478
        glDepthFunc (prev_depth);
479 480
        glColorMask (GL_TRUE, GL_TRUE, GL_TRUE, GL_TRUE);
      }
Jan Möbius's avatar
Jan Möbius committed
481

482 483
      // Projection reload
      _state.pop_projection_matrix();
Jan Möbius's avatar
Dennis:  
Jan Möbius committed
484

Jan Möbius's avatar
Jan Möbius committed
485 486
    } else if (mode_ == POSITION) { /* mode_ == POSITION */

487 488 489
      // The selection buffer picking method might have set a 
      // pick matrix that has been multiplied with the projection matrix.
      // This is the only way to get the gl pick matrix again
Jan Möbius's avatar
Jan Möbius committed
490 491 492 493 494 495 496 497 498 499 500 501 502
      glMatrixMode(GL_PROJECTION);

      glPushMatrix ();
      glMultMatrixd( _state.inverse_projection().get_raw_data());

      glGetDoublev(GL_PROJECTION_MATRIX, mat);

      glPopMatrix ();

      GLMatrixd pickMat (mat);

      glMatrixMode(GL_MODELVIEW);

Jan Möbius's avatar
Dennis:  
Jan Möbius committed
503 504 505 506 507 508
      GLMatrixd modelview = _state.modelview();

      modelview(0,3) = 0.0;
      modelview(1,3) = 0.0;
      modelview(2,3) = 0.0;

509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547
      // We don't have access to the pick matrix used during selection buffer picking
      // so we can't draw our pick area circle in this case
      if (_state.color_picking ())
      {
        // clear depth buffer behind coordsys node
        clearPickArea(_state, true, 1.0);

        // Koordinatensystem zeichnen
        drawCoordsysPick(_state);

        // set depth buffer to 0.0 so that nothing can paint above
        clearPickArea(_state, false, 0.0);
      }
      else
      {
        // clear depth buffer in coordsys region
        glDepthRange (1.0, 1.0);
        glDepthFunc (GL_ALWAYS);

        // Koordinatensystem zeichnen
        drawCoordsys(_state);

        // draw coordsys in normal mode
        glDepthRange (0.0, 1.0);
        glDepthFunc (GL_LESS);

        // Koordinatensystem zeichnen
        drawCoordsys(_state);

        // set depth buffer to 0 so tah nothing can paint over cordsys
        glDepthRange (0.0, 0.0);
        glDepthFunc (GL_ALWAYS);
        glColorMask(GL_FALSE,GL_FALSE,GL_FALSE,GL_FALSE);

        // Koordinatensystem zeichnen
        drawCoordsys(_state);

        // reset to default
        glDepthRange (0.0, 1.0);
548
        glDepthFunc (prev_depth);
549 550
        glColorMask (GL_TRUE, GL_TRUE, GL_TRUE, GL_TRUE);
      }
Jan Möbius's avatar
 
Jan Möbius committed
551
    }
Jan Möbius's avatar
Jan Möbius committed
552 553 554 555
    // Reload old configuration
    _state.pop_modelview_matrix();

  }
Jan Möbius's avatar
 
Jan Möbius committed
556 557
}

Jan Möbius's avatar
Dennis:  
Jan Möbius committed
558 559
//----------------------------------------------------------------------------

560
void CoordsysNode::clearPickArea(GLState&  _state, bool _draw, GLfloat _depth)
Jan Möbius's avatar
Dennis:  
Jan Möbius committed
561
{
562 563
  GLenum prev_depth = _state.depthFunc();
    
Jan Möbius's avatar
Dennis:  
Jan Möbius committed
564 565 566 567 568 569 570
  std::vector<Vec2f> points;
  Vec2f center;
  float radius;

  int left, bottom, width, height;
  _state.get_viewport(left, bottom, width, height);

Jan Möbius's avatar
Dennis:  
Jan Möbius committed
571 572 573
  GLboolean colorMask[4];
  glGetBooleanv (GL_COLOR_WRITEMASK, colorMask);

Jan Möbius's avatar
Dennis:  
Jan Möbius committed
574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594
  GLUquadricObj *quadric = gluNewQuadric();

  // respect sphere radius
  Vec3d proj = _state.project (Vec3d (-0.01, -0.01, -0.01));
  points.push_back (Vec2f (proj[0], proj[1]));

  proj = _state.project (Vec3d (0.1, 0.0, 0.0));
  points.push_back (Vec2f (proj[0], proj[1]));

  proj = _state.project (Vec3d (0.0, 0.1, 0.0));
  points.push_back (Vec2f (proj[0], proj[1]));

  proj = _state.project (Vec3d (0.0, 0.0, 0.1));
  points.push_back (Vec2f (proj[0], proj[1]));


  // get bounding circle of projected 4 points of the coord node
  boundingCircle(points, center, radius);

  _state.push_projection_matrix();
  _state.reset_projection();
Jan Möbius's avatar
Jan Möbius committed
595

Jan Möbius's avatar
Dennis:  
Jan Möbius committed
596 597 598 599 600
  _state.ortho (left, left + width, bottom, bottom + height, 0.0, 1.0);

  _state.push_modelview_matrix();
  _state.reset_modelview();
  glDepthFunc (GL_ALWAYS);
601 602
  glDepthRange (_depth, _depth);
  _state.translate (center[0], center[1], -0.5);
Jan Möbius's avatar
Dennis:  
Jan Möbius committed
603

604
  if (_draw)
Jan Möbius's avatar
Dennis:  
Jan Möbius committed
605 606 607 608 609 610 611
    _state.pick_set_name (0);
  else
    glColorMask(false, false, false, false);

  // 10% more to ensure everything is in
  gluDisk( quadric, 0, radius * 1.1, 10, 10 );

612
  glDepthFunc (prev_depth);
Jan Möbius's avatar
Dennis:  
Jan Möbius committed
613 614 615
  _state.pop_modelview_matrix();
  _state.pop_projection_matrix();

616 617 618
  glDepthRange (0.0, 1.0);

  if (!_draw)
Jan Möbius's avatar
Dennis:  
Jan Möbius committed
619
    glColorMask (colorMask[0], colorMask[1], colorMask[2], colorMask[3]);
620

Jan Möbius's avatar
Dennis:  
Jan Möbius committed
621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718
  gluDeleteQuadric(quadric);
}

//----------------------------------------------------------------------------

void CoordsysNode::boundingCircle(std::vector<Vec2f> &_in, Vec2f &_center, float &_radius)
{
  if (_in.size () == 0)
    return;
  if (_in.size () < 2)
  {
    _center = _in[0];
    _radius = 0.0f;
    return;
  }
  bool found = false;

  // try all circumcircles of all possible lines
  for (unsigned int i = 0; i < _in.size () - 1; i++)
    for (unsigned int j = i + 1; j < _in.size (); j++)
    {
      Vec2f cen = (_in[i] + _in[j]) * 0.5;
      float rad = (_in[i] - cen).length ();
      bool allin = true;

      for (unsigned int k = 0; k < _in.size (); k++)
        if (k != i && k != j && (_in[k] - cen).length () > rad)
        {
          allin = false;
          break;
        }

      if (!allin)
        continue;

      if (found)
      {
        if (rad < _radius)
        {
          _center = cen;
          _radius = rad;
        }
      }
      else
      {
        found = true;
        _center = cen;
        _radius = rad;
      }
    }

  if (found)
    return;

  // try all circumcircles of all possible triangles
  for (unsigned int i = 0; i < _in.size () - 2; i++)
    for (unsigned int j = i + 1; j < _in.size () - 1; j++)
      for (unsigned int k = j + 1; k < _in.size (); k++)
      {
        float v = ((_in[k][0]-_in[j][0])*((_in[i][0]*_in[i][0])+(_in[i][1]*_in[i][1]))) +
                  ((_in[i][0]-_in[k][0])*((_in[j][0]*_in[j][0])+(_in[j][1]*_in[j][1]))) +
                  ((_in[j][0]-_in[i][0])*((_in[k][0]*_in[k][0])+(_in[k][1]*_in[k][1])));
        float u = ((_in[j][1]-_in[k][1])*((_in[i][0]*_in[i][0])+(_in[i][1]*_in[i][1]))) +
                  ((_in[k][1]-_in[i][1])*((_in[j][0]*_in[j][0])+(_in[j][1]*_in[j][1]))) +
                  ((_in[i][1]-_in[j][1])*((_in[k][0]*_in[k][0])+(_in[k][1]*_in[k][1])));
        float d = (_in[i][0]*_in[j][1])+(_in[j][0]*_in[k][1])+(_in[k][0]*_in[i][1]) -
                  (_in[i][0]*_in[k][1])-(_in[j][0]*_in[i][1])-(_in[k][0]*_in[j][1]);
        Vec2f cen(0.5 * (u/d), 0.5 * (v/d));
        float rad = (_in[i] - cen).length ();
        bool allin = true;

        for (unsigned int l = 0; l < _in.size (); l++)
          if (l != i && l != j && l != k && (_in[l] - cen).length () > rad)
          {
            allin = false;
            break;
          }

        if (!allin)
          continue;

        if (found)
        {
          if (rad < _radius)
          {
            _center = cen;
            _radius = rad;
          }
        }
        else
        {
          found = true;
          _center = cen;
          _radius = rad;
        }
      }
}

Jan Möbius's avatar
 
Jan Möbius committed
719 720 721 722
//=============================================================================
} // namespace SceneGraph
} // namespace ACG
//=============================================================================