Work on command structure

0,servo,position; - Move
1,servo,position; - set servo max_position
2,servo,position; - set servo min_position
3; - get current servo positions