started working on servo status, not getting any data...
reading possitions from servo seems to work, but there is some strangeness with the checksum in status packets
reading servo pos seems to work
erging
fixed merge conflicts from master, not tested
reading data form servos works, but is a bit slow...
merging from master