code refactoring: generating a new class point cloud H. Now able to get and reproduce the image in rviz (rotated.. no idea why..)