2013年7月29日月曜日

メモ:いつものI2C

ArduinoでI2Cを使うときによく使うコピペ用

↓ここから
//書き込み
Wire.beginTransmission();
Wire.write(0x);

Wire.endTransmission();


//読み込み、パターンはデータシート確認のこと
Wire.beginTransmission();
Wire.write(0x);
Wire.endTransmission(false);
Wire.requestFrom(int(),1,false);
output = Wire.read();

Wire.endTransmission(true);

//連続読み込み(6つのレジスタから1byteずつ読み込む場合)
byte addr[6]={0x,0x,0x,0x,0x,0x,};
byte read_data[6]={0,0,0,0,0,0};   //2byte以上のときは2次元配列に

for(int i=0;i<6;i++){
Wire.beginTransmission( );
Wire.write( addr[i] );
Wire.endTransmission(false);
Wire.requestFrom(int( ),1,false);
read_data[i] = Wire.read();   
Wire.endTransmission(true);
  }

//データを8ビットシフトして他のbyteとつなげる。便利

int hl_joint(byte high,byte low){
  int high_data = int(high) << 8;
  int output = high_data | int(low);

  return output;
}

//レジスタ6つのデータを読み込んで繋げて出力する関数。3軸センサーに。
//devはデバイスのアドレス、xyzは出力を入れる配列(出力の型は自由)
void read_xyz(byte dev,int xyz[]){

byte addr[6]={0x,0x,0x,0x,0x,0x};
byte read_data[6]={0,0,0,0,0,0};   //2byte以上のときは2次元配列に

for(int i=0;i<6;i++){
Wire.beginTransmission(dev);
Wire.write( addr[i] );
Wire.endTransmission(false);
Wire.requestFrom(int(dev),1,false);
read_data[i] = Wire.read();   
Wire.endTransmission(true);
  }
// read_data[0]=Low_byte ,read_data[1]=High_byte・・・の場合

for(int j=0;j<3;j++){
 xyz[j]=hl_joint(read_data[2*j+1],read_data[2*j]);
}

}

とりあえず以上

2013年7月15日月曜日

夏休み前の工作(2) ~ArduinoでI2Cモータドライバを動かしたときのメモ~

秋月電子とかストロベリーリナックスで売ってるDRV8830を使ったモータードライバモジュールをかろうじて使えるようになったのでそのあたり+ArduinoでI2Cを使うにあたっての自分用メモ

この記事の内容によって生じたことの責任は取りかねますのであくまで自己責任でお願いします。


1、重要な参考文献: mixture-art@Q 様の記事(「Arduino I2C」でぐぐるとトップに出る)

http://mixture-art.net/arduino%E3%81%A7i2c%E9%80%9A%E4%BF%A1%E3%82%92%E3%82%84%E3%82%8B%E9%9A%9B%E3%81%AE%E3%83%A1%E3%83%A2/

↑参考にしないとI2C用ライブラリ(Wire)で適切なデータ受信ができなくなる。じぶんでC言語とかで解決するハメに・・・

2、DRV8830の日本語データシート(ストリナのDRV8830ドライバのページにリンクがある)

↑見ないと使い方がわからない(秋月のドライバのトリセツは情報が不十分)


とりあえず以下が最低限動くソースとコメント↓

ArduinoIDEに最初から入ってる 「master_writer」をベースに改造

#include <Wire.h>

byte m_driver=0x64;  ←A0 A1をオープンにしてるとドライバのアドレスは
「1100100」=「01100100」→16進数にすると「0110(←6) 0100(←4)」=64(HEX) となる。重要

↓モータの速度を設定する関数。適当
void setmotor(byte val,byte ori){  ←モータ出力設定(VSET)とブリッジ制御用の2ビットを入力
  Serial.print("setmot start\n");
  Wire.beginTransmission(m_driver); ←「書き込みモード」でドライバと通信開始。この命令を使うと勝手にアドレス(7桁)の末尾に「0(Write)」が加えられて通信される(長期間詰まった)
  Wire.write(0x00);  ←サブアドレス。レジスタ0(アドレス:0x00)のアドレスを送信
  byte sp6=val << 2; ←引数valを2ビット左にシフト
  byte mot = sp6|ori; ←方向の2ビットとorをとる。これで送信用のデータバイトができる。  Serial.println(mot,HEX); ←なんとなくシリアルに出力
  Wire.write(mot);  ←データバイトを送信。ちゃんと通ればモータが回ったりする。

  Wire.endTransmission();    ←通信終わり。「STOP」ビットをドライバに送信する。 
}

