/*******************************************************************************
 * ワンコインデコーダ６（ポイント用ソフトウェア） - Ver 2.0 - for PIC12F1822
 * Copyright (C) 2007-2026  Nucky
 * 使用PICマイコン PIC12F1822　　内部発振32MHzモード
 *  
 * ※車載デコーダのハードウェアをポイント用として使用するためのソフトです。
 * 
 * 2026.03.21 Ver2.0  ソースコードをC言語記述に変更（機能強化）
 * 
 * 【デコーダの概要】
 * DCCコマンドステーションからのアクセサリーパケットを受信し、
 * モータードライバ(TB67H450等)を介してポイントマシンを駆動します。
 * 
 * 【主な特徴】
 * 1. コンパイラ非依存: Timer1による実時間計測で、XC8(Free/PRO)の最適化差を吸収。
 * 2. 完全C言語化: インラインアセンブラを排除し、保守性と移植性を極限まで向上。
 * 3. 32MHz高速駆動: 余裕のある処理速度でパケット解析とハードウェア制御を両立。
 * 4. 堅牢な受信ロジック: ノイズや信号途絶時のタイムアウト復帰処理を完備。
 * 
 * 【ピン配置 (PIC12F1822)】
 * 1 (VDD): 5V電源 (+)
 * 2 (RA5): ECCP P1A / モータードライバ経由ポイントマシンへ
 * 3 (RA4): ECCP P1B / モータードライバ経由ポイントマシンへ
 * 4 (RA3): MCLR (未使用・入力専用)
 * 5 (RA2): DCC信号入力
 * 6 (RA1): 開通表示LED出力 ※要抵抗接続
 * 7 (RA0): 開通表示LED出力 ※要抵抗接続
 * 8 (VSS): GND (-)
 *******************************************************************************/

/*
 *【ソースコードのライセンスおよび利用条件について】
 * 本ソースコードの著作権はすべてNuckyに帰属します。
 * 本ソフトウェアは、以下の条件に基づいて提供されます。
 *
 * 1. [個人・非営利利用]
 * 個人の鉄道模型の範囲での利用、研究、改変は自由かつ無償で行えます。
 * 本コード、または改変したコードを公開・共有することも可能ですが、
 * その際も必ず非営利での公開とし、本ライセンス表記を残してください。
 *
 * 2. [商用利用（販売等）]
 * 本ソフトウェア（改変したものを含む）を書き込んだマイコンやデコーダ基板の販売、
 * 製品化、その他いかなる形であっても利益を得る目的（商用）で利用する場合は、
 * 必ず事前にご連絡ください。別途、有償の商用ライセンスをご契約いただきます。
 *
 * --- English Notice ---
 * Copyright (c) Nucky. All rights reserved.
 * 
 * 1. Personal/Non-Commercial Use: Free to use, modify, and share strictly 
 *    for personal, non-commercial hobby purposes.
 * 2. Commercial Use: ANY commercial use, including manufacturing, selling 
 *    products, or integrating this software into items for sale, is STRICTLY 
 *    PROHIBITED without prior permission. A paid commercial license is required. 
 *    Please contact the author via the website.
 *
 * --- 免責事項 / Disclaimer ---
 * 本プログラムの利用によって生じたデコーダ、車両、その他の機材の破損、不具合、
 * およびいかなる損害についても、作者は一切の責任を負いかねます。
 * This software is provided "AS IS", WITHOUT ANY WARRANTY. Use at your own risk.
*/


#include <xc.h>
#include <stdint.h>
#include <stdbool.h>

// =========================================================
// 1. 定義: クロック周波数とモータードライバ仕様
// =========================================================

// 内部発振クロックを32MHzに設定 (遅延関数 __delay_ms() 等の時間計算用)
#define _XTAL_FREQ 32000000 

// 搭載するモータードライバICに合わせてPWMの極性(正論理/負論理)を切り替えます。
#define BD6231      // BD6231F-E2 等 (一般的な制御用)
//#define TB67H450  // TB67H450FNG 等 (Slow Decay駆動が必要なドライバ用)

#if defined(BD6231)
    // BD6231: PWM非出力側ピンを LOW(0V) に固定。PWMは正論理(Active-High)で駆動。
    #define MOTOR_FIXED_LVL 0
    #define PWM_MODE_VAL    0x0C 
