Added some thread code to test method and added code to DriveTrain class
Merge origin/master