From 379a55f089f70ee961bacf3072eead629cb1d2e3 Mon Sep 17 00:00:00 2001
From: Paul Gilbert
Date: Fri, 16 Jul 2010 13:15:18 +0000
Subject: Implemented path-finding logic for accurate player movement

svn-id: r50936
---
 engines/m4/mads_player.cpp | 41 ++++++++++++++++++++++++++++++++++++++---
 1 file changed, 38 insertions(+), 3 deletions(-)

(limited to 'engines/m4/mads_player.cpp')

diff --git a/engines/m4/mads_player.cpp b/engines/m4/mads_player.cpp
index ff5f3464bf..5106d2210d 100644
--- a/engines/m4/mads_player.cpp
+++ b/engines/m4/mads_player.cpp
@@ -747,9 +747,44 @@ void MadsPlayer::turnToDestFacing() {
 }
 
 void MadsPlayer::setupRoute(bool bitFlag) {
-	// TODO: Properly Implement route setup
-	_routeIndexes[0] = _madsVm->scene()->getSceneResources()._nodes.size() - 1;
-	_routeCount = 1;
+	// Reset the flag set of nodes in use
+	SceneNodeList &nodes = _madsVm->scene()->getSceneResources()._nodes;
+	for (uint i = 0; i < nodes.size(); ++i)
+		nodes[i].active = false;
+
+	// Start constructing route node list
+	_routeLength = 0x3FFF;
+	_routeCount = 0;
+
+	setupRouteNode(_tempRoute, nodes.size() - 1, bitFlag ? 0xC000 : 0x8000, 0);
+}
+
+void MadsPlayer::setupRouteNode(int *routeIndexP, int nodeIndex, int flags, int routeLength) {
+	SceneNodeList &nodes = _madsVm->scene()->getSceneResources()._nodes;
+	SceneNode &currentNode = nodes[nodeIndex];
+	currentNode.active = true;
+
+	*routeIndexP++ = nodeIndex;
+
+	int subIndex = nodes.size() - 2;
+	int indexVal = nodes[nodeIndex].indexes[subIndex];
+	if (indexVal & flags) {
+		routeLength += indexVal & 0x3FFF;
+		if (routeLength < _routeLength) {
+			// Found a new shorter route to destination, so set up the route with the found one
+			Common::copy(_tempRoute, routeIndexP, _routeIndexes);
+			_routeCount = routeIndexP - _tempRoute;
+			_routeLength = indexVal & 0x3FFF;
+		}
+	} else {
+		for (int idx = nodes.size() - 2; idx > 0; --idx) {
+			int nodePos = idx - 1;
+			if (!nodes[nodePos].active && ((currentNode.indexes[nodePos] & flags) != 0))
+				setupRouteNode(routeIndexP, nodePos, 0x8000, indexVal & 0x3fff);
+		}
+	}
+
+	currentNode.active = false;
 }
 
 } // End of namespace M4
-- 
cgit v1.2.3