Modified the add_servo() function to check whether the new servo has already been assigned or not.

Modified the walk and action modules to assign the basic necessary at construction time.