Command Based Auto - Windriver C++ Having trouble to add sequential auto commands

[jreneew2]

Hello there! I am working on our drive base and trying to get basic autonomous code to work. However, I have run into a small problem. When I enable auto mode, the robot moves to the side (which it should, but out of order). Then just stops. It doesn't move forward or backwards like it should before that. The order of events should be drive forward->drive backwards->drive to the side.

I have been trying to add different commands to the scheduler and making a sequential command group. I have also added printf statements everywhere in the code to try and debug it. I also have had a mentor from the team to look it over and he could not figure it out either.

So I'll link code here to see if the any one here can help me out! There should be a NetConsole.txt file on there which is a log of auto mode running.

Thank you so much,
Drew
Team 2053 Programmer

P.S. Thanks for the last responses I got from this thread! I have it all sorted out. I basically integrated the rotate to angle command as a separate function, but still in the same command. You can see it in the code if you would like.