File content as of revision 8:ca92cb674004:

#include "mbed.h"
#include "Trim.h"
#include "Global.h"
//PullUpに注意
Trim::Trim(PinName upsw, PinName downsw) 
: _upsw(upsw), _downsw(downsw){
    
    _upsw.mode(PullUp);
    _downsw.mode(PullUp);
    
    upswstatus = 1;
    downswstatus = 1;
    
    pitchrate = 0.5;
}


void Trim::pitchup(){
    trimpitch--;
    clamp(trimpitch,-7,7);
    printf("trimpitch = %d\n",trimpitch);
}

void Trim::pitchdown(){
    trimpitch++;
    clamp(trimpitch,-7,7);
    printf("trimpitch = %d\n",trimpitch);
}

void Trim::clamp(int &value, int min, int max){
    if(value < min) {
        value = min;
    } else if(value > max) {
        value = max;
    }
}

void Trim::clamp(double &value, double min, double max){
    if(value < min) {
        value = min;
    } else if(value > max) {
        value = max;
    }
}


double Trim::calc(int trimpitch){
    return (double)trimpitch*pitchrate;
}    

void Trim::update(){
    if(_upsw == 0){
        upswstatus = 0;
    }else if((_upsw == 1)&&(upswstatus == 0)){
        pitchup();
        upswstatus = 1;
    }
    
    if(_downsw == 0){
        downswstatus = 0;
    }else if((_downsw == 1)&&(downswstatus == 0)){
        pitchdown();
        downswstatus = 1;
    }
        
    Global::settrimpitch(calc(trimpitch));
    Global::setinttrimpitch(trimpitch);
    
}