Implemented motor control task

-The task should be suspended/resumed from elevator move task when
needed
-The task will automatically suspend itself if the current speed reaches
zero, in order to avoid division by zero
-Also added a cast on the elevator move task to remove a warning