#define ChkDashPort() (bcm2835_gpio_lev(PIN_DASH) == LOW)
// Encoderポートチェック(負論理)
#define ChkEncA() (bcm2835_gpio_lev(PIN_ENC_A) == LOW)
#define ChkEncB() (bcm2835_gpio_lev(PIN_ENC_B) == LOW)
//----------------------------------------------------------------------------
// 定数定義
//----------------------------------------------------------------------------
typedef enum
{
PARA_ALL_OFF = 0x00,
PARA_DOT_ON,
PARA_DOT_OFF,
PARA_DASH_ON,
PARA_DASH_OFF
} PARA; // Dot/Dash状態遷移
typedef enum
{
ENC_STS_NO = 0x00,
ENC_STS_PLUSE,
ENC_STS_MINUS,
ENC_STS_MAX
} ENC_STS; // エンコーダ状態
#define LIMIT_VALUE (0x03) // チャタリングフィルタ用
#define MAX_SPEED (20) // 最大速度
#define MIN_SPEED (255) // 最小速度
//----------------------------------------------------------------------------
// ユーザメモリと初期化
//----------------------------------------------------------------------------
unsigned int ParaTime = 0x0000;
unsigned int ADCData= MIN_SPEED;
unsigned char ParaCode = PARA_ALL_OFF;
unsigned char CntDotOn = 0x00;
unsigned char CntDashOn = 0x00;
unsigned char ENC_Pluse = 0;
unsigned char ENC_Minus = 0;
//----------------------------------------------------------------------------
// エンコーダのプラス側ステータスセット
//----------------------------------------------------------------------------
static void ENC_SetPluse( void )
{
ENC_Pluse = 1;
ENC_Minus = 0;
}
//----------------------------------------------------------------------------
// エンコーダのマイナス側ステータスセット
//----------------------------------------------------------------------------
static void ENC_SetMinus( void )
{
ENC_Pluse = 0;
ENC_Minus = 1;
}
//----------------------------------------------------------------------------
// エンコーダのチャタリング吸収
//----------------------------------------------------------------------------
void ENC_ChkPort( void )
{
static unsigned char BakEncSts;
if( !ChkEncA() && !ChkEncB() )
{
BakEncSts = 0x00;
}
else if( ChkEncA() && !ChkEncB() )
{
if( BakEncSts == 0x00 )
{
ENC_SetMinus();
}
BakEncSts = 0x01;
}
else if( !ChkEncA() && ChkEncB() )
{
if( BakEncSts == 0x00 )
{
ENC_SetPluse();
}
BakEncSts = 0x02;
}
else if( ChkEncA() && ChkEncB() )
{
BakEncSts = 0x03;
}
}
//----------------------------------------------------------------------------
// エンコーダ速度設定
//----------------------------------------------------------------------------
void GetSpeedValue(void)
{
if( ENC_Pluse== 1 )
{
ENC_Pluse = 0;
if( ADCData > MAX_SPEED )
{
ADCData -= 8;
}
}
if( ENC_Minus == 1 )
{
ENC_Minus = 0;
if( ADCData < MIN_SPEED )
{
ADCData += 8;
}
}
}
//----------------------------------------------------------------------------
// パラメータセット: Dash
//----------------------------------------------------------------------------
char SetParaDash(void)
{
if(CntDashOn >= LIMIT_VALUE)
{
CntDashOn = 0;
ParaCode = PARA_DASH_ON;
ParaTime = ADCData;
ParaTime <<= 1;
ParaTime += ADCData;
return 1;
}
return 0;
}
//----------------------------------------------------------------------------
// パラメータセット: Dot
//----------------------------------------------------------------------------
char SetParaDot(void)
{
if(CntDotOn >= LIMIT_VALUE)
{
CntDotOn = 0;
ParaCode = PARA_DOT_ON;
ParaTime = ADCData;
return 1;
}
return 0;
}
//----------------------------------------------------------------------------
// 入力ポートチャタリング処理
//----------------------------------------------------------------------------
void ChkInputPort( void )
{
// for Dot
if(ParaCode != PARA_DOT_ON)
{
if(ParaCode == PARA_DOT_OFF && ParaTime >= (ADCData >>3))
CntDotOn = 0;
else if(ParaCode == PARA_DASH_ON && ParaTime >= ADCData)
CntDotOn = 0;
else if(CntDotOn < LIMIT_VALUE)
{
if( ChkDotPort() )
CntDotOn ++;
else
CntDotOn = 0;
}
}
// for Dash
if(ParaCode != PARA_DASH_ON )
{
if(ParaCode == PARA_DASH_OFF && ParaTime >= ADCData>>3)
CntDashOn = 0;
else if(ParaCode == PARA_DOT_ON && ParaTime >= (ADCData >>1))
CntDashOn = 0;
else if(CntDashOn < LIMIT_VALUE)
{
if( ChkDashPort() )
CntDashOn ++;
else
CntDashOn = 0;
}
}
}
//----------------------------------------------------------------------------
// 出力ポート設定
//----------------------------------------------------------------------------
void SetOutput(void)
{
if((ParaCode == PARA_DASH_ON) || (ParaCode == PARA_DOT_ON))
{
BUZZ_ON(); // ブザーポートOn/Off
LED_ON(); // LEDポートOn/Off
}
else
{
BUZZ_OFF();
LED_OFF();
}
}
//----------------------------------------------------------------------------
// メイン関数
//----------------------------------------------------------------------------
int main(int argc, char *argv)
{
if( !bcm2835_init() ) return 1;
// In/Out設定
bcm2835_gpio_fsel(PIN_DOT, BCM2835_GPIO_FSEL_INPT);
bcm2835_gpio_fsel(PIN_DASH, BCM2835_GPIO_FSEL_INPT);
bcm2835_gpio_fsel(PIN_ENC_A, BCM2835_GPIO_FSEL_INPT);
bcm2835_gpio_fsel(PIN_ENC_B, BCM2835_GPIO_FSEL_INPT);
bcm2835_gpio_fsel(PIN_LED, BCM2835_GPIO_FSEL_OUTP);
bcm2835_gpio_fsel(PIN_BUZZ, BCM2835_GPIO_FSEL_OUTP);
// Pullup設定
bcm2835_gpio_set_pud(PIN_DOT, BCM2835_GPIO_PUD_UP);
bcm2835_gpio_set_pud(PIN_DASH, BCM2835_GPIO_PUD_UP);
bcm2835_gpio_set_pud(PIN_ENC_A, BCM2835_GPIO_PUD_UP);
bcm2835_gpio_set_pud(PIN_ENC_B, BCM2835_GPIO_PUD_UP);
// PWM設定など
bcm2835_gpio_fsel(PIN_BUZZ, BCM2835_GPIO_FSEL_ALT5);
bcm2835_pwm_set_clock(BCM2835_PWM_CLOCK_DIVIDER_32);
bcm2835_pwm_set_mode(PWM_CHANNEL, 1, 1);
bcm2835_pwm_set_range(PWM_CHANNEL, RANGE);
bcm2835_pwm_set_data(PWM_CHANNEL, 0);
while( 1 )
{
bcm2835_delayMicroseconds(1000); // 1msec待ち
ChkInputPort(); // 入力ポートチャタリング処理
ENC_ChkPort();
GetSpeedValue(); // エンコーダ値取得
if(ParaTime > 0)
{
ParaTime --;
if(ParaTime == 0)
{
switch(ParaCode)
{
case PARA_DOT_ON:
ParaCode = PARA_DOT_OFF;
ParaTime = ADCData;
break;
case PARA_DASH_ON:
ParaCode = PARA_DASH_OFF;
ParaTime = ADCData;
break;
case PARA_DOT_OFF:
if(!SetParaDash()) // スクイズ動作のためDashを見る
ParaCode = PARA_ALL_OFF;
break;
case PARA_DASH_OFF:
if(!SetParaDot()) // スクイズ動作のためDotを見る
ParaCode = PARA_ALL_OFF;
}
}
}
if(ParaCode == PARA_ALL_OFF)
{
if(!SetParaDot())
{
SetParaDash();
}
}
SetOutput(); // 出力ポート設定
}
}