CANSIM-Nano/HTSCANSIM.ino

55 lines
824 B
C++

#include <SPI.h>
#include <mcp_can.h>
#define CAN0_INT 2
MCP_CAN CAN(10);
INT32U canId = 0x000;
unsigned char len = 0;
unsigned char OBDIImsg[8] = {4, 65, 0, 0, 0, 0, 0, 0};
byte buf[8];
String CMD = "";
char msgString[64];
byte PID = 0;
byte MODE = 0;
bool IsSweep = true;
byte sweep = 0;
//Adjustable values
byte Load = 5;
byte TPS = 15;
int TA = 10;
float O2 = 1;
int ECT = 0;
int IAT = 0;
byte MAP = 0;
int RPM = 1000;
int MAF = 10;
byte VSS = 25;
byte FP = 10;
void setup() {
Serial.begin(115200);
Serial.setTimeout(50);
Serial.println(("HTS CAN SIM 01"));
if (CAN.begin(MCP_ANY, CAN_500KBPS, MCP_8MHZ) == CAN_OK)
{
CAN.setMode(MCP_NORMAL);
pinMode(CAN0_INT, INPUT);
}
else
{
Serial.println("Setup Failed");
;
}
}
void loop() {
DOCAN();
if (Serial)
{
DOSERIAL();
}
}