MSP_EXP430FR2355.asm

   1 ; -*- coding: utf-8 -*-
   2
   3 ; Fast Forth For Texas Instrument MSP430FR5739
   4 ; Tested on MSP-EXP430FR2355 launchpad
   5 ;
   6 ; Copyright (C) <2018>  <J.M. THOORENS>
   7 ;
   8 ; This program is free software: you can redistribute it and/or modify
   9 ; it under the terms of the GNU General Public License as published by
  10 ; the Free Software Foundation, either version 3 of the License, or
  11 ; (at your option) any later version.
  12 ;
  13 ; This program is distributed in the hope that it will be useful,
  14 ; but WITHOUT ANY WARRANTY; without even the implied warranty of
  15 ; MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16 ; GNU General Public License for more details.
  17 ;
  18 ; You should have received a copy of the GNU General Public License
  19 ; along with this program.  If not, see <http://www.gnu.org/licenses/>.
  20
  21 ; ======================================================================
  22 ; INIT MSP-EXP430FR2355 board
  23 ; ======================================================================
  24
  25 ; J101 (7xjumper)
  26 ; "SBWTCK"   ---> TEST
  27 ; "SBWTDIO"  ---> RST
  28 ; "TXD"      <--- P4.3  == UCA0TXD <-- UCA0TXDBUf
  29 ; "RXD"      ---> P4.2  == UCA0RXD --> UCA0RXDBUF
  30 ; "3V3"      <--> 3V3
  31 ; "5V0"      <--> 5V0
  32 ; "GND"      <--> GND
  33
  34
  35 ; SW1 -- P4.1
  36 ; SW2 -- P2.3
  37
  38 ; LED1 - P1.0   (red)
  39 ; LED2 - P6.6   (green)
  40
  41 ; I/O pins on J1:
  42 ; J1.1  - 3V3
  43 ; J1.2  - P1.5
  44 ; J1.3  - P1.6
  45 ; J1.4  - P1.7
  46 ; J1.5  - P3.6
  47 ; J1.6  - P5.2
  48 ; J1.7  - P4.5
  49 ; J1.8  - P3.4
  50 ; J1.9  - P1.3
  51 ; J1.10 - P1.2
  52
  53 ; I/O pins on J3:
  54 ; J3.21 - 5V0
  55 ; J3.22 - GND
  56 ; J3.23 - P1.4 A4 SEED
  57 ; J3.24 - P5.3 A11
  58 ; J3.25 - P5.1 A9
  59 ; J3.26 - P5.0 A8
  60 ; J3.27 - P5.4
  61 ; J3.28 - P1.1 A1 SEED
  62 ; J3.29 - P3.5 OA3O
  63 ; J3.30 - P3.1 OA2O
  64
  65
  66 ; I/O pins on J2:
  67 ; J2.11 - P3.0
  68 ; J2.12 - P2.5
  69 ; J2.13 - P4.4
  70 ; J2.14 - P4.7
  71 ; J2.15 - P4.6
  72 ; J2.16 - RST
  73 ; J2.17 - P4.0
  74 ; J2.18 - P2.2
  75 ; J2.19 - P2.0
  76 ; J2.20 - GND
  77
  78 ; I/O pins on J4:
  79 ; J2.31 - P3.2
  80 ; J2.32 - P3.3
  81 ; J2.33 - P2.4
  82 ; J2.34 - P3.7
  83 ; J2.35 - P6.4
  84 ; J2.36 - P6.3
  85 ; J2.37 - P6.2
  86 ; J2.38 - P6.1
  87 ; J2.39 - P6.0
  88 ; J2.40 - 2.1
  89
  90 ; LFXTAL XOUT- P2.6
  91 ; LFXTAL XIN - P2.7
  92
  93 ; ======================================================================
  94 ; MSP-EXP430FR2355 LAUNCHPAD    <--> OUTPUT WORLD
  95 ; ======================================================================
  96
  97 ;                                 +--4k7-< DeepRST switch <-- GND
  98 ;                                 |
  99 ; P4.3  - UCA1 TXD    J101.6 -  <-+-> RX  UARTtoUSB bridge
 100 ; P4.2  - UCA1 RXD    J101.8 -  <---- TX  UARTtoUSB bridge
 101 ; P2.0  - RTS         J2.19  -  ----> CTS UARTtoUSB bridge (TERMINAL4WIRES)
 102 ; P2.1  - CTS         J4.40  -  <---- RTS UARTtoUSB bridge (TERMINAL5WIRES)
 103
 104 ; P1.2  - UCB0 SDA    J1.10  -  <---> SDA I2C Master_Slave
 105 ; P1.3  - UCB0 SCL    J1.9   -  ----> SCL I2C Master_Slave
 106
 107 ; P2.2  -             J2.18  -  <---- TSSOP32236 (IR RC5)
 108
 109 ; P2.5  -             J2.13  -  <---- SD_CD (Card Detect)
 110 ; P4.4  -             J2.12  -  ----> SD_CS (Card Select)
 111 ; P4.5  - UCB1 CLK    J1.7   -  ----> SD_CLK
 112 ; P4.6  - UCB1 SIMO   J2.15  -  ----> SD_SDI
 113 ; P4.7  - UCB1 SOMI   J2.14  -  <---- SD_SDO
 114
 115 ; P6.0  -             J4.39  -  ----> SCL I2C Soft_Master
 116 ; P6.1  -             J4.38  -  <---> SDA I2C Soft_Master
 117
 118 ; ----------------------------------------------------------------------
 119 ; INIT order : WDT, GPIOs, FRAM, Clock, UARTs...
 120 ; ----------------------------------------------------------------------
 121
 122 ; ----------------------------------------------------------------------
 123 ; POWER ON RESET AND INITIALIZATION : LOCK PMM_LOCKLPM5
 124 ; ----------------------------------------------------------------------
 125
 126 ;              BIS     #LOCKLPM5,&PM5CTL0 ; unlocked by WARM
 127
 128 ; ----------------------------------------------------------------------
 129 ; POWER ON RESET AND INITIALIZATION : WATCHDOG TIMER A
 130 ; ----------------------------------------------------------------------
 131
 132 ; WDT code
 133         MOV #WDTPW+WDTHOLD+WDTCNTCL,&WDTCTL    ; stop WDT
 134
 135 ; ----------------------------------------------------------------------
 136 ; POWER ON RESET AND INITIALIZATION : I/O
 137 ; ----------------------------------------------------------------------
 138
 139 ; ----------------------------------------------------------------------
 140 ; POWER ON RESET AND INITIALIZATION : PORT1/2
 141 ; ----------------------------------------------------------------------
 142
 143 ; reset state : Px{DIR,REN,SEL0,SEL1,SELC,IE,IFG,IV} = 0 ; Px{IN,OUT,IES} = ?
 144
 145 ; PORTA usage
 146
 147 ;               P1.0  -   LED1 red
 148 ; UART RTS      P2.0  -   J2.19     ---->   CTS UARTtoUSB bridge (TERMINAL4WIRES)
 149 ; UART CTS      P2.1  -   J4.40     <----   RTS UARTtoUSB bridge (TERMINAL5WIRES)
 150 ;               P2.3  -   SW2
 151 ;               P2.5  -   J2.10     <----   SD_CD (Card Detect)
 152
 153             MOV #-1,&PAREN      ; all inputs with pull resistors
 154             BIS #00001h,&PADIR  ; all pins as input else LED1 as output
 155             MOV #0FFFEh,&PAOUT  ; all pins with pullup resistors else LED1 = output low
 156
 157     .IFDEF UCA0_TERM
 158 ; UCA0_RXD  -   P1.6    - J1.3      <----   TX  UARTtoUSB bridge
 159 ; UCA0_TXD  -   P1.7    - J1.4      ---->   RX  UARTtoUSB bridge
 160 RXD         .equ 40h        ; P1.6 = RXD
 161 TXD         .equ 80h        ; P1.7 = TXD + FORTH Deep_RST pin
 162 TERM_BUS    .equ 0C0h
 163 TERM_IN     .equ P1IN
 164 TERM_REN    .equ P1REN
 165 TERM_SEL    .equ P1SEL0
 166     .ENDIF
 167
 168     .IFDEF TERMINAL4WIRES
 169
 170 ; RTS output must be wired to the CTS input of UART2USB bridge
 171 ; configure RTS as output high (false) to disable RX TERM during start FORTH
 172 HANDSHAKOUT .equ    P2OUT
 173 HANDSHAKIN  .equ    P2IN
 174 RTS         .equ    1           ; P2.0 bit position
 175
 176             BIS.B #1,&P2OUT     ; P2.0 RTS as output high
 177
 178         .IFDEF TERMINAL5WIRES   ; included in 4WIRES configuration
 179
 180 ; CTS input must be wired to the RTS output of UART2USB bridge
 181 ; configure CTS as input low (true)
 182 CTS         .equ    2           ; P2.1 bit position
 183             BIC.B  #2,&P2DIR    ; CTS input pull down resistor
 184
 185         .ENDIF  ; TERMINAL5WIRES
 186
 187     .ENDIF  ; TERMINAL4WIRES
 188
 189 SD_CD       .equ  20h
 190 SD_CDIN     .equ  P2IN
 191
 192 ; ----------------------------------------------------------------------
 193 ; POWER ON RESET AND INITIALIZATION : PORT3-4
 194 ; ----------------------------------------------------------------------
 195
 196 ; reset state : Px{DIR,REN,SEL0,SEL1,SELC,IE,IFG,IV} = 0 ; Px{IN,OUT,IES} = ?
 197
 198 ; PORTB usage
 199
 200 ;               P4.1    -   SW1
 201 ; UCA1 RXD      P4.2    -   J101.8  <----   TX  UARTtoUSB bridge
 202 ; UCA1 TXD      P4.3    -   J101.6  ---->   RX  UARTtoUSB bridge
 203 ;               P4.4    -   J2.9    ---->   SD_CS(Card Select)
 204 ; UCB1 CLK      P4.5    -   J1.7    ---->   SD_CLK
 205 ; UCB1 SIMO     P4.6    -   J2.15   ---->   SD_SDI
 206 ; UCB1 SOMI     P4.7    -   J2.14   <----   SD_SDO
 207
 208             MOV.B #-1,&PBOUT  ; pullup resistors for all pins
 209             BIS.B #-1,&PBREN  ; all pins with pull resistors
 210
 211     .IFDEF UCA1_TERM
 212 ; UCA1 RXD      P4.2    -   J101.8  <----   TX  UARTtoUSB bridge
 213 ; UCA1 TXD      P4.3    -   J101.6  ---->   RX  UARTtoUSB bridge
 214 RXD         .equ 4      ; P4.2 = RXD
 215 TXD         .equ 8      ; P4.3 = TXD + FORTH Deep_RST pin
 216 TERM_BUS    .equ 0Ch
 217 TERM_IN     .equ P4IN
 218 TERM_REN    .equ P4REN
 219 TERM_SEL    .equ P4SEL0
 220     .ENDIF
 221
 222     .IFDEF UCB1_SD
 223 SD_CS       .equ 10h    ; P4.4
 224 SD_CSOUT    .equ P4OUT
 225 SD_CSDIR    .equ P4DIR
 226
 227 SD_SEL      .equ PBSEL0 ; to configure UCB1
 228 SD_REN      .equ PBREN  ; to configure pullup resistors
 229 SD_BUS      .equ 0E000h ; pins P4.5 as UCA1CLK, P4.6 as UCA1SIMO & P4.7 as UCA1SOMI
 230     .ENDIF
 231 ; ----------------------------------------------------------------------
 232 ; POWER ON RESET AND INITIALIZATION : PORT5-6
 233 ; ----------------------------------------------------------------------
 234
 235 ; reset state : Px{DIR,REN,SEL0,SEL1,SELC,IE,IFG,IV} = 0 ; Px{IN,OUT,IES} = ?
 236
 237 ; PORT6 usage
 238
 239 ;           P6.6    -   LED2 green
 240
 241             BIS.B #0BFh,&P6REN  ; all pins with pull up resistors else P6.6
 242             MOV.B #0BFh,&P6OUT  ; OUT high for all pins else P6.6
 243             MOV.B #040h,&P6DIR  ; all pins with pullup resistors else LED2 = output low
 244
 245 ; ----------------------------------------------------------------------
 246 ; FRAM config
 247 ; ----------------------------------------------------------------------
 248
 249     .IF FREQUENCY = 16
 250             MOV.B   #0A5h, &FRCTL0_H     ; enable FRCTL0 access
 251             MOV.B   #10h, &FRCTL0         ; 1 waitstate @ 16 MHz
 252             MOV.B   #01h, &FRCTL0_H       ; disable FRCTL0 access
 253     .ENDIF
 254
 255     .IF FREQUENCY = 24
 256             MOV.B   #0A5h, &FRCTL0_H     ; enable FRCTL0 access
 257             MOV.B   #20h, &FRCTL0         ; 2 waitstate @ 24 MHz
 258             MOV.B   #01h, &FRCTL0_H       ; disable FRCTL0 access
 259     .ENDIF
 260
 261 ; ----------------------------------------------------------------------
 262 ; POWER ON RESET SYS config
 263 ; ----------------------------------------------------------------------
 264
 265     MOV #0A500h,&SYSCFG0    ; enable write MAIN + INFO
 266
 267 ; ----------------------------------------------------------------------
 268 ; POWER ON RESET AND INITIALIZATION : CLOCK SYSTEM
 269 ; ----------------------------------------------------------------------
 270
 271 ; CS code for MSP430FR2355
 272
 273 ; to measure REFO frequency, output the ACLK on P1.1:
 274 ;    BIS.B #2,&P1SEL1
 275 ;    BIS.B #2,&P1DIR
 276 ; result : REFO = xx.xxx kHz
 277
 278
 279     .IF FREQUENCY = 0.5
 280
 281 ;            MOV     #058h,&CSCTL0       ; preset DCO = measured value @ 0x180 (88)
 282 ;            MOV     #0001h,&CSCTL1      ; Set 1MHZ DCORSEL,disable DCOFTRIM,Modulation
 283             MOV     #1ED1h,&CSCTL0       ; preset MOD=31, DCO = measured value @ 0x180 (209)
 284             MOV     #00B0h,&CSCTL1      ; Set 1MHZ DCORSEL,enable DCOFTRIM=3h ,enable Modulation to reduce EMI
 285 ; ===================================== ;  fCOCLKDIV = REFO x (FLLN+1)
 286 ;            MOV     #100Dh,&CSCTL2      ; Set FLLD=1 (DCOCLKCDIV=DCO/2),set FLLN=0Dh
 287                                         ; fCOCLKDIV = 32768 x (13+1) = 0.459 MHz ; measured :  MHz
 288 ;            MOV     #100Eh,&CSCTL2      ; Set FLLD=1 (DCOCLKCDIV=DCO/2),set FLLN=0Eh
 289                                         ; fCOCLKDIV = 32768 x (14+1) = 0.491 MHz ; measured :  MHz
 290             MOV     #100Fh,&CSCTL2      ; Set FLLD=1 (DCOCLKCDIV=DCO/2),set FLLN=0Fh
 291                                         ; fCOCLKDIV = 32768 x (15+1) = 0.524 MHz ; measured :  MHz
 292 ; =====================================
 293             MOV     #8,X
 294
 295     .ELSEIF FREQUENCY = 1
 296
 297 ;            MOV     #100h,&CSCTL0       ; preset DCO = 256
 298 ;            MOV     #00B1h,&CSCTL1      ; Set 1MHZ DCORSEL,enable DCOFTRIM=3h ,disable Modulation
 299             MOV     #1EFFh,&CSCTL0       ; preset MOD=31, DCO=255
 300             MOV     #00B0h,&CSCTL1      ; Set 1MHZ DCORSEL,enable DCOFTRIM=3h ,enable Modulation to reduce EMI
 301 ; ===================================== ;  fCOCLKDIV = REFO x (FLLN+1)
 302 ;            MOV     #001Dh,&CSCTL2        ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1Dh
 303                                         ; fCOCLKDIV = 32768 x (29+1) = 0.983 MHz ; measured : 0.989MHz
 304             MOV     #001Eh,&CSCTL2         ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1Eh
 305                                         ; fCOCLKDIV = 32768 x (30+1) = 1.015 MHz ; measured : 1.013MHz
 306 ;            MOV     #001Fh,&CSCTL2        ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1Fh
 307                                         ; fCOCLKDIV = 32768 x (31+1) = 1.049 MHz ; measured : 1.046MHz
 308 ; =====================================
 309             MOV     #16,X
 310
 311     .ELSEIF FREQUENCY = 2
 312
 313 ;            MOV     #100h,&CSCTL0       ; preset DCO = 256
 314 ;            MOV     #00B3h,&CSCTL1      ; Set 2MHZ DCORSEL,enable DCOFTRIM=3h ,disable Modulation
 315             MOV     #1EFFh,&CSCTL0       ; preset MOD=31, DCO=255
 316             MOV     #00B2h,&CSCTL1      ; Set 2MHZ DCORSEL,enable DCOFTRIM=3h ,enable Modulation to reduce EMI
 317 ; ===================================== ;  fCOCLKDIV = REFO x (FLLN+1)
 318 ;            MOV     #003Bh,&CSCTL2        ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=3Bh
 319                                         ; fCOCLKDIV = 32768 x (59+1) = 1.996 MHz ; measured :  MHz
 320             MOV     #003Ch,&CSCTL2         ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=3Ch
 321                                         ; fCOCLKDIV = 32768 x (60+1) = 1.998 MHz ; measured :  MHz
 322 ;            MOV     #003Dh,&CSCTL2        ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=3Dh
 323                                         ; fCOCLKDIV = 32768 x (61+1) = 2.031 MHz ; measured :  MHz
 324 ; =====================================
 325             MOV     #32,X
 326
 327     .ELSEIF FREQUENCY = 4
 328
 329 ;            MOV     #100h,&CSCTL0       ; preset DCO = 256
 330 ;            MOV     #00B5h,&CSCTL1      ; Set 4MHZ DCORSEL,enable DCOFTRIM=3h ,disable Modulation
 331             MOV     #1EFFh,&CSCTL0       ; preset MOD=31, DCO=255
 332             MOV     #00B4h,&CSCTL1      ; Set 4MHZ DCORSEL,enable DCOFTRIM=3h ,enable Modulation to reduce EMI
 333 ; ===================================== ;  fCOCLKDIV = REFO x (FLLN+1)
 334 ;            MOV     #0078h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=78h
 335                                         ; fCOCLKDIV = 32768 x (120+1) = 3.965 MHz ; measured : 3.96MHz
 336
 337             MOV     #0079h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=79h
 338                                         ; fCOCLKDIV = 32768 x (121+1) = 3.997 MHz ; measured : 3.99MHz
 339
 340 ;            MOV     #007Ah,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=7Ah
 341                                         ; fCOCLKDIV = 32768 x (122+1) = 4.030 MHz ; measured : 4.020MHz
 342 ; =====================================
 343             MOV     #64,X
 344
 345     .ELSEIF FREQUENCY = 8
 346
 347 ;            MOV     #100h,&CSCTL0       ; preset DCO = 256
 348 ;            MOV     #00B7h,&CSCTL1      ; Set 8MHZ DCORSEL,enable DCOFTRIM=3h ,disable Modulation
 349             MOV     #1EFFh,&CSCTL0       ; preset MOD=31, DCO=255
 350             MOV     #00B6h,&CSCTL1      ; Set 8MHZ DCORSEL,enable DCOFTRIM=3h ,enable Modulation to reduce EMI
 351 ; ===================================== ;  fCOCLKDIV = REFO x (FLLN+1)
 352 ;            MOV     #00F2h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=F2h
 353                                         ; fCOCLKDIV = 32768 x (242+1) = 7.963 MHz ; measured : 7.943MHz
 354 ;            MOV     #00F3h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=F3h
 355                                         ; fCOCLKDIV = 32768 x (243+1) = 7.995 MHz ; measured : 7.976MHz
 356             MOV     #00F4h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=F4h
 357                                         ; fCOCLKDIV = 32768 x (244+1) = 8.028 MHz ; measured : 8.009MHz
 358
 359 ;            MOV     #00F5h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=F5h
 360                                         ; fCOCLKDIV = 32768 x (245+1) = 8.061 MHz ; measured : 8.042MHz
 361
 362 ;            MOV     #00F8h,&CSCTL2      ; don't work with cp2102 (by low value)
 363 ;            MOV     #00FAh,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=FAh
 364
 365 ; =====================================
 366             MOV     #128,X
 367
 368     .ELSEIF FREQUENCY = 12
 369
 370 ;            MOV     #100h,&CSCTL0       ; preset DCO = 256
 371 ;            MOV     #00B9h,&CSCTL1      ; Set 12MHZ DCORSEL,enable DCOFTRIM=3h ,disable Modulation
 372             MOV     #1EFFh,&CSCTL0       ; preset MOD=31, DCO=255
 373             MOV     #00B8h,&CSCTL1      ; Set 12MHZ DCORSEL,enable DCOFTRIM=3h ,enable Modulation to reduce EMI
 374 ; ===================================== ;  fCOCLKDIV = REFO x (FLLN+1)
 375 ;            MOV     #016Ch,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1E6h
 376                                         ; fCOCLKDIV = 32768 x 364+1) = 12.960 MHz ; measured : 11.xxxMHz
 377 ;            MOV     #016Dh,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1E7h
 378                                         ; fCOCLKDIV = 32768 x 365+1) = 11.993 MHz ; measured : 11.xxxMHz
 379             MOV     #016Eh,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1E8h
 380                                         ; fCOCLKDIV = 32768 x 366+1) = 12.025 MHz ; measured : 12.xxxMHz
 381 ;            MOV     #016Fh,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1E9h
 382                                         ; fCOCLKDIV = 32768 x 367+1) = 12.058 MHz ; measured : 12.xxxMHz
 383 ; =====================================
 384             MOV     #192,X
 385
 386     .ELSEIF FREQUENCY = 16
 387
 388 ;            MOV     #100h,&CSCTL0       ; preset DCO = 256
 389 ;            MOV     #00BBh,&CSCTL1      ; Set 16MHZ DCORSEL,enable DCOFTRIM=3h ,disable Modulation
 390             MOV     #1EFFh,&CSCTL0       ; preset MOD=31, DCO=255
 391             MOV     #00BAh,&CSCTL1      ; Set 16MHZ DCORSEL,enable DCOFTRIM=3h ,enable Modulation to reduce EMI
 392 ; ===================================== ;  fCOCLKDIV = REFO x (FLLN+1)
 393 ;            MOV     #01E6h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1E6h
 394                                         ; fCOCLKDIV = 32768 x 486+1) = 15.958 MHz ; measured : 15.92MHz
 395 ;            MOV     #01E7h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1E7h
 396                                         ; fCOCLKDIV = 32768 x 487+1) = 15.991 MHz ; measured : 15.95MHz
 397             MOV     #01E8h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1E8h
 398                                         ; fCOCLKDIV = 32768 x 488+1) = 16.023 MHz ; measured : 15.99MHz
 399 ;            MOV     #01E9h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1E9h
 400                                         ; fCOCLKDIV = 32768 x 489+1) = 16.056 MHz ; measured : 16.02MHz
 401 ; =====================================
 402             MOV     #256,X
 403
 404     .ELSEIF FREQUENCY = 20
 405
 406 ;            MOV     #100h,&CSCTL0       ; preset DCO = 256
 407 ;            MOV     #00BDh,&CSCTL1      ; Set 20MHZ DCORSEL,enable DCOFTRIM=3h ,disable Modulation
 408             MOV     #1EFFh,&CSCTL0       ; preset MOD=31, DCO=255
 409             MOV     #00BCh,&CSCTL1      ; Set 20MHZ DCORSEL,enable DCOFTRIM=3h ,enable Modulation to reduce EMI
 410 ; ===================================== ;  fCOCLKDIV = REFO x (FLLN+1)
 411 ;            MOV     #0260h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=260h
 412                                         ; fCOCLKDIV = 32768 x 608+1) = 19.956 MHz ; measured : 19.xxxMHz
 413 ;            MOV     #0261h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=261h
 414                                         ; fCOCLKDIV = 32768 x 609+1) = 19.988 MHz ; measured : 19.xxxMHz
 415             MOV     #0262h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=262h
 416                                         ; fCOCLKDIV = 32768 x 610+1) = 20.021 MHz ; measured : 20.xxxMHz
 417 ;            MOV     #0263h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=263h
 418                                         ; fCOCLKDIV = 32768 x 611+1) = 20.054 MHz ; measured : 20.xxxMHz
 419 ; =====================================
 420             MOV     #320,X
 421
 422     .ELSEIF FREQUENCY = 24
 423
 424 ;            MOV     #100h,&CSCTL0       ; preset DCO = 256
 425 ;            MOV     #00BFh,&CSCTL1      ; Set 24MHZ DCORSEL,enable DCOFTRIM=3h ,disable Modulation
 426             MOV     #1EFFh,&CSCTL0       ; preset MOD=31, DCO=255
 427             MOV     #00BEh,&CSCTL1      ; Set 24MHZ DCORSEL,enable DCOFTRIM=3h ,enable Modulation to reduce EMI
 428 ; ===================================== ;  fCOCLKDIV = REFO x (FLLN+1)
 429 ;            MOV     #02DAh,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=2DAh
 430                                         ; fCOCLKDIV = 32768 x 730+1) = 23.953 MHz ; measured : 23.xxxMHz
 431 ;            MOV     #02DBh,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=2DBh
 432                                         ; fCOCLKDIV = 32768 x 731+1) = 23.986 MHz ; measured : 23.xxxMHz
 433             MOV     #02DCh,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=2DCh
 434                                         ; fCOCLKDIV = 32768 x 732+1) = 24.019 MHz ; measured : 23.xxxMHz
 435 ;            MOV     #02DDh,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=2DDh
 436                                         ; fCOCLKDIV = 32768 x 733+1) = 24.051 MHz ; measured : 24.xxxMHz
 437 ; =====================================
 438             MOV     #384,X
 439
 440     .ELSEIF
 441     .error "bad frequency setting, only 0.5,1,2,4,8,12,16,20,24 MHz"
 442     .ENDIF
 443
 444     .IFDEF LF_XTAL
 445 ;           MOV     #0000h,&CSCTL3      ; FLL select XT1, FLLREFDIV=0 (default value)
 446             MOV     #0000h,&CSCTL4      ; ACLOCK select XT1, MCLK & SMCLK select DCOCLKDIV
 447     .ELSE
 448             BIS     #0010h,&CSCTL3      ; FLL select REFCLOCK
 449 ;           MOV     #0100h,&CSCTL4      ; ACLOCK select REFO, MCLK & SMCLK select DCOCLKDIV (default value)
 450     .ENDIF
 451
 452             BIS &SYSRSTIV,&SAVE_SYSRSTIV; store volatile SYSRSTIV preserving a pending request for DEEP_RST
 453             CMP #2,&SAVE_SYSRSTIV       ; POWER ON ?
 454             JZ      ClockWaitX          ; yes
 455             .word   0749h               ; no  RRUM #1,X --> wait anyway 250 ms because FLL lock time = 200 ms
 456 ClockWaitX  MOV     #5209,Y             ; wait 0.5s before starting after POR
 457
 458 ClockWaitY  SUB     #1,Y                ;1
 459             JNZ     ClockWaitY          ;2 5209x3 = 15625 cycles delay = 15.625ms @ 1MHz
 460             SUB     #1,X                ; x 32 @ 1 MHZ = 500ms
 461             JNZ     ClockWaitX          ; time to stabilize power source ( 500ms )
 462
 463 ;WAITFLL     BIT #300h,&CSCTL7         ; wait FLL lock
 464 ;            JNZ WAITFLL