Fixed bug getting joint angles and timestamp...

Also added event handling, handle connect errors better
Fixed ping command with libsfp
Fixed some bugs with disconnecting BaroboCtx