diff --git a/src/user/user_objects.cc b/src/user/user_objects.cc index 7d40e0d1..5a50ef87 100644 --- a/src/user/user_objects.cc +++ b/src/user/user_objects.cc @@ -6402,8 +6402,8 @@ void mjCSensor::Compile(void) { } // height fields are not necessarily convex and are not yet supported - if (static_cast(obj)->Type() == mjGEOM_HFIELD || - static_cast(ref)->Type() == mjGEOM_HFIELD) { + if ((objtype == mjOBJ_GEOM && static_cast(obj)->Type() == mjGEOM_HFIELD) || + (reftype == mjOBJ_GEOM && static_cast(ref)->Type() == mjGEOM_HFIELD)) { throw mjCError(this, "height fields are not supported in geom distance sensors"); }