Added mussolini face player thingy

3 files changed, 24 insertions, 19 deletions

diff --git a/src/entities/generale.c b/src/entities/generale.c
index 39f38c1..728d9aa 100644
--- a/src/entities/generale.c
+++ b/src/entities/generale.c
@@ -8,6 +8,11 @@ void initGenerale(Entity * entity, Game * game) {
 	entity->transformedCollisionModel = entityCreateCollisionModel(*entity->model);
 	setEntityRadius(entity);
 
+	entity->velocity.angularVelocity = (AxisAngle){
+		.axis = (Vector3){0.0, 1.0, 0.0},
+		.angle = PI/2.0
+	};
+
 	// Allocate data.
 	entity->data = KF_MALLOC(sizeof(Generale));
 
@@ -47,7 +52,7 @@ void updateGenerale(Game * game, Entity * entity) {
 	if (data->targetNotSet) {
 		getTargetGenerale(game, entity);
 		data->targetNotSet = false;
-	} else if (Vector3Distance(entity->position, data->target) <= GENERALE_NEXT_POINT_THRESHOLD )
+	} else if (Vector3Distance(entity->position, data->target) <= GENERALE_NEXT_POINT_THRESHOLD)
 		getTargetGenerale(game, entity);
 
 	entityFlyToPoint(
@@ -56,6 +61,9 @@ void updateGenerale(Game * game, Entity * entity) {
 		&data->flyToPoint
 	);
 
+	// Spin this fucker.
+	entityUpdateRotation(entity);
+
 	entityCheckTransformedCollisionModel(entity);
 }
 
diff --git a/src/entities/mussolini.c b/src/entities/mussolini.c
index ed6d182..9f56aa3 100644
--- a/src/entities/mussolini.c
+++ b/src/entities/mussolini.c
@@ -5,19 +5,10 @@
 
 void initMussolini(Entity * entity, Game * game) {
 	entity->model = &game->assets.models[MUSSOLINI_ASSET];
+	entity->collisionModel = entityCreateCollisionModel(*entity->model);
+	entity->transformedCollisionModel = entityCreateCollisionModel(*entity->model);
 	setEntityRadius(entity);
 
-	// PID configs.
-	PIDConfig stickPIDConfig = {
-		.kP = 0.5,
-		.kI = 0.0,
-		.kD = 0.0,
-		.angleMode = false,
-		.doClamp = false,
-		.min = 0.0,
-		.max = 0.0
-	};
-
 	// Allocate data.
 	entity->data = KF_MALLOC(sizeof(Mussolini));
 
@@ -27,9 +18,6 @@ void initMussolini(Entity * entity, Game * game) {
 	}
 
 	Mussolini * data = (Mussolini*)entity->data;
-	data->xStickPID = createPID(stickPIDConfig);
-	data->yStickPID = createPID(stickPIDConfig);
-	data->zStickPID = createPID(stickPIDConfig);
 }
 
 void closeMussolini(Entity * entity) {
@@ -38,8 +26,18 @@ void closeMussolini(Entity * entity) {
 }
 
 void updateMussolini(Game * game, Entity * entity) {
-	Entity * ship = getEntityFromWorld(game->world, 0);
+	entityUpdateLastValues(entity);
+
+	float t = GetFrameTime();
+	Entity * player = getEntityFromWorld(game->world, 0);
 	Mussolini * data = (Mussolini*)entity->data;
+
+	// Look at player.
+	Matrix matrix = MatrixLookAt(player->position, entity->position, (Vector3){0.0, 1.0, 0.0});
+	Quaternion rotation = QuaternionInvert(QuaternionFromMatrix(matrix));
+	entity->rotation = QuaternionSlerp(entity->rotation, rotation, t * MUSSOLINI_TURN_SPEED);
+
+	entityCheckTransformedCollisionModel(entity);
 }
 
 void drawMussolini(Game * game, Entity * entity) {
diff --git a/src/entities/mussolini.h b/src/entities/mussolini.h
index 46520a7..5238849 100644
--- a/src/entities/mussolini.h
+++ b/src/entities/mussolini.h
@@ -5,10 +5,9 @@
 #ifndef MUSSOLINI_H
 #define MUSSOLINI_H
 
+#define MUSSOLINI_TURN_SPEED 1.0
+
 typedef struct Mussolini {
-	PID xStickPID;
-	PID yStickPID;
-	PID zStickPID;
 } Mussolini;
 
 void initMussolini(Entity * entity, Game * game);