Made error happen if incorrect number of data bytes are received
Changed docs slightly
Added some partially implemented functions in oi and servo