Revised movement control

Revised version of the control program featuring a crude but
functional movement algorithm.
Merge pull request #2 from Zurukea/master

New Movement Algorithm