Initial Commit of Movement routines... only tested motor movement via unit tests so far