Revised movement control

Revised version of the control program featuring a crude but
functional movement algorithm.