1 files changed, 104 insertions, 0 deletions
diff --git a/engines/titanic/star_control/dmatrix.cpp b/engines/titanic/star_control/dmatrix.cpp
new file mode 100644
index 0000000000..70008054b6
--- /dev/null
+++ b/engines/titanic/star_control/dmatrix.cpp
@@ -0,0 +1,104 @@
+/* ScummVM - Graphic Adventure Engine
+ *
+ * ScummVM is the legal property of its developers, whose names
+ * are too numerous to list here. Please refer to the COPYRIGHT
+ * file distributed with this source distribution.
+ *
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU General Public License
+ * as published by the Free Software Foundation; either version 2
+ * of the License, or (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
+ *
+ */
+
+#include "titanic/star_control/dmatrix.h"
+#include "titanic/star_control/fmatrix.h"
+#include "titanic/star_control/star_control_sub26.h"
+
+namespace Titanic {
+
+DMatrix *DMatrix::_static;
+
+DMatrix::DMatrix() :
+	_row1(1.0, 0.0, 0.0), _row2(0.0, 1.0, 0.0), _row3(0.0, 0.0, 1.0) {
+}
+
+DMatrix::DMatrix(int mode, const FMatrix *src) {
+	assert(!mode);
+
+	_row1._x = 1.0;
+	_row2._y = 1.0;
+	_row3._z = 1.0;
+	_frow1._x = src->_row1._x;
+	_frow1._y = src->_row1._y;
+	_frow1._z = src->_row1._z;
+	_frow2._x = src->_row2._x;
+	_frow2._y = src->_row2._y;
+	_frow2._z = src->_row2._z;
+}
+
+DMatrix::DMatrix(int mode, double val) {
+	set(mode, val);
+}
+
+void DMatrix::init() {
+	_static = nullptr;
+}
+
+void DMatrix::deinit() {
+	delete _static;
+	_static = nullptr;
+}
+
+void DMatrix::set(int mode, double amount) {
+	const double FACTOR = 0.0174532925199433;
+	double sinVal = sin(amount * FACTOR);
+	double cosVal = cos(amount * FACTOR);
+
+	switch (mode) {
+	case 0:
+		_row1._x = 1.0;
+		_row2._y = cosVal;
+		_row2._z = sinVal;
+		_row3._y = -sinVal;
+		_row3._z = cosVal;
+		break;
+
+	case 1:
+		_row1._x = cosVal;
+		_row1._z = sinVal;
+		_row2._y = 1.0;
+		_row3._x = -sinVal;
+		_row3._z = cosVal;
+		break;
+
+	case 2:
+		_row1._x = cosVal;
+		_row1._y = sinVal;
+		_row2._x = -sinVal;
+		_row2._y = cosVal;
+		_row3._z = 1.0;
+		break;
+
+	default:
+		break;
+	}
+}
+
+void DMatrix::fn3(CStarControlSub26 *sub26) {
+	double v = sub26->fn1();
+	v = (v < 0.0) ? 0.0 : 2.0 / v;
+
+	error("TODO: DMatrix::fn3 %d", (int)v);
+}
+
+} // End of namespace Titanic