Think about your project as two separate parts.
In one part you have some code that can receive data and store the values in variables. This part has no idea of what the data will be used for.
The other part uses the values in the variables to make the motors move. This part has no idea where the data came from.
That way you can test each part separately.
...R