Finished implementation of joy_command in naro_cmd_srvs, untested