Experimental code completed

Will start testing soon
More task oriented user control allows more control over motor values at
any given time