Fixed function calls in motorwork
Was calling functions before they were defined on the script

Signed-off-by: Alberto Corona <albcoron@gmail.com>