Trying to fix coordinate system
Rough terrain now works well!