ラベル SocketCAN の投稿を表示しています。 すべての投稿を表示
ラベル SocketCAN の投稿を表示しています。 すべての投稿を表示

2021/03/27

WSL2で仮想CAN通信

  WSL2でLinuxカーネルのSocketCAN機能を使って仮想CAN通信をできるようにします。

●今回の環境

 Windows10


 ディストリビューション

 カーネルバージョン

 環境は前回と同じです。

 Linuxカーネルをビルドできる環境が必要です。下記を参考にしてビルド環境を用意してください。

●方法

 まず、SocketCAN機能、VCAN機能を有効にしたカスタムカーネルをビルドします。
 カスタムカーネルができれば、あとはCAN通信のモジュールをロードし、仮想CANデバイスを作成すれば、CANデバイスが無くてもPC内でCAN通信ができるようになります。

●カスタムカーネルの設定手順

 menuconfigを立ち上げます。
$ make menuconfig

手順1:Networking suportを有効にする


 ※選択は、項目まで↑↓キーで移動して、スペースキーを押すとできます。

手順2:CAN bus subsystem support を有効にする

 Networking support 内へ入り(リターンで入る)、CAN bus subsystem support を有効にします。


手順3:CAN通信機能の3項目を有効にする

 CAN bus subsystem support 内へ入り、さらに下記の3項目を有効にする。


 デフォルトで既にこれらの項目が有効になっていると思いますが、念のために確認しておきます。

手順4:CAN Device Drivers 内の項目を有効にする

 CAN Device Driversの中へ入り、さらに以下の設定を行います。

 Virtual Local CAN Interface (vcan) が仮想CANドライバです。
 そのほか2つがデフォルトで有効ですが、そのままにします。

手順5:設定を保存して終了する

 ここまでできたら、忘れずに設定を保存して menuconfig を終了します。
 また、Linuxカーネル名を変えておくとよいでしょう。

手順6:カーネルをビルドし、CAN通信のLKMをインストールする

$ make
$ sudo make modules_install
 → /lib/modules の下に、カーネル名でディレクトリができます。
  この下の kernel ディレクトリ以下にCAN通信に必要な*.ko ファイルが格納されます。

手順7:カスタムカーネルでWSL2を起動する

 今作った vmlinux ファイルでWSL2を再起動します。
 やり方は、以下の手順6~を参考にしてください。

手順8:CAN通信を有効にしたカーネルで起動できていることを確認する

$ uname -a
Linux earth 5.4.72-microsoft-standard-WSL2-can #1 SMP Wed Mar 27 14:20:57 JST 2021 x86_64 x86_64 x86_64 GNU/Linux

 ここまでが、CAN通信を有効にしたカスタムカーネルの作り方でした。


●仮想CAN通信デバイスを作成する

以下のコマンドを実行します。
$ sudo modprobe can
$ sudo modprobe can_raw
$ sudo modprobe vcan
$ sudo ip link add dev vcan0 type vcan
$ sudo ip link set up vcan0
 → /sys/class/net の下に、vcan0 の名前で仮想CANデバイスができます。


あとは、ふつうに仮想CAN通信をすることができます。
can-utilsも普通に使えます。

※仮想CANデバイスは、PCを再起動すると消えてしまうので、また modprobe からコマンド実行してください。

  


2017/09/17

Raspberry PiでCAN通信 その6【Pythonで標準フレームの受信】

前回のC言語で書いたCANの標準フレームの受信を
Pythonで実装します。

動作環境も前回と同じく、OS:raspbian jessie
仮想CANデバイス(vcan1)でテストしています。

#! /usr/bin/env python3
# -*- coding: utf-8 -*-

"""
    sudo modprobe vcan
    sudo ip link add dev vcan1 type vcan
    sudo ip link set vcan1 up
"""

import sys
import socket
import struct

CAN_MAX_DLEN = 8
CAN_MTU = 16

CAN_NAME = 'vcan1'

def canrecv_stdframe():

    s = socket.socket(socket.AF_CAN, socket.SOCK_RAW, socket.CAN_RAW)

    try:
        s.bind((CAN_NAME,))
    except OSError:
        print('bind error', file=sys.stderr)
        return -1

    frame = s.recv(CAN_MTU)

    id, dlc, bdata = struct.unpack('IB3x8s', frame)
    data = bdata.hex()

    s.close()

    return id, dlc, data

if __name__ == '__main__':
    def main():
        id, dlc, data = canrecv_stdframe()

        print('id=%x, dlc=%s, data=%s' % (id, dlc, data))

    main()

これで、標準フレームを1回受信し、表示して終わります。

Raspberry PiでCAN通信 その5【C言語で標準フレームの受信】