#elif defined(TB67H450)
    // TB67H450: PWM非出力側ピンを HIGH(5V) に固定。PWMは負論理(Active-Low)で駆動。
    #define MOTOR_FIXED_LVL 1
    #define PWM_MODE_VAL    0x0F 
#else
    #define MOTOR_FIXED_LVL 0
    #define PWM_MODE_VAL    0x0C 
#endif

// =========================================================
// 2. コンフィグレーション設定 (マイコンの基本ハードウェア設定)
// =========================================================
#pragma config FOSC = INTOSC    // 内部発振器を使用 (ピン節約)
#pragma config WDTE = OFF       // ウォッチドッグタイマ無効 (Timer1のタイムアウトで代用)
#pragma config PWRTE = ON       // パワーアップタイマ有効 (起動時の電圧安定待ち)
#pragma config MCLRE = OFF      // MCLRピン無効 (RA3をデジタル入力化)
#pragma config CP = OFF         // プログラムメモリ保護無効
#pragma config CPD = OFF        // データメモリ(EEPROM)保護無効
#pragma config BOREN = ON       // ブラウンアウトリセット有効 (電圧低下時の暴走防止)
#pragma config CLKOUTEN = OFF   // クロック出力無効
#pragma config IESO = OFF       // 内部/外部クロック切替無効
#pragma config FCMEN = OFF      // フェイルセーフクロックモニタ無効
#pragma config WRT = OFF        // フラッシュ自己書き込み保護無効
#pragma config PLLEN = ON       // 4倍PLL有効 (内部8MHzを4倍の32MHzに昇圧して高速動作)
#pragma config STVREN = ON      // スタックオーバーフローリセット有効
#pragma config BORV = HI        // ブラウンアウト電圧を高め(約2.7V)に設定し突入電流対策
#pragma config LVP = OFF        // 低電圧プログラミング無効 (ONだとRA3が使えない)

// =========================================================
// 3. EEPROM CVアドレス定義 と 初期値設定
// =========================================================
// プログラム内で読み書きするCVのEEPROM内アドレス
#define EEPROM_CV1   0x00 // CV1: アドレス下位
#define EEPROM_CV2   0x01 // CV2: アドレス上位
#define EEPROM_CV3   0x02 // CV3: 出力作動時間 (設定値 × 10ms)
#define EEPROM_CV4   0x03 // CV4: 動作モード (0:モーター式連続出力, 1:ソレノイド式パルス出力)
#define EEPROM_CV5   0x04 // CV5: 出力遅延時間 (設定値 × 10ms)
#define EEPROM_CV6   0x05 // CV6: PWM Duty比 (0〜255)
#define EEPROM_CV8   0x07 // CV8: メーカーID(156)。「8」書き込みでリセット発動
#define EEPROM_DIR_STATE 0x08 // 電源OFF直前の「ポイント開通方向」を記憶する専用アドレス

// プログラム書き込み時のデフォルトCV値 (1行最大8バイト)
// [CV1]=129, [CV2]=248 (アドレス1), [CV3]=5(50ms), [CV4]=1(ソレノイド), [CV5]=1(10ms), [CV6]=127(約50%), [CV7]=96(Ver0.96), [CV8]=156
__EEPROM_DATA(129, 248,   5,   1,   1, 127,  96, 156); 
// アドレス0x08〜0x0F (EEPROM_DIR_STATE 用の初期値)
__EEPROM_DATA(  0,   0,   0,   0,   0,   0,   0,   0); 

// =========================================================
// 4. グローバル変数 (状態管理・データキャッシュ)
// =========================================================

// --- 動作フラグ構造体 ---
// ビットフィールドを用いてメモリを節約し、パケット解析と実行ロジックを橋渡しします。
typedef struct {
    unsigned data_rcv : 1; // 自身への転換命令を受信したフラグ (1:受信あり, 0:待機)
    unsigned dir      : 1; // 転換目標の方向 (0:直進, 1:曲線)
} PointFlag;
PointFlag p_flag;

// --- CV値キャッシュ ---
// EEPROMからの読み出しは処理時間がかかるため、起動時にRAMへコピーし高速参照します。
uint8_t cv1_c, cv2_c, cv3_c, cv4_c, cv5_c, cv6_c;
uint8_t current_point_dir = 0; // 現在のポイント開通方向 (LED表示の更新やEEPROM寿命保護に使用)
uint8_t page_register = 0;     // Pageモードプログラミング時のページ記憶用

