#include "defs.h"
#include "ports.h"
//#include "display.h"
//-----------------------------------------------
#pragma vector=TIMERA0_VECTOR
__interrupt void timera0_interrurpt(){
LED_BAT1_TOGGLE;
#ifndef DEBUG
WDTCTL = WDTPW + WDTCNTCL;
#endif
}
//-----------------------------------------------

#pragma vector=TIMERB0_VECTOR
__interrupt void timerb0_interrupt(){
//LED_BAT1_TOGGLE;
//LEDS_ON; _NOP(); LEDS_OFF;
#ifndef DEBUG
WDTCTL = WDTPW + WDTCNTCL;
#endif

}

//------------------------------------------------
void SwitchToHighClock(void){ // XT1=ON, XT2=ON, MLCK=XT2, SMCLK=XT2, ACLK=XT1
int i;
BCSCTL1 = 0; // Turn on XTL2
do{
IFG1 &= ~OFIFG; //clear OFIFG
for (i=0x0F; i>0; i--) _NOP();
} while( (IFG1 & OFIFG)!=0);
BCSCTL2 = SELM1+SELS; // MCLK = XTL2, /1, SMCLK=XT2, /1, IntRes DCO
__bic_SR_register(SCG1); // Turn on SMCLK
}

void SwitchToLowClock(void){ // XT1=ON, XT2=OFF, MLCK=XT1, SMCLK=OFF, ACLK=XT1
int i;
BCSCTL1 = 0x80; // Turn off XTL2
do{
IFG1 &= ~OFIFG; //clear OFIFG
for (i=0x0F; i>0; i--) _NOP();
} while( (IFG1 & OFIFG)!=0);
BCSCTL2 = SELM1+SELM0 + SELS; // MCLK = XTL1, /1, SMCLK=XT2, /1, IntRes DCO
__bis_SR_register(SCG1); // Turn off SMCLK
}

void SetClock(){
__bic_SR_register(OSCOFF); // turn ON clock generator
SwitchToLowClock();
}
//--
void InitTimers(){
// Timer A
TACTL = TASSEL_2+MC_1+ID_3; // XT2 Select (8Mhz), Up to CCR0, divide by 8 to get 1Mhz
TACCR0 = 62500-1; // Interrunt every 1/16 Sec
TACCTL0 = CCIE;
TAR = 0;
TACTL |=TAIE;
// Timer B
TBCTL = TBSSEL_1 + MC_1; // ACLK Clock input
TBCCTL0 = CCIE;
TBCCR0 = 3333; // ~ 0.1 Sec @ 32.768kHz XT1
TBR=0;
//TBCTL |= TBIE;
}
//================================================================================
========
void main( void ){
//int i;
WDTCTL = WDTPW + WDTHOLD; // Stop watchdog timer

// Clock init
SetClock();
SwitchToHighClock();
//initPorts();
P2DIR = 0xFF;
P3DIR = 0x0B;
P4DIR = 0x03;
P5DIR = 0x7F;
DDIR = 0xFF;

InitTimers();

__enable_interrupt();
while(1){
WDTCTL = WDTPW + WDTCNTCL;
}
}
}