Control: fix bug on matrix_a_ when switching from backward to forward driving
Control: fix bug on matrix_a_ when switching from backward to forward driving

ApolloAuto/apollo,ApolloAuto/apollo,wanglei828/apollo,ycool/apollo,xiaoxq/apollo,ApolloAuto/apollo,ycool/apollo,ycool/apollo,ycool/apollo,xiaoxq/apollo,jinghaomiao/apollo,ycool/apollo,wanglei828/apollo,xiaoxq/apollo,ApolloAuto/apollo,xiaoxq/apollo,xiaoxq/apollo,wanglei828/apollo,ApolloAuto/apollo,jinghaomiao/apollo,ycool/apollo,jinghaomiao/apollo,jinghaomiao/apollo,ApolloAuto/apollo,jinghaomiao/apollo,jinghaomiao/apollo,wanglei828/apollo,wanglei828/apollo,wanglei828/apollo,xiaoxq/apollo