モータ制御を修正

Dependencies:   QEI mbed

Fork of okmtjidouki by towa ngo

Committer:
okmt
Date:
Mon Sep 14 07:58:08 2015 +0000
Revision:
3:2fb6302e0cda
Child:
8:834e3af75af8
ouou

Who changed what in which revision?

UserRevisionLine numberNew contents of line
okmt 3:2fb6302e0cda 1 void Motor01(float a)
okmt 3:2fb6302e0cda 2 {
okmt 3:2fb6302e0cda 3 if(a>0&&a<=1)
okmt 3:2fb6302e0cda 4 {mypwm011 = 1;mypwm012 = 1 - a;} //正転
okmt 3:2fb6302e0cda 5
okmt 3:2fb6302e0cda 6 else if(a<=0&&a>=-1)
okmt 3:2fb6302e0cda 7 {mypwm011 = 1 + a;mypwm012 = 1;} //逆転&a=0ならブレーキ
okmt 3:2fb6302e0cda 8
okmt 3:2fb6302e0cda 9 else
okmt 3:2fb6302e0cda 10 {mypwm011 = 0;mypwm012 = 0;} //ストップ
okmt 3:2fb6302e0cda 11 }
okmt 3:2fb6302e0cda 12
okmt 3:2fb6302e0cda 13 void Motor02(float a)
okmt 3:2fb6302e0cda 14 {
okmt 3:2fb6302e0cda 15 if(a>0&&a<=1)
okmt 3:2fb6302e0cda 16 {mypwm021 = 1;mypwm022 = 1 - a;} //正転
okmt 3:2fb6302e0cda 17
okmt 3:2fb6302e0cda 18 else if(a<=0&&a>=-1)
okmt 3:2fb6302e0cda 19 {mypwm021 = 1 + a;mypwm022 = 1;} //逆転&a=0ならブレーキ
okmt 3:2fb6302e0cda 20
okmt 3:2fb6302e0cda 21 else
okmt 3:2fb6302e0cda 22 {mypwm021 = 0;mypwm022 = 0;} //ストップ
okmt 3:2fb6302e0cda 23 }
okmt 3:2fb6302e0cda 24
okmt 3:2fb6302e0cda 25 void Motor03(float a)
okmt 3:2fb6302e0cda 26 {
okmt 3:2fb6302e0cda 27 if(a>0&&a<=1)
okmt 3:2fb6302e0cda 28 {mypwm030 = 1;mypwm031 = 1 - a;} //正転
okmt 3:2fb6302e0cda 29
okmt 3:2fb6302e0cda 30 else if(a<=0&&a>=-1)
okmt 3:2fb6302e0cda 31 {mypwm030 = 1 + a;mypwm031 = 1;} //逆転&a=0ならブレーキ
okmt 3:2fb6302e0cda 32
okmt 3:2fb6302e0cda 33 else
okmt 3:2fb6302e0cda 34 {mypwm030 = 0;mypwm031 = 0;} //ストップ
okmt 3:2fb6302e0cda 35 }
okmt 3:2fb6302e0cda 36