Added calculating floor heights from kinect and passing it into ogmbicp to...

Added calculating floor heights from kinect and passing it into ogmbicp to stop laser hits on the ground. Changed params to make it work well with sensor board