Raspberry Pi上で、C言語によるCAN通信の標準フレーム受信をします。

動作環境は、OS:raspbian jessie です。
CANデバイスは、まだCANモジュールが来ていないので、
以下のコマンドで作った仮想CANデバイス(vcan1)で受信します。
sudo modprobe vcan
sudo ip link add dev vcan1 type vcan
sudo ip link set vcan1 up

#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <string.h>
#include <errno.h>

#include <sys/socket.h>
#include <sys/ioctl.h>
#include <net/if.h>
#include <linux/can.h>
#include <linux/can/raw.h>


#define CAN_NAME "vcan1"


int canrecv_stdframe(unsigned short *p_id, unsigned char *p_dlc, unsigned char data[])
{
    int ret;
    int s;
    fd_set rdfs;
    struct ifreq ifr;
    struct sockaddr_can addr;
    struct timeval timeout;
    struct can_frame frame;
    int nbytes;

    if((s = socket(PF_CAN, SOCK_RAW, CAN_RAW)) < 0)
    {
        perror("socket");
        return -1;
    }

    memset(&ifr.ifr_name, 0, sizeof(ifr.ifr_name));
    strncpy(ifr.ifr_name, CAN_NAME, sizeof(ifr.ifr_name));

    ifr.ifr_ifindex = if_nametoindex(ifr.ifr_name);
    if(! ifr.ifr_ifindex)
    {
        perror("if_nametoindex");
        return -2;
    }

    addr.can_family = AF_CAN;
    addr.can_ifindex = ifr.ifr_ifindex;

    if(bind(s, (struct sockaddr *)&addr, sizeof(addr)) < 0)
    {
        perror("bind");
        return -3;
    }

    while(1)
    {
        FD_ZERO(&rdfs);
        FD_SET(s, &rdfs);

        timeout.tv_sec = 1;
        timeout.tv_usec = 0;

        ret = select(s+1, &rdfs, NULL, NULL, &timeout);
        if(ret < 0)
        {
            perror("select");
            return -4;
        }
        else if(0 == ret)
        {
            continue;
        }
        else
        {
            break;
        }
    }

    nbytes = read(s, &frame, sizeof(frame));
    if(nbytes < 0)
    {
        perror("recv");
        return -5;
    }

    if(nbytes == sizeof(frame))
    {
        *p_id = frame.can_id;
        *p_dlc = frame.can_dlc;
        memcpy(data, frame.data, CAN_MAX_DLEN);
    }
    else
    {
        fprintf(stderr, "recv size not std-frame.\n");
    }

    close(s);

    return 0;
}

int main(int argc, char argv[])
{
    unsigned short id;
    unsigned char dlc;
    unsigned char data[CAN_MAX_DLEN];

    canrecv_stdframe(&id, &dlc, data);

    printf("id=%x, dlc=%d, data=%.02x %.02x %.02x %.02x %.02x %.02x %.02x %.02x\n",
        id, dlc, data[0], data[1], data[2], data[3], data[4], data[5], data[6], data[7]);
}


これで、標準フレームを1回受信し、表示して終わります。

CAN標準フレームの受信に必要な処理は、これでわかりました。

次は、これをpythonで実装します。

2017/09/16

Raspberry PiでCAN通信 その4【Pythonで標準フレームの送信】

前回のC言語で書いたCANの標準フレームの送信を
Pythonで実装します。

PythonでCAN通信するには、python-canを使えばよいようですが、
私の職場はインターネットに接続させてもらえないので、
pipでpython-canをインストールすることができません。

pythonでsocketが使えるので、SocketCANを使って、
CAN通信するプログラムを作ることにしました。

動作環境も前回と同じく、OS:raspbian jessie
仮想CANデバイス(vcan1)でテストしています。

#! /usr/bin/env python3
# -*- coding: utf-8 -*-

"""
    sudo modprobe vcan
    sudo ip link add dev vcan1 type vcan
    sudo ip link set vcan1 up
"""

import sys
import socket
import struct

CAN_MAX_DLEN = 8
CAN_MTU = 16

CAN_NAME = 'vcan1'

def cansend_stdframe(id, data):

    if(CAN_MAX_DLEN < len(data)):
        print('dlc too long.', file=sys.stderr)
        return -1

    s = socket.socket(socket.AF_CAN, socket.SOCK_RAW, socket.CAN_RAW)

    s.setsockopt(socket.SOL_CAN_RAW, socket.CAN_RAW_FILTER, None, 0)

    # no loopback
    loopback = 0 # 0 = disabled, 1 = enabled(default)
    s.setsockopt(socket.SOL_CAN_RAW, socket.CAN_RAW_LOOPBACK, loopback)

    try:
        s.bind((CAN_NAME,))
    except OSError:
        print('bind error', file=sys.stderr)
        return -4

    dlc = len(data)
    bdata = bytes(data)
    frame = struct.pack('IB3x8s', id, dlc, bdata)

    if(s.send(frame) < CAN_MTU):
        print('send', file=sys.stderr)
        return -5

    s.close()

    return 0

