Added various failsafe functions and replaced land command (will remove old one soon)