robo8080のブログ

ロボット製作や電子工作など。

IchigoJam + TB6612モータードライバー で、LEGO Power Functions Motor と Servo Motor を制御する実験。

2017年05月12日 | 電子工作

IchigoJam + TB6612モータードライバー  で、LEGO Power Functions Motor と Servo Motor を制御する実験。

使用したLego パワーファンクションのモーターとサーボモーターと延長ケーブル。

延長ケーブルは速攻でちょん切ってコネクタ付け替えたw

 

 

LEGO Power Functions Motor と Servo Motor は変換ケーブルさえ作ってしまえば普通のモーターを制御するのと変わり無い。

コネクタケーブルの信号割り当てはここがわかりやすい。

Take Control Over Lego Power Functions

 

 

IchigoJam+ TB6612モータードライバー で、LEGO Power Functions Motor と Servo Motor の配線は出来た。

 

 

注:IN1とIN2は、OUT8とOUT9として使える。

 

実験に使ったTB6612モータードライバーは販売終了品なので、同等のTB6612モータードライバーはこれ。

デュアルモータードライバTB6612FNG(連続最大1A)

TB6612使用 Dual DCモータードライブキット

 


iPad + IchigoJam WebTerm でTB6612モータードライバーの制御プログラムのデバッグ。

 

 


実験に使ったプログラムはこれ。

5 'A is MOTOR1 SPEED (0 - 100%)
6 'B is MOTOR2 SPEED (0 - 100%)
10 GOSUB 500:GOSUB 700
20 WAIT 60
30 A=50:GOSUB 540:WAIT 120
35 A = 0:GOSUB 540:WAIT 60
40 A=50:GOSUB 590:WAIT 120
50 A=0:GOSUB 540:WAIT 120
60 GOSUB 500
65 B=0:GOSUB 750:WAIT 180
70 B=100:GOSUB 750:WAIT 180
75 B=0:GOSUB 750:WAIT 180
80 B=100:GOSUB 800:WAIT 180
90 B=0:GOSUB 800:WAIT 180
100 GOSUB 700
110 GOTO 30
480 STOP
490 'MOTOR1 BRAKE
500 OUT 8,1
510 OUT 9,1
520 PWM 2,0
530 RETURN
540 'MOTOR1 FWD
550 OUT 8,1
560 OUT 9,0
570 PWM 2,A*20
580 RETURN
590 'MOTOR1 REV
600 OUT 8,0
610 OUT 9,1
620 PWM 2,A*20
630 RETURN
690 'MOTOR2 BRAKE
700 OUT 1,1
710 OUT 4,1
72 PWM 3,0
730 RETURN
740 'MOTOR2 FWD
750 OUT 1,1
760 OUT 4,0
770 PWM 3,B*20
780 RETURN
790 'MOTOR2 REV
800 OUT 1,0
810 OUT 4,1
820 PWM 3,B*20
830 RETURN 

 


動いた!!

IchigoJam で、LEGO Power Functions Motor と Servo Motor を制御

 

 


参考リンク

ESP32やIchigoJamでLEGOパワーファンクションモーターを動かす実験。

 

 


最新の画像もっと見る

コメントを投稿

ブログ作成者から承認されるまでコメントは反映されません。