if __name__ == '__main__':
    def main():
        data = [ 0x11, 0x22, 0x33, 0x44 ]
        cansend_stdframe(0x0123, data)

    main()

これで、id=0x123,data=0x11 0x22 0x33 0x44 のデータを1回送信します。



2017/09/11

Raspberry PiでCAN通信 その3【C言語で標準フレームの送信】

Raspberry Pi上で、C言語によるCAN通信の標準フレーム送信をします。

can-utilsのソースコードを解析した結果、
標準フレームの送信をする処理を起こしました。

動作環境は、OS:raspbian jessie です。
CANデバイスは、まだCANモジュールが来ていないので、
以下のコマンドで作った仮想CANデバイス(vcan1)で送信します。
sudo modprobe vcan
sudo ip link add dev vcan1 type vcan
sudo ip link set vcan1 up

#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <string.h>
#include <errno.h>

#include <sys/socket.h>
#include <sys/ioctl.h>
#include <net/if.h>
#include <linux/can.h>
#include <linux/can/raw.h>

#define CAN_NAME "vcan1"

int cansend_stdframe(unsigned short id, unsigned char dlc, unsigned char data[])
{
    int s;
    struct ifreq ifr;
    struct sockaddr_can addr;
    struct can_frame frame;
    int loopback;

    if(CAN_MAX_DLEN < dlc)
    {
        fprintf(stderr, "dlc too long.\n");
        return -1;
    }

    memset(&frame, 0, sizeof(frame));
    frame.can_id = id;
    frame.can_dlc = dlc;
    memcpy(&(frame.data[0]), &(data[0]), dlc); 

    if((s = socket(PF_CAN, SOCK_RAW, CAN_RAW)) < 0)
    {
        perror("socket");
        return -2;
    }

    memset(&ifr.ifr_name, 0, sizeof(ifr.ifr_name));
    strncpy(ifr.ifr_name, CAN_NAME, sizeof(ifr.ifr_name));

    ifr.ifr_ifindex = if_nametoindex(ifr.ifr_name);
    if(! ifr.ifr_ifindex)
    {
        perror("if_nametoindex");
        return -3;
    }

    addr.can_family = AF_CAN;
    addr.can_ifindex = ifr.ifr_ifindex;

    setsockopt(s, SOL_CAN_RAW, CAN_RAW_FILTER, NULL, 0);

    /* no loopback */
    loopback = 0; /* 0 = disabled, 1 = enabled(default) */
    setsockopt(s, SOL_CAN_RAW, CAN_RAW_LOOPBACK, &loopback, sizeof(loopback));

    if(bind(s, (struct sockaddr *)&addr, sizeof(addr)) < 0)
    {
        perror("bind");
        return -4;
    }

    if(write(s, &frame, CAN_MTU) < CAN_MTU)
    {
        perror("write");
        return -5;
    }

    close(s);

    return 0;
}

int main(int argc, char argv[])
{
    unsigned char data[] = { 0x11, 0x22, 0x33, 0x44 };

    cansend_stdframe(0x0123, sizeof(data), data);
}

ループバックをoffにしているので、candumpで見ていても、何も出てきません。
loopbackの値を1にすれば、出てくるようになります。

CAN標準フレームの送信に必要な処理は、これでわかりました。

次は、これをpythonで実装します。

2017/09/10

SocketCANによる仮想CAN通信

Raspberry PiでCAN通信しようと、CAN-Utilsの中身を調べています。

LinuxのSocketCANを利用して通信しているようでした。

SocketCAN

SocketCANとは何ぞやと、上記の文章を読んでいると、
以下の章で衝撃を受けました。

6.4 The virtual CAN driver (vcan)

なんと、仮想CANドライバという機能があるようです。

CANデバイスをリンクアップするときに、
実デバイスがなくても、仮想的なCAN通信ができるようです。
仮想デバイスを作る方法は以下の通り。
$ sudo modprobe vcan
$ sudo ip link add dev vcan0 type vcan
$ sudo ip link set vcan0 up

これで、/sys/class/net の下にvcan0ができ、
vcan0 という名前でデバイスが利用できるようになります。

以下は、CANデバイスが無いPC上で、CAN-Utilsを使用した例です。

送信側


受信側


こんなことができるなら、CANモジュール買わなくてもよかったか・・・
まあ、CANモジュールが届くまでは、仮想CANで開発ができそうだ。