#include  "msp430x12x2.h"
/***************************************************/
//flash init and write
void initFlash(void)
{
    FCTL2 = FWKEY + FSSEL0 + FN0;             // MCLK/2 for Flash Timing Generator
}
//lenth must less or equal 128
void write_SegA (unsigned char *pointer,unsigned char lenth)
{
  unsigned char *Flash_ptr;                          // Flash pointer
  unsigned int i;

  Flash_ptr = (unsigned char *) 0x1080;              // Initialize Flash pointer
  FCTL1 = FWKEY + ERASE;                    // Set Erase bit
  FCTL3 = FWKEY;                            // Clear Lock bit
  *Flash_ptr = 0;                           // Dummy write to erase Flash segment

  FCTL1 = FWKEY + WRT;                      // Set WRT bit for write operation

  for (i=0; i<lenth; i++)
  {
    *Flash_ptr++ = *pointer++;                   // Write value to flash
  }

  FCTL1 = FWKEY;                            // Clear WRT bit
  FCTL3 = FWKEY + LOCK;                     // Set LOCK bit
}
//lenth must less or equal 128
void write_SegB (unsigned char *pointer,unsigned char lenth)
{
  unsigned char *Flash_ptr;                          // Flash pointer
  unsigned int i;

  Flash_ptr = (unsigned char *) 0x1000;              // Initialize Flash pointer
  FCTL1 = FWKEY + ERASE;                    // Set Erase bit
  FCTL3 = FWKEY;                            // Clear Lock bit
  *Flash_ptr = 0;                           // Dummy write to erase Flash segment

  FCTL1 = FWKEY + WRT;                      // Set WRT bit for write operation

  for (i=0; i<lenth; i++)
  {
    *Flash_ptr++ = *pointer++;                   // Write value to flash
  }

  FCTL1 = FWKEY;                            // Clear WRT bit
  FCTL3 = FWKEY + LOCK;                     // Set LOCK bit
}