More CAN interfaces are supported. myAHRS test code is added.
changed CAN message id's for AHRS to be compatible with CAN standard arbitration id's.