Added autonomous and fixed bug in vision