Commit ee550a0 1 parent 5626eda commit ee550a0 Copy full SHA for ee550a0
File tree 1 file changed +13
-44
lines changed
1 file changed +13
-44
lines changed Original file line number Diff line number Diff line change @@ -5998,25 +5998,12 @@ void quat_left(const real_t q[4], real_t left[4 * 4]) {
5998
5998
const real_t qy = q[2];
5999
5999
const real_t qz = q[3];
6000
6000
6001
- left[0] = qw;
6002
- left[1] = -qx;
6003
- left[2] = -qy;
6004
- left[3] = -qz;
6005
-
6006
- left[4] = qx;
6007
- left[5] = qw;
6008
- left[6] = -qz;
6009
- left[7] = qy;
6010
-
6011
- left[8] = qy;
6012
- left[9] = qz;
6013
- left[10] = qw;
6014
- left[11] = -qx;
6015
-
6016
- left[12] = qz;
6017
- left[13] = -qy;
6018
- left[14] = qx;
6019
- left[15] = qw;
6001
+ // clang-format off
6002
+ left[0] = qw; left[1] = -qx; left[2] = -qy; left[3] = -qz;
6003
+ left[4] = qx; left[5] = qw; left[6] = -qz; left[7] = qy;
6004
+ left[8] = qy; left[9] = qz; left[10] = qw; left[11] = -qx;
6005
+ left[12] = qz; left[13] = -qy; left[14] = qx; left[15] = qw;
6006
+ // clang-format on
6020
6007
}
6021
6008
6022
6009
/**
@@ -6029,15 +6016,9 @@ void quat_left_xyz(const real_t q[4], real_t left_xyz[3 * 3]) {
6029
6016
const real_t qz = q[3];
6030
6017
6031
6018
// clang-format off
6032
- left_xyz[0] = qw;
6033
- left_xyz[1] = -qz;
6034
- left_xyz[2] = qy;
6035
- left_xyz[3] = qz;
6036
- left_xyz[4] = qw;
6037
- left_xyz[5] = -qx;
6038
- left_xyz[6] = -qy;
6039
- left_xyz[7] = qx;
6040
- left_xyz[8] = qw;
6019
+ left_xyz[0] = qw; left_xyz[1] = -qz; left_xyz[2] = qy;
6020
+ left_xyz[3] = qz; left_xyz[4] = qw; left_xyz[5] = -qx;
6021
+ left_xyz[6] = -qy; left_xyz[7] = qx; left_xyz[8] = qw;
6041
6022
// clang-format on
6042
6023
}
6043
6024
@@ -6051,22 +6032,10 @@ void quat_right(const real_t q[4], real_t right[4 * 4]) {
6051
6032
const real_t qz = q[3];
6052
6033
6053
6034
// clang-format off
6054
- right[0] = qw;
6055
- right[1] = -qx;
6056
- right[2] = -qy;
6057
- right[3] = -qz;
6058
- right[4] = qx;
6059
- right[5] = qw;
6060
- right[6] = qz;
6061
- right[7] = -qy;
6062
- right[8] = qy;
6063
- right[9] = -qz;
6064
- right[10] = qw;
6065
- right[11] = qx;
6066
- right[12] = qz;
6067
- right[13] = qy;
6068
- right[14] = -qx;
6069
- right[15] = qw;
6035
+ right[0] = qw; right[1] = -qx; right[2] = -qy; right[3] = -qz;
6036
+ right[4] = qx; right[5] = qw; right[6] = qz; right[7] = -qy;
6037
+ right[8] = qy; right[9] = -qz; right[10] = qw; right[11] = qx;
6038
+ right[12] = qz; right[13] = qy; right[14] = -qx; right[15] = qw;
6070
6039
// clang-format on
6071
6040
}
6072
6041
You can’t perform that action at this time.
0 commit comments