// --- DCCパケット受信バッファ ---
// C言語化によりアセンブラ特有のバンク制約が消滅したため、コンパイラに配置を任せます。
uint8_t dcc_data[6] = {0}; // 受信した生のパケットデータ(最大6バイト)
uint8_t dcc_byte_cnt = 0;  // 受信したパケットの有効なバイト数
uint8_t packet_ready = 0;  // 1=パケット受信完了。メインループでの解析トリガー

// =========================================================
// 関数プロトタイプ宣言
// =========================================================
void Init_System(void);
void Load_CV_Cache(void);
void Update_LED_Display(void);
void Process_Operation_Mode(void);
void Process_Service_Mode(void);
void Execute_Turnout(uint8_t target_dir);
void Output_Control(void);
void Send_Ack(void);
void Write_CV_With_Reset(uint8_t cv_addr, uint8_t cv_data);

// =========================================================
// 【関数】 DCCパルス幅計測 (Timer1 ハードウェア計測)
// C言語のループ(while)によるソフトウェア計測ではなく、マイコン内蔵の
// ハードウェアタイマー(Timer1)を用いて、DCCパルスの物理的な時間(μs)を実測します。
// これによりXC8のFree版/PRO版による最適化の違いを完全に吸収します。
// 戻り値: 1 (短い=DCCの'1'), 0 (長い=DCCの'0'), 2 (タイムアウト=エラー)
// =========================================================
uint8_t Measure_Pulse(void) {
    // 1. RA2がLowになるのを待つ (パルスの立ち上がりエッジを待機)
    TMR1H = 0; TMR1L = 0; // タイマーリセット
    while(PORTAbits.RA2 == 1) { 
        // Init_Systemで設定した通り、1カウント＝1μsで加算されます。
        // TMR1Hが1になる(つまり256μs経過する)と異常とみなし、エラー脱出します。
        if (TMR1H > 0) return 2; 
    }
    
    // 2. RA2がHighになる(パルスの開始)のを待つ
    TMR1H = 0; TMR1L = 0;
    while(PORTAbits.RA2 == 0) { 
        if (TMR1H > 0) return 2; 
    }
    
    // 3. パルスの長さ(Highの期間)をTimer1で実測する
    TMR1H = 0; TMR1L = 0;
    while(PORTAbits.RA2 == 1) { 
        if (TMR1H > 0) return 2; 
    }
    
    // 4. パルス幅の判定
    // DCC規格: '1'は片波約58μs、'0'は約100μs。中間の 75μs を閾値とします。
    uint8_t pulse = TMR1L;
    if (pulse < 75) return 1;
    return 0;
}

// =========================================================
// 【関数】 DCCパケット受信処理 (状態遷移ループ)
// プリアンブルを探し、最大6バイトのデータをビット単位で組み立てます。
// =========================================================
void Process_DCC_Packet(void) {
    packet_ready = 0;
    uint8_t bit_val;
    uint8_t buf[6] = {0}; 
    uint8_t p_count = 0;
    
WAIT_PREAMBLE:
    p_count = 0;
    
PREAMBLE_LOOP:
    // --- 1. プリアンブル検出 (14個以上の '1' ビットの連続) ---
    bit_val = Measure_Pulse();
    if (bit_val == 2) return; // タイムアウト時はメインループへ即時復帰
    
    if (bit_val == 1) {
        p_count++; // '1'ならカウントアップ
        goto PREAMBLE_LOOP;
    } else {
        // '0'が来た時、直前に'1'が10回以上続いていなければノイズと判断し探し直す
        if (p_count < 10) goto WAIT_PREAMBLE; 
    }
    
    // --- 2. データバイトの受信 (最大6バイト) ---
    for (dcc_byte_cnt = 0; dcc_byte_cnt < 6; dcc_byte_cnt++) {
        
        // 8ビット分のデータを読み込み、左シフトして1バイトに組み立てる
        for (uint8_t i = 0; i < 8; i++) {
            bit_val = Measure_Pulse();
            if (bit_val == 2) return;
            buf[dcc_byte_cnt] = (buf[dcc_byte_cnt] << 1) | bit_val;
        }
        
        // 8ビット直後の「セパレータビット」を確認
        bit_val = Measure_Pulse();
        if (bit_val == 2) return;
        
        // --- 3. パケットエンド判定 ---
        if (bit_val == 1) {
            // セパレータが '1' ならパケット終了。最低3バイト揃っていれば有効とする。
            dcc_byte_cnt++; 
            if (dcc_byte_cnt >= 3) {
                dcc_data[0] = buf[0]; dcc_data[1] = buf[1]; dcc_data[2] = buf[2];
                dcc_data[3] = buf[3]; dcc_data[4] = buf[4]; dcc_data[5] = buf[5];
                packet_ready = 1; 
            }
            return;
        }
        // セパレータが '0' なら、まだ次のバイトが続くのでループを継続する
    }
}

