Some fixes to sensor3d