Arduino.ru

Помогите разобраться. Cкетч, читающий CAN-шину для вывода температуры и др. параметров на дисплей. На Ардуине Нано работает, но бывают задержки по несколько секунд. Решил переделать на MEGA 2560 PRO (была в наличии). Не работает, на дисплее – «снег». Похоже, что выполнение останавливается на строке 26. Библиотека mcp_can.h вроде универсальная, или для меги нужна какая-то другая?

#include <mcp_can.h>
#include <SPI.h>
#include <Wire.h>
#include <Adafruit_GFX.h>
#include <Adafruit_SSD1306.h>
#define SCREEN_WIDTH 128
#define SCREEN_HEIGHT 64
Adafruit_SSD1306 display(SCREEN_WIDTH, SCREEN_HEIGHT, &Wire, -1);
MCP_CAN CAN(10);
long unsigned int rxId;
unsigned char len = 0;
unsigned char rxBuf[8];
float temp_cvt;
float temp_engine;
float fuel;
float volt;

void setup()
{
  CAN.begin(CAN_500KBPS, MCP_8MHz);
  display.begin(SSD1306_SWITCHCAPVCC, 0x3C);
}

void loop() {

  CAN.readMsgBuf(&len, rxBuf);
  rxId = CAN.getCanId();

  if (rxId == 0x418)  //температура вариатора
  {
    temp_cvt = (rxBuf[2]);
    temp_cvt = temp_cvt - 50;
  }
  if (rxId == 0x608) //температура двигателя
  {
    temp_engine = (rxBuf[0]);
    temp_engine = temp_engine - 40;
  }
  if (rxId == 0x154)  //топливо
  {
    fuel = (rxBuf[1]);
    if (fuel == 0xff)
    {
      fuel = 0;
    }
    else
    {
      fuel = ((fuel - 62) * 0.6);
    }
  }
  if (rxId == 0x424) //Напряжение бортовой сети
  {
    volt = (rxBuf[1]);
    volt = volt / 10;
  }
  display.clearDisplay();
  display.setTextSize(2);
  display.setTextColor(WHITE);

  display.setCursor(0, 10);
  display.println("C");

  display.setCursor(13, 10);
  display.println(temp_cvt, 0);

  display.setCursor(55, 10);
  display.println("F");

  display.setCursor(68, 10);
  display.println(fuel, 0);

  display.setCursor(0, 35);
  display.println("E");

  display.setCursor(13, 35);
  display.println(temp_engine, 0);

  display.setCursor(55, 35);
  display.println("V");

  display.setCursor(68, 35);
  display.println(volt, 1);
  display.display();
}