Wooden drivcetrain code tested

drivetrain only
Autonomous initial commit

Skeleton established; not finished yet