// ==========================================================
// 【メイン関数】 プログラムの心臓部
// ==========================================================
void main(void) {
    Init_System();       // ハードウェアの初期設定
    Load_CV_Cache();     // EEPROMからRAMへCV値をロード
    Update_LED_Display();// 起動直後、前回記憶していた方向のLEDを点灯

    p_flag.data_rcv = 0; 

    // 無限ループ
    while(1) {
        // 1. DCCパケットの受信待機 (タイムアウトで常に回る)
        Process_DCC_Packet(); 
        
        // 2. 受信完了時のパケット解析
        if (packet_ready) {
            uint8_t xor_sum = 0;
            // XORチェックサムによるデータ化け検証
            for (uint8_t i = 0; i < dcc_byte_cnt; i++) {
                xor_sum ^= dcc_data[i];
            }
            
            if (xor_sum == 0 && dcc_byte_cnt >= 3) {
                // 第1バイトが 0111 xxxx (0x70 〜 0x7F) で始まる場合はサービスモード(プログラミング)
                if ((dcc_data[0] & 0xF0) == 0x70) {
                    Process_Service_Mode();
                }
                // それ以外(0x80 〜 0xBF)はオペレーションモード(ポイント転換)
                else {
                    Process_Operation_Mode();
                }
            }
        }
        
        // 3. ポイント転換の実行管理 (フラグが立っていれば駆動関数を呼ぶ)
        Output_Control();
    }
}

// ==========================================================
// 【関数】 ハードウェア初期化
// マイコン起動時に1度だけ呼ばれ、ピンの役割やタイマーを設定します。
// ==========================================================
void Init_System(void) {
    OSCCON = 0xF0;      // 内部クロック 32MHz (8MHzベース x 4倍PLL)
    ANSELA = 0x00;      // 全ピンをデジタルI/Oに設定
    TRISA  = 0x0C;      // RA2(DCC入力), RA3(MCLR入力)は「入力」、他は「出力」
    LATA   = 0x00;      // 出力ピン初期化

    APFCON = 0x03;      // ECCPのPWM出力を P1A->RA5, P1B->RA4 にルーティング

    // --- PWM(Timer2) の設定 ---
    // PR2=255設定時、PWM周波数は約31.25kHzとなります。
    // CV6の0〜255を直接Duty比レジスタ(CCPR1L)に代入できるため計算が不要です。
    PR2 = 255;          
    T2CON = 0x04;       // Timer2 ON, プリスケーラ1:1
    CCP1CON = PWM_MODE_VAL; 
    CCPR1L = 0;         // 初期Duty 0% (停止)
    PSTR1CON = 0x00;    // ステアリング(出力先の指定)を全て無効化し安全確保

    // --- DCCパルス計測用(Timer1) の設定 ---
    // 32MHz駆動時、内部クロック源(Fosc/4)は 8MHz(0.125μs)。
    // プリスケーラを1:8に設定することで、8MHz / 8 = 1MHz となり、
    // 「Timer1の1カウント ＝ ピッタリ1μs」という非常に扱いやすい時間軸を作ります。
    T1CONbits.TMR1CS = 0; 
    T1CONbits.T1CKPS = 3; 
    T1CONbits.TMR1ON = 1; 
}

// ==========================================================
// 【関数】 CVキャッシュ・状態の読み込み
// ==========================================================
void Load_CV_Cache(void) {
    cv1_c = eeprom_read(EEPROM_CV1);
    cv2_c = eeprom_read(EEPROM_CV2);
    cv3_c = eeprom_read(EEPROM_CV3);
    cv4_c = eeprom_read(EEPROM_CV4);
    cv5_c = eeprom_read(EEPROM_CV5);
    cv6_c = eeprom_read(EEPROM_CV6);
    
    // 電源OFF前に記憶していた「開通方向」を復元
    current_point_dir = eeprom_read(EEPROM_DIR_STATE);
    
    // EEPROMが未書き込み(0xFF)だった場合の安全処理
    if (current_point_dir == 0xFF) {
        current_point_dir = 0; 
        eeprom_write(EEPROM_DIR_STATE, current_point_dir);
    }
}

