Modified MC controller
Update MC
Merge pull request #2 from gongal/master

Updated to include motor controller updates.