Added brake interface switch
Latest working code