Added functions to canbus.c, added canbus.h