Fumiya Fujisawa / IRM2121

ロボカップジュニアサッカー IRM2121を用いた専用パルスボールを検知するためのライブラリ

Dependents:   BallCheck_IRM2121_InterrputInAdd CatPot_SensorRight

Pingのライブラリを参考にしました。 RoboCupJuniorSoccerにおけるボール検知をまとめて行うために作成したライブラリ。

距離に応じて微妙に値が変わるようになりました。 まともに使えます。

なお、このライブラリには、interruptinの機能を拡張するためのライブラリが含まれています。 そのため、必要なときだけピン変化割り込みに入ることが可能となっています。

値に応じて関数ポインタとかすれば距離によって値かわるようにできるかも if文で十分かもしれません

IRM2121.cpp

Committer:
ryuna
Date:
2015-01-05
Revision:
2:40101fcb6d44
Parent:
1:b25c8ac20d5b
Child:
3:711dde7b4c12

File content as of revision 2:40101fcb6d44:

/* mbed Ping Library respected Library !!
 *
 * make interruptin_mod by bousiya03
 * 
 */


#include "IRM2121.h"
#include "interruptin_mod.h"
#include "mbed.h"

IRM2121::IRM2121(PinName IRM_PIN)
        : _event(IRM_PIN)
        , _timer()
        {          
        } 
        
void IRM2121::_Start(void)
{
    if(_Valid && _Busy ){
        _timer.start();
        _Time  = _timer.read_us();
        _Valid = false;  
        _Busy  = true; 
        _event.fall_disable(this,&IRM2121::_Start);
        _event.rise(this,&IRM2121::_Stop);  
    }
}

void IRM2121::_Stop(void)
{
    if(!_Valid && _Busy){ 
        _Valid = true;  // When it stops, update the time
        _Busy  = false;
        _Time  = _timer.read_us()-_Time;
        _event.rise_disable(this,&IRM2121::_Stop);
    }
}

void IRM2121::Set(void)
{
    _Valid = true;
    _Busy = true;
    _event.fall(this,&IRM2121::_Start );
    
       
     
}

int IRM2121::Read(void)
// 0 means not valid.
{
    if(_Valid && !_Busy){ 
        return _Time;

    }else { 
        _event.fall_disable(this,&IRM2121::_Start);
        _event.rise_disable(this,&IRM2121::_Stop);
        return 0;
    }
}


void IRM2121::ReturnVB(bool *valid, bool *busy){
    //use after read_function. this is flag checker. 
    *valid = _Valid;
    *busy  = _Busy;
       
}