199 lines
6.5 KiB
C
199 lines
6.5 KiB
C
|
/********************************************************************************
|
||
|
* ReactPhysics3D physics library, http://code.google.com/p/reactphysics3d/ *
|
||
|
* Copyright (c) 2010-2013 Daniel Chappuis *
|
||
|
*********************************************************************************
|
||
|
* *
|
||
|
* This software is provided 'as-is', without any express or implied warranty. *
|
||
|
* In no event will the authors be held liable for any damages arising from the *
|
||
|
* use of this software. *
|
||
|
* *
|
||
|
* Permission is granted to anyone to use this software for any purpose, *
|
||
|
* including commercial applications, and to alter it and redistribute it *
|
||
|
* freely, subject to the following restrictions: *
|
||
|
* *
|
||
|
* 1. The origin of this software must not be misrepresented; you must not claim *
|
||
|
* that you wrote the original software. If you use this software in a *
|
||
|
* product, an acknowledgment in the product documentation would be *
|
||
|
* appreciated but is not required. *
|
||
|
* *
|
||
|
* 2. Altered source versions must be plainly marked as such, and must not be *
|
||
|
* misrepresented as being the original software. *
|
||
|
* *
|
||
|
* 3. This notice may not be removed or altered from any source distribution. *
|
||
|
* *
|
||
|
********************************************************************************/
|
||
|
|
||
|
#ifndef SCENE_H
|
||
|
#define SCENE_H
|
||
|
|
||
|
// Libraries
|
||
|
#include "openglframework.h"
|
||
|
#include "reactphysics3d.h"
|
||
|
#include "Sphere.h"
|
||
|
#include "Box.h"
|
||
|
#include "Cone.h"
|
||
|
#include "Cylinder.h"
|
||
|
#include "Capsule.h"
|
||
|
#include "Line.h"
|
||
|
#include "ConvexMesh.h"
|
||
|
#include "Dumbbell.h"
|
||
|
#include "VisualContactPoint.h"
|
||
|
#include "../common/Viewer.h"
|
||
|
|
||
|
// Constants
|
||
|
const openglframework::Vector3 BOX_SIZE(4, 2, 1);
|
||
|
const float SPHERE_RADIUS = 3.0f;
|
||
|
const float CONE_RADIUS = 3.0f;
|
||
|
const float CONE_HEIGHT = 5.0f;
|
||
|
const float CYLINDER_RADIUS = 3.0f;
|
||
|
const float CYLINDER_HEIGHT = 5.0f;
|
||
|
const float CAPSULE_RADIUS = 3.0f;
|
||
|
const float CAPSULE_HEIGHT = 5.0f;
|
||
|
const float DUMBBELL_HEIGHT = 5.0f;
|
||
|
const int NB_RAYS = 100;
|
||
|
const float RAY_LENGTH = 30.0f;
|
||
|
const int NB_BODIES = 7;
|
||
|
|
||
|
// Raycast manager
|
||
|
class RaycastManager : public rp3d::RaycastCallback {
|
||
|
|
||
|
private:
|
||
|
|
||
|
/// All the visual contact points
|
||
|
std::vector<VisualContactPoint*> mHitPoints;
|
||
|
|
||
|
/// All the normals at hit points
|
||
|
std::vector<Line*> mNormals;
|
||
|
|
||
|
public:
|
||
|
|
||
|
virtual rp3d::decimal notifyRaycastHit(const rp3d::RaycastInfo& raycastInfo) {
|
||
|
rp3d::Vector3 hitPos = raycastInfo.worldPoint;
|
||
|
openglframework::Vector3 position(hitPos.x, hitPos.y, hitPos.z);
|
||
|
VisualContactPoint* point = new VisualContactPoint(position);
|
||
|
mHitPoints.push_back(point);
|
||
|
|
||
|
// Create a line to display the normal at hit point
|
||
|
rp3d::Vector3 n = raycastInfo.worldNormal;
|
||
|
openglframework::Vector3 normal(n.x, n.y, n.z);
|
||
|
Line* normalLine = new Line(position, position + normal);
|
||
|
mNormals.push_back(normalLine);
|
||
|
|
||
|
return raycastInfo.hitFraction;
|
||
|
}
|
||
|
|
||
|
void render(openglframework::Shader& shader,
|
||
|
const openglframework::Matrix4& worldToCameraMatrix,
|
||
|
bool showNormals) {
|
||
|
|
||
|
// Render all the raycast hit points
|
||
|
for (std::vector<VisualContactPoint*>::iterator it = mHitPoints.begin();
|
||
|
it != mHitPoints.end(); ++it) {
|
||
|
(*it)->render(shader, worldToCameraMatrix);
|
||
|
}
|
||
|
|
||
|
if (showNormals) {
|
||
|
|
||
|
// Render all the normals at hit points
|
||
|
for (std::vector<Line*>::iterator it = mNormals.begin();
|
||
|
it != mNormals.end(); ++it) {
|
||
|
(*it)->render(shader, worldToCameraMatrix);
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
|
||
|
void resetPoints() {
|
||
|
|
||
|
// Destroy all the visual contact points
|
||
|
for (std::vector<VisualContactPoint*>::iterator it = mHitPoints.begin();
|
||
|
it != mHitPoints.end(); ++it) {
|
||
|
delete (*it);
|
||
|
}
|
||
|
mHitPoints.clear();
|
||
|
|
||
|
// Destroy all the normals
|
||
|
for (std::vector<Line*>::iterator it = mNormals.begin();
|
||
|
it != mNormals.end(); ++it) {
|
||
|
delete (*it);
|
||
|
}
|
||
|
mNormals.clear();
|
||
|
}
|
||
|
};
|
||
|
|
||
|
// Class Scene
|
||
|
class Scene {
|
||
|
|
||
|
private :
|
||
|
|
||
|
// -------------------- Attributes -------------------- //
|
||
|
|
||
|
/// Pointer to the viewer
|
||
|
Viewer* mViewer;
|
||
|
|
||
|
/// Raycast manager
|
||
|
RaycastManager mRaycastManager;
|
||
|
|
||
|
/// Light 0
|
||
|
openglframework::Light mLight0;
|
||
|
|
||
|
/// Phong shader
|
||
|
openglframework::Shader mPhongShader;
|
||
|
|
||
|
/// All the raycast lines
|
||
|
std::vector<Line*> mLines;
|
||
|
|
||
|
/// Current body index
|
||
|
int mCurrentBodyIndex;
|
||
|
|
||
|
/// True if the hit points normals are displayed
|
||
|
bool mAreNormalsDisplayed;
|
||
|
|
||
|
/// Raycast manager
|
||
|
|
||
|
/// All objects on the scene
|
||
|
Box* mBox;
|
||
|
Sphere* mSphere;
|
||
|
Cone* mCone;
|
||
|
Cylinder* mCylinder;
|
||
|
Capsule* mCapsule;
|
||
|
ConvexMesh* mConvexMesh;
|
||
|
Dumbbell* mDumbbell;
|
||
|
|
||
|
/// Collision world used for the physics simulation
|
||
|
rp3d::CollisionWorld* mCollisionWorld;
|
||
|
|
||
|
/// Create the raycast lines
|
||
|
void createLines();
|
||
|
|
||
|
public:
|
||
|
|
||
|
// -------------------- Methods -------------------- //
|
||
|
|
||
|
/// Constructor
|
||
|
Scene(Viewer* viewer, const std::string& shaderFolderPath,
|
||
|
const std::string& meshFolderPath);
|
||
|
|
||
|
/// Destructor
|
||
|
~Scene();
|
||
|
|
||
|
/// Take a step for the simulation
|
||
|
void simulate();
|
||
|
|
||
|
/// Render the scene
|
||
|
void render();
|
||
|
|
||
|
/// Change the body to raycast
|
||
|
void changeBody();
|
||
|
|
||
|
/// Display or not the surface normals at hit points
|
||
|
void showHideNormals();
|
||
|
};
|
||
|
|
||
|
// Display or not the surface normals at hit points
|
||
|
inline void Scene::showHideNormals() {
|
||
|
mAreNormalsDisplayed = !mAreNormalsDisplayed;
|
||
|
}
|
||
|
|
||
|
|
||
|
#endif
|