// ==========================================================
// 【関数】 LED表示更新
// ==========================================================
void Update_LED_Display(void) {
    if (current_point_dir == 0) {
        LATA0 = 1; LATA1 = 0; // 直進(Close) : RA0を点灯
    } else {
        LATA0 = 0; LATA1 = 1; // 曲線(Throw) : RA1を点灯
    }
}

// ==========================================================
// 【関数】 CV書き込み統合処理 (工場出荷リセット対応)
// ==========================================================
void Write_CV_With_Reset(uint8_t cv_addr, uint8_t cv_data) {
    // CV8に「8」が書き込まれたら、主要なCVをデフォルト値に戻す
    if (cv_addr == EEPROM_CV8 && cv_data == 8) {
        eeprom_write(EEPROM_CV1, 129); eeprom_write(EEPROM_CV2, 248);
        eeprom_write(EEPROM_CV3, 5);   eeprom_write(EEPROM_CV4, 1);
        eeprom_write(EEPROM_CV5, 1);   eeprom_write(EEPROM_CV6, 127);
    } else {
        eeprom_write(cv_addr, cv_data);
    }
    Load_CV_Cache(); // キャッシュを最新化
}

// ==========================================================
// 【関数】 オペレーションモード(ポイント転換パケット)解析
// ==========================================================
void Process_Operation_Mode(void) {
    if ((dcc_data[0] & 0xC0) == 0x80) {
        uint8_t addr1 = dcc_data[0];
        // 第2バイトの最下位ビット(方向制御情報)を無視してアドレス比較
        uint8_t addr2 = dcc_data[1] & 0xFE; 
        
        if ((addr1 == cv1_c) && (addr2 == cv2_c)) {
            p_flag.dir = dcc_data[1] & 0x01; // 転換目標の方向を抽出
            p_flag.data_rcv = 1;             // 実行フラグを立てる
        }
    }
}

// ==========================================================
// 【関数】 出力制御のメイン管理
// ==========================================================
void Output_Control(void) {
    if (p_flag.data_rcv) {
        // 動作中(未確定状態)の表現として、まず両方のLEDを消灯
        LATA0 = 0; 
        LATA1 = 0;
        
        Execute_Turnout(p_flag.dir); // 転換シーケンス実行
        
        p_flag.data_rcv = 0; // 実行完了としてフラグを下ろす
    }
}

// ==========================================================
// 【関数】 ポイント転換シーケンスの実行
// ==========================================================
void Execute_Turnout(uint8_t target_dir) {
    // 1. 出力遅延処理 (CV5) : 複数ポイントの一斉動作による過電流をずらす
    for (uint8_t i = 0; i < cv5_c; i++) __delay_ms(10);

    // 2. 貫通電流防止 (Dead-time) : Hブリッジ回路のショート破損を防ぐ
    PSTR1CON = 0x00; 
    LATA &= ~(0x30); // RA4, RA5 を強制LOW
    CCPR1L = 0;      
    __delay_us(100);

    // 3. ルーティング切替 : 転換方向に応じて出力ピンを切り替える
    if (target_dir == 1) {
        LATA4 = MOTOR_FIXED_LVL; 
        PSTR1CON = 0x01; // RA5(P1A)へPWMルーティング
    } else {
        LATA5 = MOTOR_FIXED_LVL; 
        PSTR1CON = 0x02; // RA4(P1B)へPWMルーティング
    }

    // 4. ポイント駆動開始 : CV6(Duty)で安全な電圧を出力
    CCPR1L = cv6_c; 

    // 5. 動作時間の待機 (CV3)
    for (uint8_t i = 0; i < cv3_c; i++) __delay_ms(10);

    // 6. パルス停止処理 : ソレノイド式(CV4=1)ならコイル焼損を防ぐため確実に出力をOFFにする
    if (cv4_c & 0x01) {
        PSTR1CON = 0x00;
        LATA &= ~(0x30);
        CCPR1L = 0;
    }

    // 7. 状態更新とEEPROM寿命保護 : 実際に方向が変わった時だけ保存
    if (current_point_dir != target_dir) {
        current_point_dir = target_dir;
        eeprom_write(EEPROM_DIR_STATE, current_point_dir);
    }
    
    // 8. 動作完了として新しい開通方向のLEDを点灯
    Update_LED_Display();
}

