Slave Node Movement Command Logic

Needs interior functions to actually send pwms, but I believe the logic
is there
Rough Draft Movement Code

Needs fleshing out with actual functions to control pwm output
Minor changes

blah
test commit

trying to clean/merge