fifo buffer in kommunikationsmodulen not tested, started working on servo status packet decoding and stuff...