#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;
}
}
}

         // Timer A
         TACTL   = TASSEL_2|ID_3|TACLR;   // XT2 Select (8Mhz), Up to CCR0, divide by 8 to get 1Mhz
         TACCR0  = 62500-1;                // Interrunt every 1/16 Sec
         TACCTL0 = CCIE;
         TACTL   |= MC_1;

         TACTL   |=TAIE;

WDTCTL = WDTPW + WDTHOLD;                 // Stop watchdog timer

/************************************************************
* Interrupt Vectors (offset from 0xFFE0)
************************************************************/

#define PORT2_VECTOR        (1 * 2u)  /* 0xFFE2 Port 2 */
#define USART1TX_VECTOR     (2 * 2u)  /* 0xFFE4 USART 1 Transmit */
#define USART1RX_VECTOR     (3 * 2u)  /* 0xFFE6 USART 1 Receive */
#define PORT1_VECTOR        (4 * 2u)  /* 0xFFE8 Port 1 */
#define TIMERA1_VECTOR      (5 * 2u)  /* 0xFFEA Timer A CC1-2, TA */
#define TIMERA0_VECTOR      (6 * 2u)  /* 0xFFEC Timer A CC0 */
#define ADC12_VECTOR          (7 * 2u)  /* 0xFFEE ADC */
#define USART0TX_VECTOR     (8 * 2u)  /* 0xFFF0 USART 0 Transmit */
#define USART0RX_VECTOR     (9 * 2u)  /* 0xFFF2 USART 0 Receive */
#define WDT_VECTOR          (10 * 2u) /* 0xFFF4 Watchdog Timer */
#define COMPARATORA_VECTOR  (11 * 2u) /* 0xFFF6 Comparator A */
#define TIMERB1_VECTOR      (12 * 2u) /* 0xFFF8 Timer B CC1-6, TB */
#define TIMERB0_VECTOR      (13 * 2u) /* 0xFFFA Timer B CC0 */
#define NMI_VECTOR          (14 * 2u) /* 0xFFFC Non-maskable */
#define RESET_VECTOR        (15 * 2u) /* 0xFFFE Reset [Highest Priority] */

#define UART1TX_VECTOR      USART1TX_VECTOR
#define UART1RX_VECTOR      USART1RX_VECTOR
#define UART0TX_VECTOR      USART0TX_VECTOR
#define UART0RX_VECTOR      USART0RX_VECTOR
#define ADC_VECTOR          ADC12_VECTOR

#pragma vector=COMPARATORA_VECTOR
__interrupt void StayHere6()
{      for (;;);     }