made changes for better print and tracking
Fixed selection, printfs and started to make the drivetrain an array