void fault_clear(){ ←faultレジスタ(0x01のレジスタ)内の障害状態をリセットする。フェールの種類によってはリセットしないとドライバが使用できない場合がある。
  Serial.print("fault_clear\n");
  Wire.beginTransmission(m_driver);
  Wire.write(0x00);       
  Wire.write(B10000000);     ←第7ビットに1を書き込むとフェールのログが消える。
             
  Wire.endTransmission();

}

void setup()
{
  Wire.begin();
 
  Serial.begin(9600);
  Serial.println("\n set ");
  Serial.println(m_driver,HEX);
 
  fault_clear();    ←最初に一応フェールをリセットしておく
}


ここからメインループ
void loop()
{
↓適当にモータを動かしてみた。第1引数は0x3fあたりが最大、第2引数は0x0,1,2,3のどれかを入力。詳しくはデータシート参照。待ち時間は別に2秒とかじゃなくていい(多分不要)
 delay(2000);
 setmotor(0x1E,0x0);
 delay(2000);
 setmotor(0x1E,0x0);
 delay(2000);
 setmotor(0x3E,0x0);
 delay(2000); 
   

↓ここからデータ読み出し。非常に重要な箇所あり(知らないとI2Cデータ受信できない)

  Serial.print("0x01 read start\n");
  Wire.beginTransmission(m_driver);  ←受信だけど書き込みモードでデータ通信開始、ドライバの仕様。
  Wire.write(0x01);        ←読みたいレジスタのアドレス
  Wire.endTransmission(false); ←参考文献より。これを入れないとドライバとの通信が維持できない。

  Wire.requestFrom(int(m_driver),1,false);  ←読み込みモードで通信開始。こちらは勝手に末尾に「1(read)」が付け加えられる。ドライバのマニュアルに「アドレス(書き込み)、アドレス(読み込み)」とか親切に書いてくれているが、そのアドレスは末尾の0,1を加えたアドレスなのでそれをこことかbeginTransimission()に入れても通信できない。こんな馬鹿なところでハマってしまってドライバを数ヶ月放置してた・・・(つд;)

  byte out = Wire.read();     ←普通にread。
  Serial.println(out,HEX);  ←シリアルに出力して内容を確認

  Wire.endTransmission(true);    ←通信終了。()内のtrueは必要。これも参考文献より
  delay(2000);

↓レジスタ0も同様にreadしてみる。
 Serial.print("0x00 read start\n");
  Wire.beginTransmission(m_driver);
  Wire.write(0x00);       
 Wire.endTransmission(false);
  Wire.requestFrom(int(m_driver),1,false);
  byte out2 = Wire.read();              
  
  Serial.println(out2,HEX);

  Wire.endTransmission(true);   
  delay(2000);
}










あと、配線について。電流センス抵抗に適切な抵抗をつないでGND接続しないといけないが、制限とか気にしないのであればここはGND直結でいい(直結(か小さい抵抗をGND接続)しないとドライバが動作しない。注意)。Faultnのピンは何も接続しなくても動作した。

