Ropigo services not working but DEBUG shows no errors

edit

When I launch the ropigo.cpp the LED's flash but when I try to enable them with the service I get the correct response on the service but the LED's never enable. This is all executed on the robot. Since the debugging isn't giving me anything that I can see anywhere else I can look?

ropigo.cpp

Works at launch:

<snippet>
int main(int argc, char **argv) {

init();

ROS_INFO("GoPiGo Firmware Version: %d",fw_ver());
ROS_INFO("GoPiGo Board Version: %d",brd_rev());

led_on(0);
usleep(500000);
led_on(1);
usleep(500000);
led_off(0);
usleep(500000);
led_off(1);

Doesn't work calling the servive:

pi@raspberrypi:~ $ rosservice call /led_on_left
status: 1

pi@raspberrypi:~/gopigo_ws $ rosrun ropigo ropigo_node
[ INFO] [1514516109.833289548]: GoPiGo Firmware Version: 16
[ INFO] [1514516109.833892359]: GoPiGo Board Version: 14
[DEBUG] [1514516111.350827490]: determineIP: using value of ROS_IP:192.168.1.158:
[DEBUG] [1514516111.360743405]: Adding tcp socket [7] to pollset
[DEBUG] [1514516111.361887465]: UDPROS server listening on port [34333]
[DEBUG] [1514516111.393761194]: Started node [/ropigo], pid [1028], bound on [192.168.1.158], xmlrpc port [46803], tcpros port [43087], using [real] time
[DEBUG] [1514516111.436831304]: Publisher update for [/cmd_vel]:  already have these connections: 
[DEBUG] [1514516111.478181626]: Publisher update for [/servo_cmd]:  already have these connections: 
[DEBUG] [1514516111.646612075]: Accepted connection on socket [7], new socket [11]
[DEBUG] [1514516111.647944051]: Adding tcp socket [11] to pollset
[DEBUG] [1514516111.648294727]: TCPROS received a connection from [192.168.1.158:36198]
[DEBUG] [1514516111.651738522]: Connection: Creating TransportSubscriberLink for topic [/rosout] connected to [callerid=[/rosout] address=[TCPROS connection on port 43087 to [192.168.1.158:36198 on socket 11]]]
[DEBUG] [1514516180.835470043]: Accepted connection on socket [7], new socket [10]
[DEBUG] [1514516180.836667959]: Adding tcp socket [10] to pollset
[DEBUG] [1514516180.836977438]: TCPROS received a connection from [192.168.1.158:36204]
[DEBUG] [1514516180.837447855]: Connection: Creating ServiceClientLink for service [/led_on_left] connected to [callerid=[/rosservice] address=[TCPROS connection on port 43087 to [192.168.1.158:36204 on socket 10]]]
[DEBUG] [1514516180.837721917]: Service client [/rosservice] wants service [/led_on_left] with md5sum [*]
[DEBUG] [1514516180.839234052]: Socket [10] received 0/4 bytes, closing
[DEBUG] [1514516180.839896083]: TCP socket [10] closed
[DEBUG] [1514516180.840152020]: Connection::drop(0)
[DEBUG] [1514516180.840373374]: Connection::drop(2)
[DEBUG] [1514516180.840720874]: Connection::drop(2)
[DEBUG] [1514516181.102238902]: Accepted connection on socket [7], new socket [10]
[DEBUG] [1514516181.103342860]: Adding tcp socket [10] to pollset
[DEBUG] [1514516181.103638953]: TCPROS received a connection from [192.168.1.158:36220]
[DEBUG] [1514516181.104074995]: Connection: Creating ServiceClientLink for service [/led_on_left] connected to [callerid=[/rosservice_1072_1514516180851] address=[TCPROS connection on port 43087 to [192.168.1.158:36220 on socket 10]]]
[DEBUG] [1514516181.104302495]: Service client [/rosservice_1072_1514516180851] wants service [/led_on_left] with md5sum [581cc55c12abfc219e446416014f6d0e]

**[ INFO] [1514516181.149711749]: Left LED enabled**

[DEBUG] [1514516181.150174978]: Connection::drop(2)
[DEBUG] [1514516181.150595759]: TCP socket [10] closed
[DEBUG] [1514516181.150998467]: Connection::drop(0)
[DEBUG] [1514516181.151296592]: Connection::drop(2)
[DEBUG] [1514516181.151471435]: Connection::drop(2)