Restore position doesn't work if there are obstacles between Lara and the saved position

[zed0]

I think this is because the camera gets stuck on the obstacles. This could potentially be fixed by restoring the camera's position as well as Lara's.