andrey
/
Marlin_FB4S
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity
Browse Source

Fix apply_rotation function (#15636)

pull/1/head
Evgeny-SPB 5 years ago
committed by Scott Lahteine
parent
0b0b822671
commit
b7db91c46d
1 changed files with 3 additions and 1 deletions
Whitespace
Show all changes Ignore whitespace when comparing lines Ignore changes in amount of whitespace Ignore changes in whitespace at EOL
Unified View
Diff Options
Show Stats Download Patch File Download Diff File
  1. 4
      Marlin/src/libs/vector_3.cpp

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

@ -71,7 +71,9 @@ void vector_3::normalize() {
// Apply a rotation to the matrix // Apply a rotation to the matrix
void vector_3::apply_rotation(const matrix_3x3 &matrix) { void vector_3::apply_rotation(const matrix_3x3 &matrix) {
const float _x = x, _y = y, _z = z; const float _x = x, _y = y, _z = z;
*this = matrix.vectors[0] * _x + matrix.vectors[1] * _y + matrix.vectors[2] * _z; x = _x * matrix.vectors[0][0] + _y * matrix.vectors[1][0] + _z * matrix.vectors[2][0];
y = _x * matrix.vectors[0][1] + _y * matrix.vectors[1][1] + _z * matrix.vectors[2][1];
z = _x * matrix.vectors[0][2] + _y * matrix.vectors[1][2] + _z * matrix.vectors[2][2];
} }
void vector_3::debug(PGM_P const title) { void vector_3::debug(PGM_P const title) {

Write Preview
Loading…
Cancel
Save