投擲プログラム

Dependencies:   QEI mbed

main.cpp

Committer:
johnnyken
Date:
2017-12-09
Revision:
1:e7357f0f664b
Parent:
0:af0259ca519f
Child:
2:6aa2dd006191
Child:
3:d4caf19048aa

File content as of revision 1:e7357f0f664b:

//ロボコン3年投擲テスト用プログラム

//hファイル
#include "mbed.h"
#include "QEI.h"

//difine

//pin設定
DigitalOut valve1(p21);
QEI rollen(p29, p30, NC, 1024);

DigitalOut led1(LED1);
DigitalOut led2(LED2);
DigitalOut led3(LED3);
DigitalOut led4(LED4);

Serial pc(USBTX,USBRX);


//timer初期化
Ticker rollening;

//グローバル変数
int enc = 0;
int enc_old = 0;    //過去カウント比較用

//グローバル関数
void Dthrow(){
    //led2=!led2;
    enc=rollen.getPulses();
    pc.printf("%d\n",enc);
    if(enc < 0){
        led2 = 1;
        valve1 = 1;
        }
    else{
        led2 = 0;
        valve1 = 0;
        }
    if(enc<enc_old){
        led1 = 1;
        led3 = 0;
        }
    else{
        led1 = 0;
        led3 = 1;
        }
    }

//main関数
int main(){
    //led2=1;
    rollening.attach(&Dthrow, 0.01);
    //メモ:attaach_usでマイクロ秒もいけるらしいですがいけませんでした
    
    while(1){
        }
    
    }