From ba8be9e10db6c7911027838dd92ce9c8df1223a5 Mon Sep 17 00:00:00 2001
From: Jasper <Jaspermanousek@hotmail.com>
Date: Fri, 14 Nov 2014 14:23:10 +0100
Subject: [PATCH] aaah

---
 physics.cc | 47 +++++++++++++++++++++++++++++++++++++++++++++--
 physics.hh | 10 ++++++++++
 2 files changed, 55 insertions(+), 2 deletions(-)

diff --git a/physics.cc b/physics.cc
index 7b22507..cf030ff 100644
--- a/physics.cc
+++ b/physics.cc
@@ -10,6 +10,8 @@ btBroadphaseInterface* broadphase; //defines how objects are culled from collisi
 btConstraintSolver* solver; //solver for forces and impulses.
 
 std::vector<btRigidBody*> bodies; //list of all bodies. bodies are also in world, but save again to ease cleaning up process.
+btRigidBody* playerBall;
+btRigidBody* terrainBody;
 
 void init()
 {
@@ -29,7 +31,46 @@ void takeUpdateStep(float timeDiff)
 	world->stepSimulation(timeDiff);
 }
 
-void addSphere(float rad, float x, float y, float z, float mass)
+void addTerrain(int width, int length, float** heightData)
+{
+	float* heightfield = new float[width * length];
+	      int highest = -999999, j = 0, i = 0;
+	      for (i = 0; i < width; i++)
+		 for (j = 0; j < length; j++) {
+		    heightfield[j*length+i] = heightData[i][j];
+		    if (heightData[i][j] > highest)
+		       highest = heightData[i][j];
+		 }
+
+	btHeightfieldTerrainShape* terrianShape = new btHeightfieldTerrainShape(width,length,heightData,highest,1,true,false);
+
+	btRigidBody* tBody = new btRigidBody(0,new btDefaultMotionState(),terrianShape);
+
+	tBody->getWorldTransform().setOrigin(btVector3(0,highest/2,0));
+
+	//tBody->getWoorldTransform().setRotation(btQuaternion(0,0,0,1));
+
+	terrainBody = tBody;
+
+	world->addRigidBody(terrainBody);
+
+/*
+	terrianShape->setLocalScaling(btVector3(1,1,1));
+	btCollisionShape* trimeshShape = terrianShape;
+         
+	float mass = 0.f;
+	btTransform   startTransform;
+	startTransform.setIdentity();
+	startTransform.setOrigin(btVector3(0,highest/2,0));//not 100% sure maybe (0,0,0) or (0,-highest/2,0)
+
+	btRigidBody* groundBody = localCreateRigidBody(mass, startTransform,trimeshShape);
+	
+	world->addRigidBody(terrainBody);
+	*/
+
+}
+
+void addSphere(float rad, float x, float y, float z, float mass, int indice) //TODO add indice check
 {
 	btSphereShape* sphere = new btSphereShape(rad);
 	btVector3 inertia(0,0,0);
@@ -52,9 +93,11 @@ void addSphere(float rad, float x, float y, float z, float mass)
 	bodies.push_back(body);
 }
 
-void getPos(int i)
+glm::vec3 getPos(int i)
 {
 	btVector3 origin = bodies[i]->getCenterOfMassPosition();
+	glm::vec3 save(origin.getX(),origin.getY(),origin.getZ());
+	return save;
 }
 
 void getRotation(int i)
diff --git a/physics.hh b/physics.hh
index 5c25912..a52e646 100644
--- a/physics.hh
+++ b/physics.hh
@@ -8,7 +8,9 @@
 #include "extern/bullet/src/BulletDynamics/Dynamics/btRigidBody.h"
 #include "extern/bullet/src/BulletDynamics/Dynamics/btDynamicsWorld.h"
 #include "extern/bullet/src/BulletDynamics/Dynamics/btDiscreteDynamicsWorld.h"
+
 #include "extern/bullet/src/BulletCollision/CollisionShapes/btSphereShape.h"
+#include "extern/bullet/src/BulletCollision/CollisionShapes/btHeightfieldTerrainShape.h"
 
 #include "extern/bullet/src/BulletDynamics/ConstraintSolver/btConstraintSolver.h"
 #include "extern/bullet/src/BulletDynamics/ConstraintSolver/btSequentialImpulseConstraintSolver.h"//YAY!
@@ -29,7 +31,15 @@ class Physics {
     public:
         Physics();
 	~Physics();
+	void init();
+	void takeUpdateStep(float timeDiff);
 	void rollForward(glm::vec3 camPos, float strength);
+	glm::vec3 getPos(int i);
+	void getRotation(int i);
+	void rollForward();
+	void addTerrain(int width, int length, float** heightData);
+	void addSphere(float rad, float x, float y, float z, float mass, int indice);
+
     private:
 	btRigidBody* playerBody;
 	btRigidBody* terrainBody;