Implement CAN datagram format

[antoinealb]

I will start working on the CAN datagram implementation. I will do it without any dynamic allocation, which will require some change to the protocol format probably.