typedef enum
{
    wd_disable = 0,
    wd_1sec = (1 << WDP2) | (1 << WDP1),
    wd_2sec = (1 << WDP2) | (1 << WDP1) | (1 << WDP0),
#ifdef WDP3    
    wd_4sec = (1 << WDP3),
    wd_8sec = (1 << WDP3) | (1 << WDP0),
#endif
}Ewd_modes;


////////////////////////////////////////////////////////////////////////////////
#pragma optimize = none
void watchdog_cmd( Ewd_modes in_mode )
{
    INTERRUPT_PUSH_AND_CLR;
    WATCHDOG_RESET;
    
    u8 temp = WDT_REG | (1 << WDCE) | (1 << WDE);
    
    switch( in_mode )
    {
    case wd_disable:
        MCU_REG &= ~(1 << WDRF);
        WDT_REG = temp;
        WDT_REG = 0;
        break;
        
    default:
        u8 t2 = WDT_REG | (1 << WDE) | (u8)in_mode;
        WDT_REG = temp;
        WDT_REG = t2;
        break;
    }
    
    INTERRUPT_POP;
}