Working stable version
Now offsetting to match the floor position in the image