adding control forces
Merge branch 'master' of https://github.com/sytianhe/CS5625Final-Project
merge
control forces added in