Added pose checking and minimum rotate value.

The min rotate makes it ugly going through doors, but stops it getting stuck at the carpet at BHAM.