#include "msp430x22x4.h"
//寫segD,然后復制segD(1000h-103Fh)到segC(1040h-107Fh)
//對信息段A的操作，注意LOCKA位
//segD(1000h-103fh)
//segC(1040h-107fh)
//segB(1080h-10bfh)
//segA(10c0h-10ffh)

#define SEGD_START  0x1000
#define SEGC_START  0x1040
void erase_seg(unsigned int);
void write_seg(unsigned int);
void copy_d_to_c(void);
void sega_op(void);
int main( void )
{
  WDTCTL=WDTPW+WDTHOLD;                   //關看門狗
  BCSCTL1 =CALBC1_1MHZ;                   //設定DCO為1MHZ
  DCOCTL =CALBC1_1MHZ;
  
  erase_seg(SEGD_START);                  //擦除信息段D
  write_seg(SEGD_START);                  //寫住信息段D
  copy_d_to_c();                          //將數據從信息段D復制到段C
  //FCTL3=FWKEY+LOCKA;                    //復位LOCKA
  sega_op();                              //對LOCKA進行反向操作
  return 0;  
}

void erase_seg(unsigned int erase)        //段擦除子程序
{
  char * seg_ptr;                         
  seg_ptr=(char *)erase;                  //指向段地址
  FCTL2=FWKEY+FSSEL1+FN1;                 //flash時鐘源為SMCLK,f(FTG)=SMCLK/3
  FCTL3=FWKEY;                            //復位LOCK
  FCTL1=FWKEY+ERASE;                      //段擦除使能
  *seg_ptr=0;                             //空寫啟動
  FCTL3=FWKEY+LOCK;                       //置位LOCK
}

void write_seg(unsigned int write)        //段寫子程序
{
  char write_value;
  char * write_addr=(char *)write;        //指向段首地址
  FCTL3=FWKEY;                            //復位LOCK
  FCTL1=FWKEY+WRT;                        //寫使能
  for(write_value=0;write_value<64;write_value++)
  {
    (*write_addr++)=write_value;          //循環寫入
  }
  FCTL3=FWKEY+LOCK;                       //置位LOCK
}  

void copy_d_to_c(void)                    //段復制程序
{
  char n;
  char * segd=(char *)SEGD_START;         //segd指向D段首地址
  char * segc=(char *)SEGC_START;         //segc指向C段首地址
  erase_seg(SEGC_START);                  //先擦除信息段C
  FCTL3=FWKEY;                            //復位LOCK
  FCTL1=FWKEY+WRT;                        //寫使能
  for(n=0;n<64;n++)
  { 
    *segc++=*segd++;                      //循環復制
  }
  FCTL3=FWKEY+LOCK;                       //置位LOCK
}

void sega_op(void)                        //LOCKA位開關
{
  if(LOCKA&FCTL3)
  {
    FCTL3=FWKEY+LOCKA;
  }
  else
  {
    FCTL3=FWKEY+LOCKA;
  }
}