ROSでラズパイのGPIOをちゃんと使うには

【後日追加】WiringPi-Pythonを使ってsudoなしで実行する方法がわかりました。こちらの投稿をみてください。

前回の続きです。このバージョンのWiringPi-PythonではsudoなしではGPIOが使えないのがはっきりしたので、WiringPiを入れるともれなく付いてくるgpioコマンドをpythonから使ってみました。入力ポートで押しボタンの状態を読んで、押されたらLEDを点灯するROSノードです。

#!/usr/bin/env python
import roslib
import rospy
import time
import subprocess

#main
if __name__ == '__main__':
    ### init io port ###
    subprocess.check_call('gpio export 17 out',shell=True)
    subprocess.check_call('gpio export 18 in',shell=True)
    ###
    rospy.init_node('swtest')

    while not rospy.is_shutdown():
        sens = subprocess.check_output('gpio -g read 18',shell=True) 
        if '0' in sens:
            subprocess.check_output('gpio -g write 17 1',shell=True)
        else:
            subprocess.check_output('gpio -g write 17 0',shell=True)
    print('\rStopped')

GPIO18にプルアップされたボタンSWを押すと0になるように接続、GPIO17にLEDを１で点灯するよう接続します。roscoreを起動しておくのを忘れないでください。ボタンを押すとLEDが点灯するはずです。

これで一件落着と言いたいところですが、まだ問題が残ります。それは実行速度です。下の写真はポートに１を書いてすぐ０を書くという無限ループを走らせた時のポートの波形です。つまりポートに書く関数の実行速度を測定したものです。

これは以前ROSでWiringPi-Pythonを使った場合です。（クリックで拡大します）

　＃ラズパイ２で実行

時間軸は5us、１回の入出力にかかる時間は8us程度です。これならモーターの回転数を読んだり、簡易的なPWMを行ったりすることも可能です。しかし、今回のgpioコマンドを使った方法ではそうはいきません。

　＃ラズパイ３で実行

一見前の写真と変わりませんが、時間軸が違います。時間軸10ms、波形から読み取れる１回の入出力の時間はなんと16msです。まさに桁違いに遅くなっています。これはシェルコマンドを呼び出している関係でどうしてもしょうがありません。１回の読み書きにこれだけなので、例えば４個のボタンをチェックするには４倍の64mSかかる計算になります。

押しボタンでのUIとか、以前作った「光を追いかけるロボット」くらいのレスポンスなら充分ですが、積極的に制御に使うのはちょっと苦しいですね。前の投稿で書いたようにセンサやモーターが簡単に接続しやすいため、ROSが身近になるという効果は大きいので、この辺は我慢することにしましょう。