// ==========================================================
// 【関数】 ACK(応答)送信
// ==========================================================
void Send_Ack(void) {
    uint8_t backup_lata = LATA; 
    uint8_t backup_duty = CCPR1L;
    uint8_t backup_pstr = PSTR1CON;

    LATA4 = MOTOR_FIXED_LVL; 
    LATA |= 0x03;            // LED点灯で僅かでも電流を稼ぐ
    PSTR1CON = 0x01;         // RA5へ出力
    CCPR1L = 255;            // フルパワー(100%)でモータを駆動し電流を消費する

    __delay_ms(6);           // NMRA規格で定められた応答時間 (約6ms)

    // バックアップから元の状態を復元
    CCPR1L = backup_duty;
    PSTR1CON = backup_pstr;
    LATA = backup_lata; 
}

// ==========================================================
// 【関数】 サービスモード (CVプログラミング処理)
// あらゆるコマンドステーションでの読書に対応するため、
// Page Mode および Direct Mode (Byte / Bit) の全てを網羅します。
// ==========================================================
void Process_Service_Mode(void) {
    uint8_t instruction = dcc_data[0]; 
    
    // --- 【1】PAGE モード (3バイト) ---
    if (dcc_byte_cnt == 3) {
        uint8_t is_write = (instruction & 0x08) ? 1 : 0; // Bit3: 1=Write, 0=Verify
        uint8_t command  = instruction & 0x07;           
        uint8_t target_data = dcc_data[1];
        uint8_t cv_addr = 0;

        if (command <= 3) { 
            // データレジスタ(R1〜R4)アクセス
            if (page_register == 0) return;
            cv_addr = (page_register - 1) * 4 + command; 
        } 
        else if (command == 0x05) { 
            // ページレジスタへの書き込み
            if (is_write) page_register = target_data;
            if (!is_write && page_register != target_data) return;
            Send_Ack(); return;
        }
        else { 
            // 直接アクセス
            cv_addr = command; 
        }

        if (is_write) {
            Send_Ack(); // タイムアウトを防ぐため、EEPROM書き込み前にACKを返す
            Write_CV_With_Reset(cv_addr, target_data);
        } else {
            if (eeprom_read(cv_addr) == target_data) Send_Ack();
        }
    }
    // --- 【2】DIRECT モード (Byte単位操作) (4バイト) ---
    else if (dcc_byte_cnt == 4 && (instruction & 0xF4) == 0x74) {
        uint8_t is_write = (instruction & 0x08) ? 1 : 0; 
        uint8_t cv_addr = dcc_data[1];     
        uint8_t target_data = dcc_data[2]; 

        if (is_write) {
            Send_Ack();
            Write_CV_With_Reset(cv_addr, target_data);
        } else {
            if (eeprom_read(cv_addr) == target_data) Send_Ack();
        }
    }
    // --- 【3】DIRECT モード (Bit単位操作) (4バイト) ---
    else if (dcc_byte_cnt == 4 && (instruction & 0xFC) == 0x78) {
        uint8_t cv_addr = dcc_data[1]; 
        uint8_t k_bit = (dcc_data[2] & 0x10) ? 1 : 0; // 1=Write, 0=Verify
        uint8_t d_bit = (dcc_data[2] & 0x08) ? 1 : 0; // 目標のビット値
        uint8_t bit_pos = dcc_data[2] & 0x07;         // ビット位置
        
        uint8_t current_cv_val = eeprom_read(cv_addr);
        uint8_t bit_mask = 1 << bit_pos;
        uint8_t actual_bit = (current_cv_val & bit_mask) ? 1 : 0;

        if (k_bit == 0) {
            // Verify
            if (actual_bit == d_bit) Send_Ack();
        } else {
            // Write
            Send_Ack(); 
            if (d_bit) current_cv_val |= bit_mask;  
            else       current_cv_val &= ~bit_mask; 
            
            Write_CV_With_Reset(cv_addr, current_cv_val);
        }
    }
}