Updated motor control task

Initialize height scalar, motor values