Initial commit of firmware for CM-530 microcontroller to support bioloid_ros project