Some fixes

Fixed code (wouldn't compile)
Make hard turns, turn harder
Used thresholds and increased them