arduinoでインスツルメント クラスター その2

概要

arduino unoでcanからインスツルメント　クラスターを操作した。
シリアルから、コマンドで操作してみた。

写真

サンプルコード

コマンド	rpm	speed
a	1000	20
b	3000
c	5000
d		40
e		100

#include <SPI.h>
#include "mcp_can.h"

MCP_CAN CAN(10);
unsigned char stmp[8] = {
    0,
    0,
    0,
    0,
    0,
    0,
    0,
    0
};

void setup() {
    Serial.begin(115200);
START_INIT:
    if (CAN_OK == CAN.begin(CAN_1000KBPS))
    {
        Serial.println("CAN BUS Shield init ok!");
    }
    else
    {
        Serial.println("CAN BUS Shield init fail");
        Serial.println("Init CAN BUS Shield again");
        delay(100);
        goto START_INIT;
    }
    Serial.print("\n>");
}
int rpm = 3000;
int speed = 40;
void loop() {
    if (Serial.available() > 0) 
    {
        char c = Serial.read();
        if (c == 13) 
            return;
        Serial.print(c);
        switch (c) 
        {
        case 'a':
            rpm = 1000;
            speed = 20;
        break;
        case 'b':
            rpm = 3000;
        break;
        case 'c':
            rpm = 5000;
        break;
        case 'd':
            speed = 40;
        break;
        case 'e':
            speed = 100;
        break;
        default:
            rpm = 7000;
            speed = 180;
        break;
        }
        Serial.print("\n>");
    }
    stmp[0] = (rpm * 4) / 256;
    stmp[1] = (rpm * 4) % 256;
    stmp[4] = (speed * 100 + 10000) / 256;
    stmp[5] = (speed * 100 + 10000) % 256;
    CAN.sendMsgBuf(0x201, 0, 8, stmp);
    delay(100);
}

以上。