以上。上記の情報でモータを動かせる・・・はず。動作確認したが動かせるモーターと動かせないモータがあった(ドライバのせいでは無く、多分電流流れすぎか何かで何らかの制限がかかってると推測)

 今回ArduinoのWireライブラリの親切設計(自動的にW,Rビットを付加)についてよく理解してなかったのがひどかった。しかしこれで他のI2Cデバイスも普通に使えるようになるはず( ´д`)b

2013年7月13日土曜日

夏休み前の工作(1)

今回つくったのはこちら↓
















 なんてことはないただのUSBハブですが、USBの線が2つ出ています。
片方は電源用、片方は信号用になっており、スマホ用USBチャージャーなんかから
電源を取れるようにしてあります。 これで電源用のインターフェースをUSBに統一できる。

















 つなぎ方(重要) : 試行錯誤があったが以下のように配線します。

1、元から繋がってるV+線を切断、こっちはオープンにしておく
2、 基板のV+と外部電源用電源V+線(写真手前赤線)を半田付け
3、外部電源用GNDを基板GNDに半田付け、元からある線と一緒につける(GNDを共通にする)
4、外装に適当な穴を開ける
5、いろいろ絶縁とか、ショートしないように注意


















Raspberrypi とかPCでも一応正常動作を確認(なんとなく不審な挙動がみられたけど・・・)
よい子は真似しないでね。

~おわり~

2013年6月9日日曜日

ラジコンできたよー(・ω・)ノ Ⅱ  ~android - raspberry pi - arduino を使った入出力~

最近なかなか気が向かずに放置していたラジコンを有給とった勢いで一通り作ってみました。

早速現物を↓
 
←上から。必要なデバイスを無駄なく筐体に搭載する。筐体は軽量かつ低コストな素材を使用・・・どう見ても空き箱にぶち込んだだけ(´;ω;`)。


←斜め。前方にwebカメラ(ヨドバシで500万円)を搭載。


←正面。下半分は前回同様タミヤのやつ。そろそろキャタピラがぼろくなってきた。多分呼ばないがラジコンの名前をSAGAWAと命名。












↓動作のようす。

 

片手がカメラでふさがっているので操作がひどいことになっていますが、今のところ
・シークバーで速度調整(後退も可)、
・左右に(全力で)傾けるとそっちに曲がる。
・タブレットに車載カメラの映像が映る(10~15fps)。
機能を実装。
(片手で撮影して無ければ)どうにかラジコンとして遊べます。

とりあえず動いてしまえばラジコン自体は割とどうでも良くて、各デバイス間のプロトコルとかソフトの方が個人的に重要だったりします。ここをしっかり作っとけば後でヘリでもロボットでも(対応したヘリとかロボットを作りさえすれば)動かせるので。

でも今日は疲れたのでそのへんのメモはまた来週。



2013年5月8日水曜日

明日のためのメモ pythonでバイナリ

