Update DriveTrain

[matunkar]

• [ ] change the dimensions (find out what they are from shreya)
• [ ] bring in the getTrajectoryCommand from last year's code