Added more advanced head control.
Merge branch 'master' of https://github.com/masonremy/481CTeam6