直流モータ2個を,2つのアナログ入力でデューティ制御するプログラムです。

Dependencies:   Motor mbed

main.cpp

Committer:
Yoshichan
Date:
2014-08-03
Revision:
0:c4b58f8a436e

File content as of revision 0:c4b58f8a436e:

// Sweep the motor speed from full-speed reverse (-1.0) to full speed forwards (1.0)

#include "mbed.h"
#include "Motor.h"

Motor m1(p23, p6, p5);   // pwm, fwd, rev
AnalogIn ain1(p16);// AD input for Motor1

Motor m2(p22, p8, p7);   // pwm, fwd, rev
AnalogIn ain2(p15);// AD input for Motor2

int main() {
    while(1)
    {
        float k1=(ain1-0.5)*1.2;
        if(k1>0.6)
        {
            k1=0.6;
        }
        else
        {
            if(k1<-0.6)
            {
                k1=-0.6;
            }
            else{}
        }
        
        float k2=(ain2-0.5)*1.2;
        if(k2>0.6)
        {
            k2=0.6;
        }
        else
        {
            if(k2<-0.6)
            {
                k2=-0.6;
            }
            else{}
        }        
        m1.speed(k1); 
        m2.speed(k2); 
        wait(0.1);
    }
}