Arduino Mega 2560 + MCP 2515

Hola!
tengo un pcb en el que tengo un arduino mega 2560 conectado a un controlador CAN MCP 2515 y este a su vez a un transceptor CAN MCP 2515. Mi objetivo es mandar mensajes a sensores CAN y también leer los mensajes que estos sensores responder.
En vez de utilizar la libreria MCP 2515 he creado las funciones de RESET, READ, READ RX BUFFER del MCP 2515 en mi programa, pero no me funciona y no se a que puede ser debido. El arduino si envía señales, el problema está en el MCP 2515.
Adjunto el programa.
A ver si alguien me puede ayudar.
Gracias

EquipoCAN.ino (57.4 KB)

Es muy dificil ayudarte con algo tan específico.
Consulto: porque no usaste la librería por una cuestión de espacio, necesitabas lugar para tu código extenso?

Digo porque la sugerencia que tengo es que pruebes con la librería para desestimar alguna falla de hardware. Si no existe falla de hardware, entonces usa tu parte de código que sabes funciona y usa las funciones de la librería que deben interactuar con el MCP 2515 y de a poco ve reemplazandolas por las tuyas.

Entiendes mi idea?