58
59

Delete article

Deleted articles cannot be recovered.

Draft of this article would be also deleted.

Are you sure you want to delete this article?

More than 5 years have passed since last update.

Raspberry Piで自動運転やってみる 1.車体の準備

Last updated at Posted at 2018-05-04

この記事は全3回のうちの1つ目の記事です。つづきもご覧ください。
1.車体の準備(本記事)
2.自動ブレーキ
3.障害物回避

概要

Raspberry Pi Zero Wを手に入れたので、自動運転をやってみたいと思います。
自動運転といっても本格的なものは難しいので、画像処理ベースで障害物を避けて走る機能を実現することにします。

作りたいのはこんなモノです:

  • 小さい(部屋の中で遊べる)
  • 障害物を避けて走る(ライントレースよりは賢いことをしたい)
  • 本体だけの計算リソースで動く
  • 距離センサーは使わない
  • 汎用品をつかって簡単につくる
  • 前輪ステアリング(戦車みたいな方式ではなく)

今回の記事は準備編ということで、モノを作ってラジコンとして動かすところまでについて、制作のポイントを記しておきます。

完成したもの

IMG_20180504_113439287.jpg
前から

IMG_20180504_113445118.jpg
後から

IMG_20180504_113602574.jpg
横から

IMG_20180504_113535715.jpg
サーボ・ステアリング部

部品構成

モノ 備考
バギー工作基本セット http://www.tamiya.com/japan/products/70112/index.html
ユニバーサルプレートセット http://www.tamiya.com/japan/products/70098/index.html
ユニバーサルアームセット http://www.tamiya.com/japan/products/70143/index.html
モバイルバッテリー http://amzn.asia/iyV9B5Z
Raspberrypi Zero W
カメラモジュール https://shop.pimoroni.com/products/raspberry-pi-zero-camera-module
レンズコンバーター 100円ショップにあります
ユニバーサル基板 http://akizukidenshi.com/catalog/g/gP-12188/
ピンソケット
サーボモーター SG-90 http://akizukidenshi.com/catalog/g/gM-08761/
モータードライバー TA-7291P http://akizukidenshi.com/catalog/g/gI-02001/
9軸センサー MPU-9250モジュール http://amzn.asia/cdr65M9
電子部品・配線等
エポキシ接着剤 100円ショップにあります
その他ネジや木材等

#車体について

  • 車体はタミヤのセットを使います。ユニバーサルプレートセットを使って2階建て構成にすることで、回路やカメラのマウントが簡単になります。シャーシ上にバッテリー、2階部分に回路とサーボモーターを配置。
  • ユニバーサルアームセットに入っているスペーサーを柱にします。
  • シャーシへのネジ取り付けは下穴を開けておかないと割れますので注意。
  • このキットはサスペンション付きなので、動く空間を確保しつつユニバーサルプレートをカット。
  • サーボ取付け部は現物合わせしながら加工します。
  • ステアリングとサーボの接続部は、硬めの針金をL字にしてエポキシ接着剤で固めています。見えにくいですが上記写真も参照ください。
  • 前輪のブッシュが緩みがちなので、接着剤でとめておきます。
  • カメラモジュール自体の画角が結構狭く、旋回時の行く先が見えないいので、対策のために魚眼コンバーターレンズを使います。
  • 視野を確保するためにカメラ自体も後ろのほうに配置したほうが良いですが、ケーブル長に余裕がないので、とりあえずサーボモーターの裏側にマウントしています。カメラ配置に関してはもっと工夫した方がいいです。

