mirror of
https://github.com/rvtr/ctr_mcu.git
synced 2025-06-18 16:45:33 -04:00
6ec42747e1
●スタックがあふれる可能性があったので修正 ・スタックをあまり使わないように(accero.c, iic_twl.c, pm.c, vreg_ctr_write からのhosu_increment_if_nesessary(), ) ・iic_ctrの割り込み順位を下げた(iic_ctr_init)。iic_twl以外は一律最低に。 mmen,DS互換で暫く波形を見たが問題なさそう。もう暫くエージング継続 ・renge task_interval_runの中からtask_immed_runを呼ぶのをやめた。よーく動作確認をすること！（これは戻すかも） ●ext_infoの実装を修正(task_misc.c) romは減ったが、スタティックなRAMが増えた。それでもスタックを使うより安全と思う ●MGICの無い機材（白箱など）でも電池周りのHALが動くよう修正(adc.c) ●voltableを.hではなく.cへ移動 ●iic_mcu_startのiic_puウェイトを1msに。別に動でもいいのだが。 ○電源offからの電源投入チェック、アダプタ有無で異なるパスを通っていたが、出来るだけ共通に。テスト中 git-svn-id: file:///Volumes/Transfer/gigaleak_20231201/2020-05-23%20-%20ctr.7z%20+%20svn_v1.068.zip/ctr/svn/ctr_mcu@363 013db118-44a6-b54f-8bf7-843cb86687b1
574 lines
16 KiB
C
574 lines
16 KiB
C
/* ========================================================
|
||
|
||
CTR MCU I2Cレジスタ
|
||
|
||
====================================================== */
|
||
#include "incs.h"
|
||
#include "vreg_ctr.h"
|
||
#include "rtc.h"
|
||
#include "led.h"
|
||
#include "accero.h"
|
||
#include "pm.h"
|
||
#include "pool.h"
|
||
|
||
#include <fsl.h>
|
||
|
||
#include "fsl_user.h"
|
||
|
||
|
||
extern u8 extinfo_read(); // task_misc.c
|
||
|
||
extern u8 iic_burst_state; // 特殊バーストアクセスする時のカウンタ
|
||
extern bit info_led_pattern_updated; // お知らせLEDのパターンを先頭に戻す
|
||
|
||
extern bit pedolog_overflow;
|
||
extern bit reserve_pedo_increnent;
|
||
|
||
|
||
|
||
// ********************************************************
|
||
#ifdef _DBG_PEDO_AUTO_ENABLE_
|
||
u8 vreg_ctr[VREG_C_ENDMARK_ + 16];
|
||
#else
|
||
u8 vreg_ctr[VREG_C_ENDMARK_];
|
||
#endif
|
||
|
||
static u8 vreg_free_adrs; // アドレス飛んでるのでしばらくはこれで
|
||
bit irq_readed; // AAA型のため。
|
||
|
||
|
||
|
||
// ********************************************************
|
||
extern task_status_immed tski_firm_update();
|
||
extern task_status_immed tski_mcu_reset();
|
||
|
||
|
||
|
||
// ********************************************************
|
||
#ifdef _MCU_BSR_
|
||
#define IICAMK IICAMK1
|
||
#endif
|
||
|
||
|
||
// ********************************************************
|
||
// 非ゼロの初期値の指定が必要なアドレス
|
||
// マイコンリセット時に呼ばれます
|
||
void vreg_ctr_init( )
|
||
{
|
||
vreg_ctr[ VREG_C_VCOM_T ] = VCOM_DEFAULT_T;
|
||
vreg_ctr[ VREG_C_VCOM_B ] = VCOM_DEFAULT_B;
|
||
|
||
vreg_ctr[ VREG_C_OFF_DELAY ] = FORCEOFF_THREASHOLD;
|
||
|
||
vreg_ctr[ VREG_C_VOL_CAL_MIN ] = 0x36;
|
||
vreg_ctr[ VREG_C_VOL_CAL_MAX ] = 0xFF - 0x36;
|
||
|
||
vreg_ctr[ VREG_C_RBR_CONTROL ] = REG_BIT_RESET_n; // todo | REG_BIT_FLIGHT;
|
||
}
|
||
|
||
|
||
// ********************************************************
|
||
// 本体の電源投入時にセットされます
|
||
void vreg_ctr_reset( )
|
||
{
|
||
vreg_ctr[ VREG_C_MCU_VER_MAJOR ] = MCU_VER_MAJOR | 0x10;
|
||
vreg_ctr[ VREG_C_MCU_VER_MINOR ] = MCU_VER_MINOR;
|
||
|
||
vreg_ctr[ VREG_C_LED_BRIGHT ] = 0xFF;
|
||
vreg_ctr[ VREG_C_LED_POW ] = 0;
|
||
vreg_ctr[ VREG_C_LED_WIFI ] = 0;
|
||
vreg_ctr[ VREG_C_LED_CAM ] = 0;
|
||
vreg_ctr[ VREG_C_LED_3D ] = 0;
|
||
// vreg_ctr[ VREG_C_VOL_CAL_MIN ] = 0x36; ここで書いちゃダメ！
|
||
// vreg_ctr[ VREG_C_VOL_CAL_MAX ] = 0xFF - 0x36; 電源入れるたびにデフォルト値になってしまう
|
||
{
|
||
u8 i;
|
||
for( i = 0; i < sizeof( uni_info_LED ); i++ )
|
||
{
|
||
info_LED.bindata[ i ] = 0;
|
||
}
|
||
}
|
||
}
|
||
|
||
|
||
|
||
// ********************************************************
|
||
// I2C仮想レジスタに書きます。
|
||
// 引数 adrs は内部アドレス
|
||
// 書けないアドレスにアクセスした場合、何もしません。
|
||
// ●書き込んだ結果、I2C_mcu通信が発生する場合、renge_task_immed_add()
|
||
// を使用しないと、I2C_mcu使用中でエラー終了した場合にリトライしません。
|
||
void vreg_ctr_write( u8 adrs, u8 data )
|
||
{
|
||
switch ( adrs )
|
||
{
|
||
|
||
case ( VREG_C_MCU_STATUS ):
|
||
// vreg_twl[ REG_TWL_INT_ADRS_MODE ] = (u8)( ( data >> 6 ) & 0x03 ); Rでよい。その代わりリセットでクリア
|
||
vreg_ctr[ VREG_C_MCU_STATUS ] &= data; // bitクリアはするがセットはしない。
|
||
// 上の方のtwlレジスタミラーは読み出され時に合成
|
||
break;
|
||
|
||
case ( VREG_C_VCOM_T ):
|
||
case ( VREG_C_VCOM_B ):
|
||
renge_task_immed_add( tski_vcom_set );
|
||
vreg_ctr[adrs] = data;
|
||
break;
|
||
|
||
case ( VREG_C_DBG03 ):
|
||
if( ( vreg_ctr[VREG_C_DBG01] == 'j' )
|
||
&& ( vreg_ctr[VREG_C_DBG02] == 'h' )
|
||
&& ( data == 'l' ) )
|
||
{
|
||
renge_task_immed_add( tski_firm_update );
|
||
IICAMK = 1;
|
||
}
|
||
vreg_ctr[ VREG_C_DBG03 ] = data;
|
||
break;
|
||
|
||
case ( VREG_C_COMMAND0 ):
|
||
if( data != 0 )
|
||
{
|
||
renge_task_immed_add( tski_do_command0 );
|
||
vreg_ctr[ VREG_C_COMMAND0 ] |= data;
|
||
}
|
||
break;
|
||
|
||
case ( VREG_C_COMMAND2 ):
|
||
// こちらからの完了割り込みを待ってくれないそうです。 #-ω-) 何のための割り込みだ
|
||
// 液晶電源
|
||
if(( data & REG_BIT_CMD_LCD_ON ) != 0 )
|
||
{
|
||
renge_task_immed_add( tski_PM_LCD_on );
|
||
}
|
||
else if(( data & REG_BIT_CMD_LCD_OFF ) != 0 )
|
||
{
|
||
renge_task_immed_add( tski_PM_LCD_off );
|
||
}
|
||
|
||
// バックライト設定
|
||
/// 今のところさらに細かくは分けないけど…
|
||
if(( data & REG_BITS_CMD_BL ) != 0 )
|
||
{
|
||
renge_task_immed_add( tski_PM_BL_set );
|
||
vreg_ctr[adrs] = (u8)( data & REG_BITS_CMD_BL );
|
||
}
|
||
break;
|
||
|
||
case ( VREG_C_COMMAND1 ):
|
||
if( data != 0 )
|
||
{
|
||
// u8 temp; 中間変数使ったらばかでかくなった...
|
||
// TWLに割り込みを入れる
|
||
/// 実際に割り込みを入れるのはSoC
|
||
/// ビットの並びが違うから面倒
|
||
vreg_twl[ REG_TWL_INT_ADRS_IRQ ] = ( ( data & REG_BIT_SEND_TWL_PWSW_DET ) != 0 ) ? REG_BIT_TWL_IRQ_PWSW_DET : 0x00; //pwsw_det
|
||
vreg_twl[ REG_TWL_INT_ADRS_IRQ ] |= ( ( data & REG_BIT_SEND_TWL_RESET_DET ) != 0 ) ? REG_BIT_TWL_IRQ_RESET : 0x00; //reset_req
|
||
|
||
vreg_twl[ REG_TWL_INT_ADRS_IRQ ] |= ( ( data & REG_BIT_SEND_TWL_OFF_DET ) != 0 ) ? REG_BIT_TWL_IRQ_OFF : 0x00; //off_req
|
||
|
||
vreg_twl[ REG_TWL_INT_ADRS_IRQ ] |= ( ( data & REG_BIT_SEND_TWL_BATT_LOW ) != 0 ) ? REG_BIT_TWL_IRQ_BT_LOW : 0x00; //batt_low
|
||
vreg_twl[ REG_TWL_INT_ADRS_IRQ ] |= ( ( data & REG_BIT_SEND_TWL_BATT_EMPTY ) != 0 ) ? REG_BIT_TWL_IRQ_BT_EMPTY : 0x00; //batt_empty
|
||
|
||
if(( data & REG_BIT_SEND_TWL_VOL_CLICK ) != 0 )
|
||
{
|
||
vreg_twl[ REG_TWL_INT_ADRS_IRQ ] |= REG_BIT_TWL_IRQ_VOL_CHANGE; //vol_changed
|
||
}
|
||
}
|
||
break;
|
||
|
||
case ( VREG_C_LED_POW ):
|
||
if( iic_burst_state == 0 )
|
||
{
|
||
vreg_ctr[ VREG_C_LED_POW ] = data;
|
||
iic_burst_state ++;
|
||
}
|
||
else if( iic_burst_state < 5 )
|
||
{
|
||
led_red_batt_empty.dats[ iic_burst_state -1 ] = data;
|
||
iic_burst_state ++;
|
||
}
|
||
break;
|
||
|
||
case ( VREG_C_LED_WIFI ):
|
||
case ( VREG_C_LED_CAM ):
|
||
case ( VREG_C_LED_3D ):
|
||
vreg_ctr[adrs] = (u8)( data & 0x0F );
|
||
break;
|
||
|
||
case ( VREG_C_LED_NOTIFY_DATA ):
|
||
if( iic_burst_state < sizeof( uni_info_LED ) )
|
||
{
|
||
if(( iic_burst_state == 1 ) && ( data == 0 )) // fade_time == 0 禁止
|
||
{
|
||
data = 1;
|
||
}
|
||
info_LED.bindata[ iic_burst_state ] = data;
|
||
iic_burst_state ++;
|
||
if( iic_burst_state > 4 ) // パターンを1文字でも書いた
|
||
{
|
||
info_led_pattern_updated = true;
|
||
}
|
||
}
|
||
break;
|
||
|
||
/// 非同期で動いているためここでは書かない。
|
||
// 予約するだけでstopで書く
|
||
case ( VREG_C_RTC_SEC ):
|
||
case ( VREG_C_RTC_MIN ):
|
||
set_rtc( adrs - VREG_C_RTC_SEC, data & 0x7F );
|
||
break;
|
||
|
||
case ( VREG_C_RTC_DAY ):
|
||
case ( VREG_C_RTC_HOUR ):
|
||
set_rtc( adrs - VREG_C_RTC_SEC, data & 0x3F );
|
||
break;
|
||
|
||
case ( VREG_C_RTC_YOBI ):
|
||
set_rtc( adrs - VREG_C_RTC_SEC, data & 0x07 );
|
||
break;
|
||
|
||
case ( VREG_C_RTC_MONTH ):
|
||
set_rtc( adrs - VREG_C_RTC_SEC, data & 0x1F );
|
||
break;
|
||
|
||
case ( VREG_C_RTC_YEAR ):
|
||
set_rtc( adrs - VREG_C_RTC_SEC, data );
|
||
break;
|
||
|
||
case ( VREG_C_RTC_COMP ):
|
||
WDT_Restart();
|
||
while(1)
|
||
{
|
||
RWAIT = 1;
|
||
while( !RWST ){}
|
||
if( SEC != 0 )
|
||
{
|
||
break;
|
||
}
|
||
RWAIT = 0;
|
||
}
|
||
SUBCUD = data;
|
||
RWAIT = 0;
|
||
vreg_ctr[ VREG_C_RTC_COMP ] = data;
|
||
break;
|
||
|
||
case ( VREG_C_RTC_ALARM_MIN ):
|
||
rtc_alarm_dirty = true;
|
||
vreg_ctr[ VREG_C_RTC_ALARM_MIN ] = (u8)( data & 0x7F );
|
||
break;
|
||
|
||
case ( VREG_C_RTC_ALARM_HOUR ):
|
||
rtc_alarm_dirty = true;
|
||
vreg_ctr[ VREG_C_RTC_ALARM_HOUR ] = (u8)( data & 0x3F );
|
||
break;
|
||
|
||
// 書くだけでよい
|
||
case ( VREG_C_RTC_ALARM_DAY ):
|
||
vreg_ctr[ VREG_C_RTC_ALARM_DAY ] = (u8)( data & 0x3F );
|
||
break;
|
||
|
||
case ( VREG_C_RTC_ALARM_MONTH ):
|
||
vreg_ctr[ VREG_C_RTC_ALARM_MONTH ] = (u8)( data & 0x1F );
|
||
break;
|
||
|
||
case ( VREG_C_ACC_CONFIG ):
|
||
renge_task_immed_add( tski_acc_hosu_set );
|
||
vreg_ctr[ VREG_C_ACC_CONFIG ] = data;
|
||
break;
|
||
|
||
case ( VREG_C_ACC_R_ADRS ):
|
||
renge_task_immed_add( tski_acc_read );
|
||
vreg_ctr[ VREG_C_ACC_R_ADRS ] = data;
|
||
break;
|
||
|
||
case ( VREG_C_ACC_W_BUF ):
|
||
renge_task_immed_add( tski_acc_write );
|
||
vreg_ctr[ VREG_C_ACC_W_BUF ] = data;
|
||
break;
|
||
|
||
case ( VREG_C_ACC_HOSU_SETTING ):
|
||
if( ( data & 0x01 ) != 0 )
|
||
{
|
||
clear_hosu_hist(); // 履歴クリア
|
||
}
|
||
break;
|
||
|
||
case ( VREG_CX_FREE_DATA ):
|
||
if( vreg_free_adrs < VREG_C_FREE_SIZE )
|
||
{
|
||
pool.vreg_c_ext.vreg_c_free[ vreg_free_adrs ] = data;
|
||
vreg_free_adrs ++;
|
||
}
|
||
break;
|
||
|
||
case ( VREG_CX_FREE_ADRS ):
|
||
vreg_free_adrs = data;
|
||
break;
|
||
|
||
|
||
case ( VREG_C_COMMAND3 ):
|
||
switch ( data )
|
||
{
|
||
case ( 'r' ):
|
||
// 割り込みルーチンからFSLライブラリを呼ぶのは禁止
|
||
// マイコンを再起動。 レジスタ類も初期化される。
|
||
renge_task_immed_add( tski_mcu_reset );
|
||
break;
|
||
|
||
#ifdef _ENABLE_WDT_TEST_
|
||
case ( 'w' ):
|
||
// WDTで再起動（テスト向け）
|
||
while(1)
|
||
{
|
||
NOP();
|
||
}
|
||
// mcu_wdt_reset; // このコマンド使ったら意味ないでしょ！
|
||
break;
|
||
#endif
|
||
case( 'p' ):
|
||
reserve_pedo_increnent = 1;
|
||
// ここで増やすにはスタックが足りない。↑で予約のみ、task_misc内で処理
|
||
// hosu_increment_if_necessary(); // 今、一歩増えた
|
||
break;
|
||
}
|
||
|
||
// vreg_ctr[ VREG_C_COMMAND3 ] = data; // 書く必要なし
|
||
break;
|
||
|
||
case ( VREG_C_RBR_CONTROL ):
|
||
if(( data & REG_BIT_RESET_n ) != 0 )
|
||
{
|
||
RBR_RESET_n = 1;
|
||
}
|
||
else
|
||
{
|
||
RBR_RESET_n = 0;
|
||
}
|
||
if(( data & REG_BIT_FLIGHT ) != 0 )
|
||
{
|
||
RBR_FLIGHT = 1;
|
||
}
|
||
else
|
||
{
|
||
RBR_FLIGHT = 0;
|
||
}
|
||
vreg_ctr[ VREG_C_RBR_CONTROL ] = data;
|
||
break;
|
||
|
||
// read only //////////////////////////////////////////
|
||
case VREG_C_MCU_VER_MAJOR:
|
||
case VREG_C_MCU_VER_MINOR:
|
||
case VREG_C_3D: // すぐにリフレッシュされる
|
||
case VREG_C_SND_VOL: // すぐにリフレッシュされる
|
||
case VREG_C_BT_TEMP: // すぐにリフレッシュされる
|
||
case VREG_C_BT_REMAIN: // すぐにリフレッシュされる
|
||
case VREG_C_BT_REMAIN_FINE: // すぐにリフレッシュされる
|
||
case VREG_C_BT_VOLTAGE: // すぐにリフレッシュされる
|
||
case VREG_C_STATUS_1: // 適当にリフレッシュされる
|
||
case VREG_C_STATUS: // 適当にリフレッシュされる
|
||
case VREG_C_IRQ0: // 次のついでに割り込み起こしてほしいなら...
|
||
case VREG_C_IRQ1:
|
||
case VREG_C_IRQ2:
|
||
case VREG_C_IRQ3:
|
||
case VREG_C_IRQ4:
|
||
case VREG_C_LED_NOTIFY_FLAG: // すぐリフレッシュされる
|
||
case VREG_C_RTC_SEC_FINE_L: // すぐリフレッシュされる
|
||
case VREG_C_RTC_SEC_FINE_H: // すぐリフレッシュされる
|
||
// VREG_C_ACC_RESERVE, // 何も起きない
|
||
// VREG_C_ACC_HOSU_HIST = 0x4F,
|
||
case VREG_C_ACC_XH: // すぐリフレッシュされる
|
||
case VREG_C_ACC_XL:
|
||
case VREG_C_ACC_YH:
|
||
case VREG_C_ACC_YL:
|
||
case VREG_C_ACC_ZH:
|
||
case VREG_C_ACC_ZL:
|
||
dbg_nop();
|
||
break;
|
||
|
||
case VREG_C_ACC_HOSU_L: // 書けてもいいけど、デバッグ用。(アドレス0x4B == mcu sla(r))
|
||
dbg_nop();
|
||
/* FALLTHROUGH */
|
||
|
||
// 普通に書かれるだけ /////////////////////////////////
|
||
default:
|
||
/*
|
||
case VREG_C_IRQ_MASK0:
|
||
case VREG_C_IRQ_MASK1:
|
||
case VREG_C_IRQ_MASK2:
|
||
case VREG_C_IRQ_MASK3:
|
||
case VREG_C_IRQ_MASK4:
|
||
case VREG_C_DBG01:
|
||
case VREG_C_DBG02:
|
||
case VREG_C_LED_BRIGHT:
|
||
case VREG_C_ACC_HOSU_L:
|
||
case VREG_C_ACC_HOSU_M:
|
||
case VREG_C_ACC_HOSU_H:
|
||
case VREG_C_ACC_HOSU_HOUR_BOUNDARY:
|
||
case VREG_C_FREE_ADRS:
|
||
case VREG_C_RTC_ALARM_YEAR:
|
||
case VREG_C_ACC_W_ADRS:
|
||
case VREG_C_OFF_DELAY:
|
||
case VREG_C_HAL_OVW_CONT0:
|
||
case VREG_C_HAL_OVW_DAT0:
|
||
case VREG_C_HAL_OVW_CONT1:
|
||
case VREG_C_HAL_OVW_DAT1:
|
||
*/
|
||
if( adrs < VREG_C_ENDMARK_ )
|
||
{
|
||
vreg_ctr[adrs] = data;
|
||
break;
|
||
}
|
||
else
|
||
{
|
||
dbg_nop(); // read onlyの所に書いた。なんかバグってない？
|
||
break;
|
||
}
|
||
}
|
||
return;
|
||
}
|
||
|
||
|
||
|
||
// ********************************************************
|
||
// I2C仮想レジスタから読みます。
|
||
// 戻り： xx データ
|
||
// 注意：次のアドレスの準備で呼ばれる ので、
|
||
// リードされたらクリアなどは気をつける
|
||
// ( →vreg_ctr_after_read( u8 adrs ) )
|
||
u8 vreg_ctr_read( u8 adrs )
|
||
{
|
||
static u16 rsub_temp;
|
||
u8 temp;
|
||
|
||
// RTCは読み出し途中に繰り上がるのを避けるため
|
||
if( ( VREG_C_RTC_SEC <= adrs ) && ( adrs <= VREG_C_RTC_YEAR ) )
|
||
{
|
||
rtc_buf_refresh( );
|
||
}
|
||
else if( adrs == VREG_C_MCU_STATUS )
|
||
{
|
||
return( ( vreg_ctr[ VREG_C_MCU_STATUS ] & 0x03 ) |
|
||
( ( vreg_twl[ REG_TWL_INT_ADRS_MODE ] & 0x03 ) << 6 ) | // sys_mode
|
||
( ( vreg_twl[ REG_TWL_INT_ADRS_MODE ] & 0x80 ) >> 2 )); // vol32
|
||
}
|
||
else if( adrs == VREG_C_RTC_SEC_FINE_L )
|
||
{
|
||
rsub_temp = RSUBC;
|
||
return( (u8)( rsub_temp & 0xFF ) );
|
||
}
|
||
else if( adrs == VREG_C_RTC_SEC_FINE_H )
|
||
{
|
||
return( (u8)( ( rsub_temp >> 8 ) & 0xFF ) );
|
||
}
|
||
/*
|
||
// debug 的な
|
||
else if( adrs == VREG_C_IRQ_MASK0 )
|
||
{
|
||
return( vreg_ctr[ VREG_C_IRQ_MASK0 ] & 0x7F ); // ぜ～ったいにMSBは0。1なら通信エラー
|
||
}
|
||
*/
|
||
else if( adrs == VREG_C_ACC_HOSU_HIST )
|
||
{
|
||
return( hosu_read() );
|
||
}
|
||
else if( adrs == VREG_CX_FREE_DATA )
|
||
{
|
||
temp = pool.vreg_c_ext.vreg_c_free[ vreg_free_adrs ];
|
||
// vreg_free_adrs ++; // ここで加算してしまうとインデックスがずれる
|
||
return( temp );
|
||
}
|
||
else if( adrs == VREG_CX_INFO )
|
||
{
|
||
return( extinfo_read() );
|
||
}
|
||
else if( adrs == VREG_C_ACC_HOSU_SETTING )
|
||
{
|
||
if( pedolog_overflow )
|
||
{
|
||
return( 0x10 );
|
||
}
|
||
else
|
||
{
|
||
return( 0 );
|
||
}
|
||
}
|
||
|
||
if( adrs >= VREG_C_ENDMARK_ )
|
||
{
|
||
// VREG_C_INFO > VREG_C_ENDMARK_ なのでいじるとき注意
|
||
return( 0xFF );
|
||
}
|
||
return ( vreg_ctr[adrs] );
|
||
}
|
||
|
||
|
||
|
||
// ********************************************************
|
||
// I2C仮想レジスタから読まれて何かするレジスタ
|
||
void vreg_ctr_after_read( u8 adrs, u8 data )
|
||
{
|
||
// 割り込みフラグはリードでクリア
|
||
switch( adrs )
|
||
{
|
||
case VREG_C_IRQ0:
|
||
case VREG_C_IRQ1:
|
||
case VREG_C_IRQ2:
|
||
case VREG_C_IRQ3:
|
||
case VREG_C_IRQ4:
|
||
DI();
|
||
vreg_ctr[ adrs ] ^= data;
|
||
EI();
|
||
irq_readed = true;
|
||
break;
|
||
|
||
case VREG_CX_FREE_DATA:
|
||
vreg_free_adrs ++;
|
||
break;
|
||
|
||
default:
|
||
break;
|
||
}
|
||
}
|
||
|
||
|
||
|
||
|
||
|
||
|
||
/******************************************************************************
|
||
割り込みを入れる
|
||
割り込みマスクが必要と言うことでこんな事をする羽目になりました
|
||
*****************************************************************************/
|
||
#if 0
|
||
// マスクされてたら、フラグは立てるが、割り込みは入れない。
|
||
#define set_irq( irqreg, bitpos ) \
|
||
{ \
|
||
vreg_ctr[ irqreg ] |= bitpos; \
|
||
if( ( vreg_ctr[ irqreg+8 ] & bitpos ) == 0 ){ \
|
||
IRQ0_ast; \
|
||
} \
|
||
}
|
||
#endif
|
||
|
||
// マスクされてたら、フラグ「立てない」、割り込み入れない。
|
||
void set_irq( u8 irqreg, u8 irq_flg )
|
||
{
|
||
u8 tot;
|
||
|
||
if(( system_status.pwr_state == ON ) ||
|
||
( system_status.pwr_state == SLEEP ))
|
||
{
|
||
// DI();
|
||
if( ( vreg_ctr[ irqreg + 8 ] & irq_flg ) == 0 ){
|
||
vreg_ctr[ irqreg ] |= irq_flg;
|
||
IRQ0_neg; // 一瞬上げて...
|
||
// EI();
|
||
tot = 0;
|
||
while( !IRQ0 && ( ++tot != 0 ) ){;} // O.D.なのでちゃんとあがるのを待つ ＆ IRQ_mcu がLに縛られてると困る(基板不良)
|
||
IRQ0_ast; // 落とし直す。
|
||
}
|
||
}
|
||
// EI();
|
||
}
|