Changed if/else block into switch()
Merge branch 'groovy-devel' of git://github.com/smd-ros-devel/asctec_drivers into groovy-devel