Modes now working

modes working, autonomous working