Remove uses of mjtNum-typed functions from user_objects.cc
PiperOrigin-RevId: 662026275 Change-Id: Idfb2b6ced6eac4b4b60079e219aac63fc1d00b89
This commit is contained in:
committed by
Copybara-Service
parent
02ffaa8248
commit
d45d13e5ad
@@ -2117,10 +2117,10 @@ double mjCGeom::GetVolume() const {
|
|||||||
// Thomsen approximation
|
// Thomsen approximation
|
||||||
// https://www.numericana.com/answer/ellipsoid.htm#thomsen
|
// https://www.numericana.com/answer/ellipsoid.htm#thomsen
|
||||||
double p = 1.6075;
|
double p = 1.6075;
|
||||||
double tmp = mju_pow(size[0] * size[1], p) +
|
double tmp = std::pow(size[0] * size[1], p) +
|
||||||
mju_pow(size[1] * size[2], p) +
|
std::pow(size[1] * size[2], p) +
|
||||||
mju_pow(size[2] * size[0], p);
|
std::pow(size[2] * size[0], p);
|
||||||
return 4 * mjPI * mju_pow(tmp / 3, 1 / p);
|
return 4 * mjPI * std::pow(tmp / 3, 1 / p);
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
case mjINERTIA_VOLUME:
|
case mjINERTIA_VOLUME:
|
||||||
@@ -2314,7 +2314,9 @@ void mjCGeom::SetInertia(void) {
|
|||||||
inertia_b[2] = mass_b * (ae * ae + be * be) / 5;
|
inertia_b[2] = mass_b * (ae * ae + be * be) / 5;
|
||||||
|
|
||||||
// shell inertia
|
// shell inertia
|
||||||
mju_sub3(inertia, inertia_b, inertia_a);
|
inertia[0] = inertia_b[0] - inertia_a[0];
|
||||||
|
inertia[1] = inertia_b[1] - inertia_a[1];
|
||||||
|
inertia[2] = inertia_b[2] - inertia_a[2];
|
||||||
return;
|
return;
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
|
|||||||
Reference in New Issue
Block a user