Now use a plane normal with a maximum deviation angle for more robust floor detection