pythonを使ってバイナリデータ(長さ不定のヘッダあり)を変数に読み込み特定の文字ごとに区切ってリストに入れて、区切られた要素はときどき要素数が一定でないのに対応して任意のパターンでアンパックしたいときの処理がしたいなー( ´・ω・`) というときに使えそうなプログラムのメモ

こんなバイナリ入力→「****123*****123*****123**123***」

を↓こんな感じで出力、output[]の中身を一行ずつCSVに入れたりすると幸せになれるかもしれない。

output=[[aaaa],[123,100,200],[123,20,30],[123,34,12,12],[123,0,2]]

関数にしてみた↓ conは入力(バイナリ)

def binparse(con):
    con=con.replace('123','\n123')
    con=con.split('\n')
    print "replaced\n",con
    cnt=0
    for i in con:
        if 1<cnt<(len(con)) and i[0:2] !='ab':  ←配列の修正。区切り文字が意図しないところにはいっていてもこれでたぶん修正できる。
            con[cnt-1]=con[cnt-1]+"\n"+i
            con.pop(cnt)
       
        cnt += 1

    out=[]
    cnt=0
  
    fmt1='2c6hi'  ←文字数ごとに適当なフォーマットを設定。パターンが増えそうだとインデックス
    fmt2='2c3hc'   とかリストにまとめたほうがいいかも
    for i in con:
        l=len(i)
        if l==20: ←長さが20だったら~fmt以外は同じ処理
            tmp=struct.unpack(fmt1,i)
            tmp2=[]
            for j in range(len(tmp)):
                           
                tmp2.append(tmp[j])
            print out
            out.append(tmp2)
        elif l==9:
            tmp=struct.unpack(fmt2,i)
            tmp2=[]
            for j in range(len(tmp)):
                           
                tmp2.append(tmp[j])
            print out
            out.append(tmp2)
            pass
        cnt += 1
   
    f.close()
    return out

2013年5月6日月曜日

GWの工作(2) ~androidとpythonのソケット通信に関するメモ~

raspberry piというたのしいおもちゃを買ってしまったのでxbeeは投げ捨ててwifiを使った通信を試みる今日この頃。今回はその辺のメモ

・今回はデータをandroidタブレット→(wifi)→raspberrypi(python)→(シリアル)→arduino の経路で流すシステムを考えます。

・pythonをソケットのサーバ、androidをソケットのクライアントとします。

■まずpythonのソケット通信から、これは以前もやったのでわりとスムーズだった。

 通信用のスレッド(抜粋)↓ ※メインのスレッド(main())が回ってないとおかしいことになる。main()は適当に無限ループにしておく

class tcpthread(threading.Thread):
    def __init__(self):
        threading.Thread.__init__(self)

    def run(self):
        host = '○○○.○○○.○○○.○○○'  ←IPアドレス
        port =(ポート番号)

        tcpcom=0   ←ポート処理用のフラグ(後述)

       ↓ソケットのインスタンスを作成
        s = socket.socket(socket.AF_INET, socket.SOCK_STREAM)

        while tcpcom==0:   ←ポートが詰まってたら別のポートを探す処理(何度もテストしてるとたまにポートが詰まる。時間経過でまた開くが面倒なので別のポートをスキャンする)
            try:
                s.bind((host,port))
                tcpcom=1   ←ポートがあったらフラグを立ててループ脱出
                print "connection port:",port  ←つながったポートを表示。android側はこれを入力             except:
                port =port +1 ←詰まってたら次のポートへ

    s.listen(1) ←受け付けるクライアントは1つのみ

    ↓通信ループ
    while True:
            print "waiting"
            conn,addr=s.accept()  ←クライアントからの接続待ちつながるまでここで止まる
            print "accept port :",conn,"addr :",addr   ←つながったIPを表示
            data=conn.recv(120)       ←クライアントからデータ受け取る()内は受け取るバイト数

      conn.send("send python\n")  ←クライアントにデータ送信


    //s.close() ←ソケットのクローズ。通信ループの外にあることに注目。今のところソケットは開けっ放しである。


 if __name__ == '__main__':
    tcp= tcpthread()
    tcp.setDaemon(True)  ←スレッドを綺麗に終わらせる呪文。
    tcp.start()
    time.sleep(1)
    main()


■次にandroid。初心者だったので辛かったが以下の参考資料などを参考にどうにか実装
http://yamato-iphone.blogspot.jp/2012/06/blog-post_5123.html

まずマルチスレッドのやり方。AsyncTaskというクラスを使うのが正道っぽいがなんだか面倒くさそうだったのでもっと楽なやり方(ハンドラを使った普通のマルチスレッド)で実装
public class MainActivity extends Activity {

↓(実質的な)グローバル変数
private Handler mHandler;  ←ハンドラを作っておく
 serverflag =0;  ←サーバーがあるかどうかのフラグ。後述

↑ここまでグローバル変数
protected void onCreate(Bundle savedInstanceState) { 

~略~

mHandler =new Handler(); ←ハンドラのインスタンス作成

/////マルチスレッド、ハンドラを使っているからGUI書き換えもできる。onCreateの中に書いてしまっている
        (new Thread(new Runnable() {

            @Override
            public void run() {
                    while(true){
                         mHandler.post(new Runnable(){
                             @Override
                             public void run(){
       ↑ここまでほぼ呪文。普通のマルチスレッドの中でハンドラを経由した処理を実行している(と思う)。GUIの更新が絡む処理がこのrun()のなかでやること。でないと例外が出る仕様
                                 socketcom("test")    ←後述するソケット通信関数
                                 textview1.setText(Integer.toString(”文字”));
                                 System.out.println("マルチスレッド 通過");

                                


                             }
                             });
                       
                        try { ←マルチスレッドのtry

                                    Thread.sleep(30); ←ウエイトを設定。別にここじゃなくてもいい。通信が絡む場合はウエイトが必要
↓以下も呪文
                            } catch (InterruptedException e) {}
                    }
            }
    })).start();
        ///////ここまでマルチスレッド

○ここからソケット通信の話↓ というか自分用テンプレート関数

public void socketcom(String str){ ←引数は別になんでもいい。無くてもいい
if (serverflag != 1){   ←サーバ無かったら以下の処理素通り
    try {
        //タイムアウトを設定。この辺は重要。タイムアウトを手動設定しないと通信途絶と同時にアプリも止まる。socket =new Socket(IP,PORT) で一発接続しないのがコツ


        InetSocketAddress addr = new InetSocketAddress(ipaddr, port); ←とりあえずアドレスだけ専用のインスタンスにまとめておく。あと当然だがアドレスとポートはサーバのものを設定する
        socket =new Socket(); ←カラのソケットを作る
        socket.connect(addr,500); ←ソケットを接続。引数の数字はタイムアウト時間(ms)。時間はお好みで
       
↓ 入力と出力のストリームを作っておく。ほぼ呪文。生の通信データ(byte)を使いやすい形に変換しているためなんか複雑になっている模様
        DataOutputStream out = new DataOutputStream(socket.getOutputStream());

        BufferedReader inp = new BufferedReader(new inputStreamReader(socket.getInputStream()));

↑入出力定義

         out.writeBytes(str);  ←ソケットへの出力。pythonに届く

        String responseLine="";    入力を入れる変数。↓のifの中で作ってもいいかも

        if ((responseLine = inp.readLine()) != null) { ←「何かサーバから来てたら(呪文)」
                //System.out.println("Server: " + responseLine+cnt);
                textview.setText("Server: " + responseLine); 来たデータを任意に処理
            }else{

                System.out.println("null in");
            }

            out.close();   
            inp.close();
        socket.close();  ←クライアント側はサーバと違って開けっ放しにしない。一通信ごとに閉じる。開けっ放しにしようとして半日つぶした(個人的には開けっ放しにしたいが・・・)。



         } catch (UnknownHostException e) { ↓勝手に生成される例外処理IOのほうは重要
            e.printStackTrace();
            System.out.println("UnknownHost err"+e);
             textview.setText("Server:none (unknownhost)" );
            return;
        } catch (IOException e) {
            e.printStackTrace();
            System.out.println("io err"+e);
            tv.setText("Server:none (IO) " );
            serverflag=1;     ←「サーバー無し」のフラグを立てる。後から別のボタンとかでこれを0にすると再接続できる(実装してないから予想)
            return;
        }

}else{
    tv.setText("サーバーが見つかりませんでした " ); ←サーバ無かったときの処理。適当に。

}

androidのソケット通信ここまで

おまけメモ : ~とりあえずボタン~ ちょっとボタンがいるときに

public class MainActivity extends Activity { Button bt;
protected void onCreate(Bundle savedInstanceState) {

bt = new Button(this);
bt.setText("button");

(レイアウト).addView(bt);
bt.setOnClickListener(new View.OnClickListener() {

            @Override
            public void onClick(View v) {
                

                (ボタンが押されたときの処理)
               
            }
       });


~androidでwebカメラの映像を見る~ ここも死ぬほど詰まった。どうにもならず結局外部ライブラリ(MjpegView Class)を使うことに(GNU GPL v3 注意)。
使い方抜粋(大きさ固定の仕方)
mjv=new MjpegView(this) {//表示の大きさを固定にする
             @Override
             protected void onMeasure(int widthMeasureSpec, int heightMeasureSpec) {

              super.onMeasure(widthMeasureSpec, heightMeasureSpec);

              setMeasuredDimension( 320 , 240 );
             }
            };
mjv.setSource(MjpegInputStream.read("http://(IPアドレス):(ポート)/?action=stream.mjpeg"));


以上。これでとりあえずandroidからpythonにデータを送れる(wifiでも)、しかもraspberry piにつないだwebカメラの映像もandroidで見れる(raspi側で mjpeg streamer などが必要)。
参考資料
http://linux.yebisu.jp/memo/800

これであとはpython-arduinoのプロトコルを作ればめでたくAndroidでコントロールできるカメラつきラジコンが出来上がる・・・予定。テストプロトコルでモーター動かすだけで満足してしまっている自分が怖い

2013年4月29日月曜日

GWの工作(1) androidとarduino(ややこしい)を無線でシリアル通信

~GWは東京観光でもしようかと思っていたが気がついたらまた電子工作に入れ込んでいたでござる の巻~

最近流行りのタブレットでArduino Microをとりあえず動かしてみました。今回はそのあたりのメモ

~材料~

nexus7 : android 3.0以上くらいなら大体okだと思う
USB ホストケーブル: 片方はスマホに挿すやつ(usb-miniB)、もう片方が普通のUSB(メス)になってるやつ
arduino micro : 別にunoでもなんでもok シリアル通信するだけなので
xbee 2個 : ZBの普通のやつ(あとUSBドングルとブレッドボード変換基板)。使い方は過去記事参照のこと

 ~使ったソフト~
 Arduino1.0.4 :これじゃないとボードにmicroが入ってない?
神が作ってくださったandroid usbシリアル通信ライブラリ「FTDriver」と「Android USB Serial Monitor Lite(google playで入手可)
参考 : http://ksksue.com/wiki/doku.php?id=wiki:android:hardware:usb:ftdriver

~参考資料~
「xbeeで作るワイヤレスセンサーネットワーク」:オライリーの本。一家に一冊は欲しいね。

nexus7のUSBドライバーのインストールについて。
・今回の内容ではいらんけど、これがないとPCで書いたeclipseがnexus7認識しないので注意。あと「タブレット情報」ボタンを7回連打するのも忘れずに。他にも入れ方は色々あるようだがとりあえず公式からのインストールのやり方。
http://blogs.yahoo.co.jp/momo_poem/67257950.html


やり方
0、Xbeeの設定をする(親機をUSBドングル、子機をarduino)やり方は参考資料とか過去記事を

1、nexsus7でAndroid USB Serial Monitor Liteを入手

2、nexsus7にUSBホストケーブルとxbeeドングル(親機)を接続・・・できるようにしておく

3、 arduinoとXbeeの配線 
※注意:arduinoのTX出力が5VなのでXbeeのRXとの間で3.3Vに降圧すべき。でないとxbeeぶっ壊れる こんな便利なものがあるみたいです→http://www.switch-science.com/products/detail.php?product_id=1216
  ・arduino の3.3VとxbeeのVin
  ・arduinoのTXとxbeeのRX
  ・arduinoのRXとxbeeのTX
  ・arduinoのPIN2とGNDにLED(抵抗入り)
・・・筆者のXbee(子機)はもうだめかもわからんね

4、arduinoのプログラムを書く。シリアルで’a’を受信したらLED ON’b’を受信したらOFFするプログラムを書いただけ。
要点:
Arduino microでシリアル通信するときはSerial1クラスを使うこと(3時間くらい詰まった) 例:Serial1.begin(9600)
なんか普通のSerialのほうはPCとの接続に使ってるみたい。Arduino Leonardも同様

5、nexus7にホストケーブルを挿してAndroid USB Serial Monitor Liteを起動

6、プログラムアップロード。この時点でもnexus7からLチカできるがarduinoとPCがつながっててちょっとアレだったので線を引っこ抜いて外部電源に切り替え

7、nexus7から「a」を送ったり「b」を送ったりして遊ぶ。なんとなく感度が良くない気がする。

結果↓



arduinoのコード(抜粋) : ほぼarduino IDE に入っているサンプルのまんま、serial部分を足しただけ。

int led = 2;

void setup() {               

  pinMode(led, OUTPUT); 
  Serial1.begin(9600); 
}

void loop() {

  if(Serial1.available()>0){
   
    char data1=Serial1.read();
  if(data1=='a'){
    digitalWrite(led, HIGH);
    Serial1.print("a received led on\n");   // turn the LED on (HIGH is the voltage level)
  delay(1000);   
} 
  else if(data1=='b'){ 
  digitalWrite(led, LOW);  
  Serial1.print("b received led off\n");
  delay(1000);    
  }else
{
    Serial1.read();
  }

}
Serial1.println("serial from arduino");
delay(2000);
}

今後の展開(2日後予定) : android側で出来合いのソフトじゃなくてFTDriverライブラリを使ってラジコンとか操縦できるといいね(android傾けたりして)

おわり