sravan/Marlin-Firmware
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Tweak vector_3::apply_rotation

Browse Source
This commit is contained in:
Scott Lahteine
2018-09-30 01:51:21 -05:00
parent e2ab78d876
commit e10f730478
1 changed files with 4 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files

8
Marlin/src/libs/vector_3.cpp
View File

@@ -76,10 +76,10 @@ void vector_3::normalize() {
} }
void vector_3::apply_rotation(const matrix_3x3 &matrix) { void vector_3::apply_rotation(const matrix_3x3 &matrix) {
const float _x = x * matrix.matrix[3 * 0 + 0] + y * matrix.matrix[3 * 1 + 0] + z * matrix.matrix[3 * 2 + 0], const float _x = x, _y = y;
_y = x * matrix.matrix[3 * 0 + 1] + y * matrix.matrix[3 * 1 + 1] + z * matrix.matrix[3 * 2 + 1], x = _x * matrix.matrix[3 * 0 + 0] + _y * matrix.matrix[3 * 1 + 0] + z * matrix.matrix[3 * 2 + 0];
_z = x * matrix.matrix[3 * 0 + 2] + y * matrix.matrix[3 * 1 + 2] + z * matrix.matrix[3 * 2 + 2]; y = _x * matrix.matrix[3 * 0 + 1] + _y * matrix.matrix[3 * 1 + 1] + z * matrix.matrix[3 * 2 + 1];
x = _x; y = _y; z = _z; z = _x * matrix.matrix[3 * 0 + 2] + _y * matrix.matrix[3 * 1 + 2] + z * matrix.matrix[3 * 2 + 2];
} }
void vector_3::debug(const char * const title) { void vector_3::debug(const char * const title) {