|
|
@ -76,6 +76,8 @@ void vector_3::apply_rotation(const matrix_3x3 &matrix) {
|
|
|
|
matrix.vectors[0][2] * _x + matrix.vectors[1][2] * _y + matrix.vectors[2][2] * _z };
|
|
|
|
matrix.vectors[0][2] * _x + matrix.vectors[1][2] * _y + matrix.vectors[2][2] * _z };
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
extern const char SP_X_STR[], SP_Y_STR[], SP_Z_STR[];
|
|
|
|
|
|
|
|
|
|
|
|
void vector_3::debug(PGM_P const title) {
|
|
|
|
void vector_3::debug(PGM_P const title) {
|
|
|
|
serialprintPGM(title);
|
|
|
|
serialprintPGM(title);
|
|
|
|
SERIAL_ECHOPAIR_F_P(SP_X_STR, x, 6);
|
|
|
|
SERIAL_ECHOPAIR_F_P(SP_X_STR, x, 6);
|
|
|
|