Updated main.c sending full CAN message

Added functions to convert Int to Hex string (easier for CAN)