addpath('./mcode_blocks');

%Maximum interval values in usec
% These determine bit widths of counters
MAX_SLOT = 63;
MAX_DIFS = 63;
MAX_EIFS = 255;
MAX_NAV = 4095;
MAX_NUM_SLOTS = 2^16-1;

%Calculate bit widths
% All counters run at 160MHz (1/160 usec)
NB_CNTR_SLOT = ceil(log2(MAX_SLOT * 160));
NB_CNTR_DIFS = max(ceil(log2(MAX_DIFS * 160)), ceil(log2(MAX_EIFS * 160)));
NB_CNTR_NAV = ceil(log2(MAX_NAV * 160));
NB_CNTR_NUM_SLOTS = ceil(log2(MAX_NUM_SLOTS));
NB_CNTR_POSTRX = 19; %big enough for SIFS and timeout

%Max hardware latencies, used to calculate various MAC intervals
PHY_RX_START_DLY = 25;

%Actual hardware latencies, used to calibrate MAC intervals

%D1: RxRfDelay + RxPLCPDelay
% After pkt reception, D1 is delay from actual medium IDLE to PHY_RX_END
hw_time_D1 = 1;

%RxTx Turnaround
% Time from PHY_TX_START.IND to PHY_TX_START.CONFIRM
%  (delay from "transmit now" signal to first energy on medium)
hw_time_rxtx_turnaround = 1;


ticks_per_usec = 10;

%%%%%%%%%%%%%%%%%%%%%%%%%
% MAC timing parameters
INTERVAL_SIFS = 10;
INTERVAL_SLOT = 9;
INTERVAL_DIFS = INTERVAL_SIFS + 2*INTERVAL_SLOT;
INTERVAL_EIFS = INTERVAL_SIFS + INTERVAL_DIFS + 100; %guess TACK_slow for now
INTERVAL_ACKTIMEOUT = INTERVAL_SIFS + INTERVAL_SLOT + PHY_RX_START_DLY;

%%%%%%%%%%%%%%%%%%%%%%%%%
% Calibrated MAC times

%TxDIFS: instant to sample medium status after successful Rx
calib_time_TxDIFS = INTERVAL_DIFS - hw_time_D1 - hw_time_rxtx_turnaround;

%Adjustment for NAV times, to compensate dealy from actual idle to RX_END+FCS
calib_time_NAV_adj = 0;

REG_MAC_Intervals_1 = ...
    2^0  * (10*INTERVAL_SLOT) + ... %b[9:0]
    2^20 * (10*INTERVAL_DIFS) + ... %b[29:20]
    0;
    
REG_MAC_Intervals_2 = ...
    2^0  * (10*INTERVAL_EIFS) + ... %b[15:0]
    2^16 * (10*INTERVAL_ACKTIMEOUT) + ... %b[31:16]
    0;

REG_MAC_Calib_Times = ...
    2^0  * (10*calib_time_TxDIFS) + ... %b[9:0]
    2^24 * (10*calib_time_NAV_adj) + ... %b[31:24]
    0;

REG_MAC_Tx_Ctrl_A_Params = 0;
    
REG_MAC_Tx_Ctrl_B_Params = 0;

REG_MAC_Tx_Ctrl_C_Params = 0;

REG_MAC_Tx_Ctrl_D_Params = 0;

REG_MAC_PostRxTimers = ...
    2^0  * (10*16) + ... %b[14:0] - timer 1 value
    2^15 * (0)     + ... %b[15] - enable timer 1
    2^16 * (10*16) + ... %b[30:16] - timer 2 value
    2^31 * (0)     + ... %b[31] - enable timer 2
    0;

REG_MAC_PostTxTimers = ...
    2^0  * (10*16) + ... %b[14:0] - timer 1 value
    2^15 * (0)     + ... %b[15] - enable timer 1
    2^16 * (10*16) + ... %b[30:16] - timer 2 value
    2^31 * (0)     + ... %b[31] - enable timer 2
    0;


REG_MAC_Backoff_Control = ...
    2^0  * (0) + ... %b[15:0] - num BO slots
    2^31 * (0) + ... %b[31] - Start backoff period immediately
    0;

REG_MAC_Control = ...
    2^0  * (0) + ... %b[0] Reset
    2^1  * (0) + ... %b[1] Disable NAV
    2^2  * (0) + ... %b[2] Reset NAV
    2^3  * (1) + ... %b[3] Block Rx on Tx
    2^4  * (0) + ... %b[4] Reset TU latch
    2^5  * (0) + ... %b[5] Ignore Rx PHY for CCA
    2^6  * (0) + ... %b[6] Ignore Tx PHY for CCA
    2^7  * (0) + ... %b[7] Ignore NAV for CCA
    2^8  * (0) + ... %b[8] Force CCA=BUSY
    2^9  * (0) + ... %b[9] --
    2^10 * (0) + ... %b[10] Reset RX_STARTED latch
    2^11 * (0) + ... %b[11] Reset Tx controller A
    2^12 * (0) + ... %b[12] Reset Tx controller B
    2^13 * (0) + ... %b[13] Reset Tx controller C
    2^14 * (0) + ... %b[14] Reset Tx controller D
    2^15 * (0) + ... %b[15] Reset Tx controller A backoff
    2^16 * (0) + ... %b[16] Reset Tx controller C backoff
    2^17 * (0) + ... %b[17] Reset Tx controller D backoff
    2^18 * (0) + ... %b[18] Pause Tx controller A
    2^19 * (0) + ... %b[19] Pause Tx controller C
    2^20 * (0) + ... %b[20] Pause Tx controller D
    2^21 * (0) + ... %b[21] Enbale ext CCA.BUSY input
    2^22 * (0) + ... %b[22] Enable ext PostRx Timer 1 start
    2^23 * (0) + ... %b[23] Reset Rx PHY active latches
    2^24 * (0) + ... %b[24] Reset Tx PHY active latch
    0;

%Match 40-d8-55-04-21-4a
%REG_NAV_Match_Addr_1 = hex2dec('0455d840');
%REG_NAV_Match_Addr_2 = hex2dec('00004a21');

%Default to zeros - won't match anything until overwritten by software
REG_NAV_Match_Addr_1 = 0;
REG_NAV_Match_Addr_2 = 0;

mac_sim_rx_data_b.time = [];
mac_sim_rx_data_b.signals.values = sscanf('48 11 2c 00 40 d8 55 04 21 4a 40 d8 55 04 21 5a 40 d8 55 04 21 4a f0 92 f7 db e5 d9 ', '%02x');
NUM_BYTES = length(mac_sim_rx_data_b.signals.values);

mac_sim_rx_data_valid.time = [];
mac_sim_rx_data_valid.signals.values = [zeros(1, NUM_BYTES) ones(1, NUM_BYTES) zeros(1, NUM_BYTES)].';

mac_sim_rx_data_addr.time = [];
mac_sim_rx_data_addr.signals.values = [zeros(1, NUM_BYTES) 0:NUM_BYTES-1 zeros(1, NUM_BYTES)].';