TITANIC: Finished CStarControlSub24 class

1 files changed, 129 insertions, 5 deletions

diff --git a/engines/titanic/star_control/star_control_sub24.cpp b/engines/titanic/star_control/star_control_sub24.cpp
index 27f29b41ca..28b69f71a7 100644
--- a/engines/titanic/star_control/star_control_sub24.cpp
+++ b/engines/titanic/star_control/star_control_sub24.cpp
@@ -26,18 +26,142 @@
 namespace Titanic {
 
 void CStarControlSub24::proc3(const FMatrix &m1, const FMatrix &m2) {
-
+	CStarControlSub23::proc3(m1, m2);
+	_sub25.fn1(m1, m2);
+	_field60 = 0.1;
+	_field58 = 0.0;
+	_field40 = _field44 = _field48 = -1;
+	_field8 = 1;
 }
 
 void CStarControlSub24::proc4(FVector &v1, FVector &v2, FMatrix &m) {
 	CStarControlSub23::proc4(v1, v2, m);
 
-	// TODO
+	if (_field24 > 8000.0) {
+		_field8 = 1;
+		_field34 = 1;
+		proc6(120, 4, _field24 - 8000.0);
+	}
+
+	FVector row3 = m._row3;
+	double mult = _row3._x * row3._x + _row3._y * row3._y+ _row3._z * row3._z;
+	_field58 = 1.0;
+
+	bool flag = false;
+	if (mult < 1.0) {
+		if (mult >= 1.0 - 1.0e-10)
+			flag = true;
+	} else {
+		if (mult <= 1.0 + 1.0e-10)
+			flag = true;
+	}
+
+	if (!flag) {
+		const FVector *tv;
+		FVector tempV1, tempV2;
+		FVector::addAndNormalize(tempV1, row3, _row3);
+		tv = FVector::addAndNormalize(tempV2, row3, tempV1);
+		tempV1 = *tv;
+
+		tv = FVector::addAndNormalize(tempV2, row3, tempV1);
+		tempV1 = *tv;
+
+		tv = FVector::addAndNormalize(tempV2, row3, tempV1);
+		tempV1 = *tv;
+
+		FMatrix m1;
+		m1.fn1(tempV1);
+		_sub25.fn1(m, m1);
+
+		_field58 = 0.0;
+		_field60 = 0.1;
+		_field8 = 1;
+	}
 }
 
-int CStarControlSub24::proc5(CErrorCode &errorCode, FVector &v, const FMatrix &m) {
-	// TODO
-	return 0;
+int CStarControlSub24::proc5(CErrorCode &errorCode, FVector &v, FMatrix &m) {
+	FVector v1, v2, v3, v4;
+	const FVector *tv;
+
+	if (_field8)
+		return 0;
+
+	if (_field58 < 1.0) {
+		_sub25.fn2(_field60 + _field58, m);
+		errorCode.set();
+		return 1;
+	}
+
+	if (!_field34) {
+		_field8 = 0;
+		return 2;
+	}
+
+	v2 = m._row3;
+	v3 = _row2 - v;
+	v3.normalize();
+
+	double val = m._row3._x * v3._x + m._row3._y * v3._y + m._row3._z * v3._z;
+	bool flag = false;
+	if (val > 1.0) {
+		if (val >= 1.0 - 1.0e-10)
+			flag = true;
+	} else {
+		if (val <= 1.0 + 1.0e-10)
+			flag = true;
+	}
+
+	if (!flag) {
+		v2.addAndNormalize(v1, v2, v3);
+		tv = v2.addAndNormalize(v4, v2, v1);
+		v1 = *tv;
+		tv = v2.addAndNormalize(v4, v2, v1);
+		v1 = *tv;
+		tv = v2.addAndNormalize(v4, v2, v1);
+		v1 = *tv;
+
+		m.fn1(v1);
+		v2 = v1;
+	}
+
+	if (_field40 >= 0) {
+		double powVal = _powers[_field40];
+		v1 = v2 * powVal;
+		v += v1;
+
+		--_field40;
+		errorCode.set();
+		return 1;
+	}
+
+	if (_field44 > 0) {
+		v1._z = v2._z * _field38;
+		v1._x = v2._x * _field38;
+		v._x = v1._x + v._x;
+		v._y = v2._y * _field38 + v._y;
+		v._z = v1._z + v._z;
+
+		--_field44;
+		errorCode.set();
+		return 1;
+	}
+
+	if (_field48 >= 0) {
+		double powVal = _powers[31 - _field48];
+		v1._y = v2._y * powVal;
+		v1._z = v2._z * powVal;
+		v1._x = v2._x * powVal;
+		v._y = v1._y + v._y;
+		v._z = v1._z + v._z;
+		v._x = v._x + v1._x;
+
+		--_field48;
+		errorCode.set();
+		return 1;
+	}
+
+	_field8 = 0;
+	return 2;
 }
 
 } // End of namespace Titanic