Floor detection now works

So far, the code uses predefined camera orientation values.