Implement CAN Handler

[HamzaIqbal69]

Create a handler for CAN messages to route messages and update things accordingly.