電気系について

  • 電池はLiPoや乾電池だと電圧変換が面倒なので、モバイルバッテリーをつかいます。微妙に車体サイズにハマるものが見つからないですが、とりあえずリストにあるもので。左右にはみ出しますがケーブル一体型なのでそこそこスッキリまとまります。
  • Raspiの上に乗せる回路は秋月のFRISK基板がちょうどいい感じです。
  • DCモーターの駆動に必要なモータードライバは、実績の多そうなTA7291Pを選びました。vrefを決めるために数kΩの抵抗を入れます。
  • モータードライバはvrefを変えるのではなく、inputをpwmにして動かします(発熱を抑えられるらしい)。
  • モーターの端子間には電子系への影響を抑えるためにコンデンサーを取り付けます。
  • 9軸センサーモジュールはI2Cポートにつなぎます。
  • サーボモーターはハードウェアPWMができるポートにつなぎます。これも電源はRaspiと共有します。
  • 電源をモーターとRaspiとで共有していますので、電源の安定化のためコンデンサーをつけておきます。

ソフトウェアについて

  • RaspbianOSを使います。
  • Gstreamerバックエンドとpythonモジュールを使える状態でOpenCV3.3をインストールします。
  • rpicamsrcをインストールします。
  • raspi-configでカメラやGPIOを設定します。
  • GPIOでモーターを制御する方法や、PWMでサーボを制御する方法については他にも記事があるので割愛します。

ラジコンとして動かす

各種IOを叩けば、後輪モーターやステアリングが動きます。こんな感じでクラス化しています:

car_controller.py
import wiringpi as wp

class CarController(object):

    FORWARD_PIN = 6
    BACKWARD_PIN = 5

    STEER_PIN = 18
    STEER_MIN = 65
    STEER_MAX = 89

    def __init__(self):
        # slottle
        wp.wiringPiSetupGpio()
        wp.pinMode(CarController.FORWARD_PIN,1)
        wp.softPwmCreate(CarController.FORWARD_PIN,0,100)
        wp.pinMode(CarController.BACKWARD_PIN,1)
        wp.softPwmCreate(CarController.BACKWARD_PIN,0,100)
        # steering
        wp.wiringPiSetupGpio()
        wp.pinMode(CarController.STEER_PIN,2) # Hardware PWM
        wp.pwmSetMode(0)
        wp.pwmSetRange(1024)
        wp.pwmSetClock(375)
    
    def slottle(self,x):
        """
        x: -1.0 to 1.0
        """
        x = int(max(-100,min(100,100*x)))
        if 0<=x:
            wp.softPwmWrite(CarController.FORWARD_PIN,abs(x))
            wp.softPwmWrite(CarController.BACKWARD_PIN,0)
        if x<0:
            wp.softPwmWrite(CarController.FORWARD_PIN,0)
            wp.softPwmWrite(CarController.BACKWARD_PIN,abs(x))

    def steer(self,x):
        """
        x: -1.0 to 1.0
        """
        a = 0.5 * (CarController.STEER_MAX - CarController.STEER_MIN)
        b = 0.5 * (CarController.STEER_MAX + CarController.STEER_MIN)
        x = int(max(CarController.STEER_MIN,min(CarController.STEER_MAX, a*x+b)))
        wp.pwmWrite(CarController.STEER_PIN,x)

    def brake(self):
        wp.softPwmWrite(CarController.FORWARD_PIN,100)
        wp.softPwmWrite(CarController.BACKWARD_PIN,100)

rpicamsrcを使うと、Gstreamer経由でOpenCVによる画像処理や別のPCへのストリーミングなどができます。

ここまでやれば、「一人称カメラつきラジコン」として動かすことができます。これだけでも結構面白いです。
Websocket通信でスマホから操作する、Bluetoothジョイスティックで操作するなど工夫するといいと思います。本題からはずれるのでここでは割愛しますが、コードが整理できれば公開するかもしれません。

つづき

自動ブレーキ編に続きます。

58
59
3

Register as a new user and use Qiita more conveniently

  1. You get articles that match your needs
  2. You can efficiently read back useful information
  3. You can use dark theme
What you can do with signing up
58
59

Delete article

Deleted articles cannot be recovered.

Draft of this article would be also deleted.

Are you sure you want to delete this article?