The result of rayTest to a heightmap at (0, 0) is always 0.035

[chengruiz]

Hi Professor,
I accidentally found that the rayTest to a heightmap at (0, 0) is always 0.035 even if the heightmap is different. For example, add the following code to line 60 in examples/heightmap.cpp.

raisimLib/examples/src/server/heightmap.cpp

Line 58 in 9f1be94

  Eigen::Vector3d start{0., 0., 100.};
  auto rays = world.rayTest(start, {0., 0., -1.}, 200, false);
  double ray_height = 0.;
  if (rays.size() > 0) {
    ray_height = rays[rays.size() - 1].getPosition()[2];
  }
  std::cout << hm->getHeight(start[0], start[1]) << " " << ray_height << std::endl;

It will output

0.441001 0.035

Interestingly, changing the seed of terrainProperties does not affect this result.