added initial test code
add pseudocode for motor updates