Switch mjData.{qH,qLD} from reduced ("C") to full ("M") inertia matrix structure. No performance impact of extra zeros because of existing "simple dof" skipping mechanism.
PiperOrigin-RevId: 733523931 Change-Id: Ic8d8a152dda5532331c239cb6b4ce7d8d09b7fff
This commit is contained in:
committed by
Copybara-Service
parent
51f6aa8b43
commit
0f563ecf31
+3
-2
@@ -113,9 +113,10 @@ inline std::vector<mjtNum> AsVector(const mjtNum* array, int n) {
|
||||
}
|
||||
|
||||
// Prints a matrix to stderr, useful for debugging.
|
||||
inline void PrintMatrix(const mjtNum* mat, int nrow, int ncol, int p = 5) {
|
||||
inline void PrintMatrix(const mjtNum* mat, int nrow, int ncol, int p = 5,
|
||||
std::string_view name = "") {
|
||||
std::cerr.precision(p);
|
||||
std::cerr << "\n";
|
||||
std::cerr << name << "\n";
|
||||
for (int r = 0; r < nrow; r++) {
|
||||
for (int c = 0; c < ncol; c++) {
|
||||
mjtNum val = mat[c + r*ncol];
|
||||
|
||||
Reference in New Issue
Block a user