MSP_EXP430FR2433.asm

   1 ; -*- coding: utf-8 -*-
   2
   3 ; Fast Forth For Texas Instrument MSP430FR5739
   4 ; Tested on MSP-EXP430FR2433 launchpad
   5 ;
   6 ; Copyright (C) <2017>  <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-EXP430FR2433 board
  23 ; ======================================================================
  24
  25 ; J101 (7xjumper)
  26 ; "SBWTCK"   ---> TEST
  27 ; "SBWTDIO"  ---> RST
  28 ; "TXD"      <--- P1.4  == UCA0TXD <-- UCA0TXDBUf
  29 ; "RXD"      ---> P1.5  == UCA0RXD --> UCA0RXDBUF
  30 ; "3V3"      <--> 3V3
  31 ; "5V0"      <--> 5V0
  32 ; "GND"      <--> GND
  33
  34
  35 ; SW1 -- P2.3
  36 ; SW2 -- P2.7
  37
  38 ; LED1 - P1.0
  39 ; LED2 - P1.1
  40
  41 ; I/O pins on J1:
  42 ; J1.1 - 3V3
  43 ; J1.2 - P1.0
  44 ; J1.3 - P1.5
  45 ; J1.4 - P1.4
  46 ; J1.5 - P1.6
  47 ; J1.6 - P1.7
  48 ; J1.7 - P2.4
  49 ; J1.8 - P2.7
  50 ; J1.9 - P1.3
  51 ; J1.10- P1.2
  52
  53 ; I/O pins on J2:
  54 ; J2.11 - P2.0
  55 ; J2.12 - P2.1
  56 ; J2.13 - P3.1
  57 ; J2.14 - P2.5
  58 ; J2.15 - P2.6
  59 ; J2.16 - RST
  60 ; J2.17 - P3.2
  61 ; J2.18 - P2.2
  62 ; J2.19 - P1.1
  63 ; J2.20 - GND
  64
  65 ; LFXTAL - P2.0
  66 ; LFXTAL - P2.1
  67
  68 ; ======================================================================
  69 ; MSP-EXP430FR2433 LAUNCHPAD    <--> OUTPUT WORLD
  70 ; ======================================================================
  71
  72 ;                                 +--4k7-< DeepRST switch <-- GND
  73 ;                                 |
  74 ; P1.4  - UCA0 TXD    J101.6 -  <-+-> RX  UARTtoUSB bridge
  75 ; P1.5  - UCA0 RXD    J101.8 -  <---- TX  UARTtoUSB bridge
  76 ; P1.0  - RTS         J1.2   -  ----> CTS UARTtoUSB bridge (TERMINAL4WIRES)
  77 ; P1.1  - CTS         J2.19  -  <---- RTS UARTtoUSB bridge (TERMINAL5WIRES)
  78
  79 ; P1.2  - UCB0 SDA    J1.10  -  <---> SDA I2C Master_Slave
  80 ; P1.3  - UCB0 SCL    J1.9   -  ----> SCL I2C Master_Slave
  81
  82 ; P2.2  - ACLK        J2.18  -  <---- TSSOP32236 (IR RC5)
  83
  84 ; P2.0  -             J2.11  -  ----> SD_CS (Card Select)
  85 ; P2.1  -             J2.12  -  <---- SD_CD (Card Detect)
  86 ; P2.4  - UCA1 CLK    J1.7   -  ----> SD_CLK
  87 ; P2.5  - UCA1 SOMI   J2.14  -  <---- SD_SDO
  88 ; P2.6  - UCA1 SIMO   J2.15  -  ----> SD_SDI
  89
  90 ; P3.1  -             J2.13  -  ----> SCL I2C Soft_Master
  91 ; P3.2  -             J2.17  -  <---> SDA I2C Soft_Master
  92
  93
  94 ; P2.0  -             J2.11  -  <---- I2CTERM_SLA0
  95 ; P2.1  -             J2.12  -  <---- I2CTERM_SLA1
  96 ; P2.2  - ACLK        J2.18  -  <---- I2CTERM_SLA2
  97
  98 ; ----------------------------------------------------------------------
  99 ; INIT order : WDT, GPIOs, FRAM, Clock, UARTs...
 100 ; ----------------------------------------------------------------------
 101
 102 ; ----------------------------------------------------------------------
 103 ; POWER ON RESET AND INITIALIZATION : LOCK PMM_LOCKLPM5
 104 ; ----------------------------------------------------------------------
 105
 106 ;              BIS     #LOCKLPM5,&PM5CTL0 ; unlocked by WARM
 107
 108 ; ----------------------------------------------------------------------
 109 ; POWER ON RESET AND INITIALIZATION : WATCHDOG TIMER A
 110 ; ----------------------------------------------------------------------
 111
 112 ; WDT code
 113         MOV #WDTPW+WDTHOLD+WDTCNTCL,&WDTCTL    ; stop WDT
 114
 115 ; ----------------------------------------------------------------------
 116 ; POWER ON RESET AND INITIALIZATION : I/O
 117 ; ----------------------------------------------------------------------
 118
 119 ; ----------------------------------------------------------------------
 120 ; POWER ON RESET AND INITIALIZATION : PORT1/2
 121 ; ----------------------------------------------------------------------
 122
 123 ; reset state : Px{DIR,REN,SEL0,SEL1,SELC,IE,IFG,IV} = 0 ; Px{IN,OUT,IES} = ?
 124
 125
 126 ; PORT1 usage
 127 ; LED1 - P1.0
 128 ; LED2 - P1.1
 129 ; P1.4  - TXD TERMINAL + DEEP_RST
 130 ; P1.5  - RXD TERMINAL
 131 ; P1.0  - RTS TERMINAL
 132 ; P1.1  - CTS TERMINAL
 133
 134
 135     .IFDEF UCA0_TERM
 136 TXD         .equ 10h        ; P1.4 = TXD + FORTH Deep_RST pin
 137 RXD         .equ 20h        ; P1.5
 138 TERM_BUS    .equ 30h
 139 TERM_IN     .equ P1IN
 140 TERM_SEL    .equ P1SEL0
 141 TERM_REN    .equ P1REN
 142     .ENDIF
 143
 144     .IFDEF UCA1_SD
 145 SD_SEL      .equ PASEL0     ; to configure UCA1
 146 SD_REN      .equ PAREN      ; to configure pullup resistors
 147 SD_BUS      .equ 07000h     ; pins P2.4 as UCA1CLK, P2.5 as UCA1SOMI & P2.6 as UCA1SIMO
 148     .ENDIF
 149
 150 ; P2.1                <--- SD_CD (Card Detect)
 151 SD_CD           .equ  2
 152 SD_CDIN         .equ  P2IN
 153 ; P2.0                ---> SD_CS (Card Select)
 154 SD_CS           .equ  1
 155 SD_CSOUT        .equ P2OUT
 156 SD_CSDIR        .equ P2DIR
 157
 158
 159     .IFDEF UCA1_TERM
 160 TXD         .equ 40h        ; P2.6 = TXD + FORTH Deep_RST pin
 161 RXD         .equ 20h        ; P2.5
 162 TERM_BUS    .equ 60h
 163 TERM_IN     .equ P2IN       ; TERMINAL TX  pin as FORTH Deep_RST
 164 TERM_SEL    .equ P2SEL0
 165 TERM_REN    .equ P2REN
 166     .ENDIF
 167
 168             MOV #-1,&PAREN      ; all inputs with pull resistors
 169             BIS #00003h,&PADIR  ; all pins as input else LED1/LED2 as output
 170             MOV #0FFFCh,&PAOUT  ; all pins with pullup resistors and LED1/LED2 = output low
 171
 172     .IFDEF TERMINAL4WIRES
 173 ; RTS output must be wired to the CTS input of UART2USB bridge
 174 ; configure RTS as output high to disable RX TERM during start FORTH
 175 ; notice that this pin RTS may be permanently wired on SBWTCK (TEST) without disturbing SBW 2 wires programming
 176 HANDSHAKOUT .equ    P1OUT
 177 HANDSHAKIN  .equ    P1IN
 178 RTS         .equ    1           ; P1.0 bit position
 179
 180             BIS #1,&PAOUT       ; P1.0 RTS as output high
 181
 182         .IFDEF TERMINAL5WIRES
 183
 184 ; CTS input must be wired to the RTS output of UART2USB bridge
 185 ; configure CTS as input low
 186 CTS         .equ    2           ; P1.1 bit position
 187             BIC  #2,&PADIR      ; CTS input pull down resistor
 188
 189         .ENDIF  ; TERMINAL5WIRES
 190
 191     .ENDIF  ; TERMINAL4WIRES
 192
 193
 194     .IFDEF UCB0_TERM        ; for MSP_EXP430FR2433_I2C
 195 I2CM_BUS        .equ    0Ch   ; P1.2=SDA P1.3=SCL
 196 I2CM_SEL        .equ    P1SEL0
 197 I2CM_REN        .equ    P1REN
 198 I2CM_OUT        .equ    P1OUT
 199     .ENDIF
 200
 201     .IFDEF  UCB0_I2CM   ; for TERM2IIC add-on
 202 I2CT_BUS        .equ    0Ch   ; P1.2=SDA P1.3=SCL
 203 I2CT_SEL        .equ    P1SEL0
 204 I2CT_REN        .equ    P1REN
 205 I2CT_OUT        .equ    P1OUT
 206     .ENDIF
 207
 208 I2CT_SLA_BUS    .equ   07h     ; P2.0 P2.1 P2.1
 209 I2CT_SLA_IN     .equ   P2IN
 210 I2CT_SLA_OUT    .equ   P2OUT
 211 I2CT_SLA_DIR    .equ   P2DIR
 212 I2CT_SLA_REN    .equ   P2REN
 213
 214
 215
 216 ; ----------------------------------------------------------------------
 217 ; POWER ON RESET AND INITIALIZATION : PORT3
 218 ; ----------------------------------------------------------------------
 219
 220 ; reset state : Px{DIR,REN,SEL0,SEL1,SELC,IE,IFG,IV} = 0 ; Px{IN,OUT,IES} = ?
 221
 222 ; PORT3 usage
 223             MOV.B #-1,&P3OUT  ; OUT1 for all pins
 224             BIS.B #-1,&P3REN  ; all pins with pull resistors
 225
 226
 227 ; ----------------------------------------------------------------------
 228 ; FRAM config
 229 ; ----------------------------------------------------------------------
 230
 231     .IF FREQUENCY = 16
 232 NWAITS            = 1
 233             MOV.B   #0A5h, &FRCTL0_H     ; enable FRCTL0 access
 234             MOV.B   #10h, &FRCTL0         ; 1 waitstate @ 16 MHz
 235             MOV.B   #01h, &FRCTL0_H       ; disable FRCTL0 access
 236     .ENDIF
 237
 238 ; ----------------------------------------------------------------------
 239 ; POWER ON RESET SYS config
 240 ; ----------------------------------------------------------------------
 241
 242 ; SYS code
 243 ;    BIC #1,&SYSCFG0 ; enable write program in FRAM
 244     MOV #0A500h,&SYSCFG0 ; enable write MAIN and INFO
 245
 246 ; ----------------------------------------------------------------------
 247 ; POWER ON RESET AND INITIALIZATION : CLOCK SYSTEM
 248 ; ----------------------------------------------------------------------
 249
 250 ; CS code for EXP430FR2433
 251
 252 ; to measure REFO frequency, output ACLK on P2.2:
 253 ;    BIS.B #4,&P2SEL1
 254 ;    BIS.B #4,&P2DIR
 255 ; result : REFO = 32.69kHz
 256
 257 ; ===================================================================
 258 ; need to adjust FLLN (and DCO) for each device of MSP430fr2xxx family ?
 259 ; (no problem with MSP430FR5xxx families without FLL).
 260 ; ===================================================================
 261
 262 ;    .IF FREQUENCY = 0.5
 263 ;
 264 ;            MOV #0D6h,&CSCTL0          ; preset DCO = 0xD6 (measured value @ 0x180 ; to measure, type 0x180 @ U.)
 265 ;
 266 ;            MOV     #0001h,&CSCTL1      ; Set 1MHZ DCORSEL,disable DCOFTRIM,Modulation
 267 ;; ===================================== ;  fCOCLKDIV = REFO x (FLLN+1)
 268 ;;            MOV     #100Dh,&CSCTL2      ; Set FLLD=1 (DCOCLKCDIV=DCO/2),set FLLN=0Dh
 269 ;                                        ; fCOCLKDIV = 32768 x (13+1) = 0.459 MHz ; measured :  MHz
 270 ;;            MOV     #100Eh,&CSCTL2      ; Set FLLD=1 (DCOCLKCDIV=DCO/2),set FLLN=0Eh
 271 ;                                        ; fCOCLKDIV = 32768 x (14+1) = 0.491 MHz ; measured :  MHz
 272 ;            MOV     #100Fh,&CSCTL2      ; Set FLLD=1 (DCOCLKCDIV=DCO/2),set FLLN=0Fh
 273 ;                                        ; fCOCLKDIV = 32768 x (15+1) = 0.524 MHz ; measured :  MHz
 274 ;; =====================================
 275 ;            MOV     #8,X
 276 ;
 277 ;    .ELSEIF FREQUENCY = 1
 278 ;
 279 ;            MOV #00B4h,&CSCTL0          ; preset DCO = 0xB4 (measured value @ 0x180 ; to measure, type HEX 0x180 ?)
 280 ;
 281 ;            MOV     #0001h,&CSCTL1      ; Set 1MHZ DCORSEL,disable DCOFTRIM,Modulation
 282 ;; ===================================== ;  fCOCLKDIV = REFO x (FLLN+1)
 283 ;;            MOV     #001Dh,&CSCTL2        ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1Dh
 284 ;                                        ; fCOCLKDIV = 32768 x (29+1) = 0.983 MHz ; measured : 0.989MHz
 285 ;            MOV     #001Eh,&CSCTL2         ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1Eh
 286 ;                                        ; fCOCLKDIV = 32768 x (30+1) = 1.015 MHz ; measured : 1.013MHz
 287 ;;            MOV     #001Fh,&CSCTL2        ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1Fh
 288 ;                                        ; fCOCLKDIV = 32768 x (31+1) = 1.049 MHz ; measured : 1.046MHz
 289 ;; =====================================
 290 ;            MOV     #16,X
 291 ;
 292 ;    .ELSEIF FREQUENCY = 2
 293 ;
 294 ;            MOV #00B4h,&CSCTL0          ; preset DCO = 0xB4 (measured value @ 0x180 ; to measure, type HEX 0x180 ?)
 295 ;
 296 ;            MOV     #0003h,&CSCTL1      ; Set 2MHZ DCORSEL,disable DCOFTRIM,Modulation
 297 ;; ===================================== ;  fCOCLKDIV = REFO x (FLLN+1)
 298 ;;            MOV     #003Bh,&CSCTL2        ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=3Bh
 299 ;                                        ; fCOCLKDIV = 32768 x (59+1) = 1.996 MHz ; measured :  MHz
 300 ;;            MOV     #003Ch,&CSCTL2         ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=3Ch
 301 ;                                        ; fCOCLKDIV = 32768 x (60+1) = 1.998 MHz ; measured :  MHz
 302 ;            MOV     #003Dh,&CSCTL2        ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=3Dh
 303 ;                                        ; fCOCLKDIV = 32768 x (61+1) = 2.031 MHz ; measured :  MHz
 304 ;; =====================================
 305 ;            MOV     #32,X
 306 ;
 307 ;    .ELSEIF FREQUENCY = 4
 308 ;
 309 ;            MOV #00D2h,&CSCTL0          ; preset DCO = 0xD2 (measured value @ 0x180)
 310 ;
 311 ;            MOV     #0005h,&CSCTL1      ; Set 4MHZ DCORSEL,disable DCOFTRIM,Modulation
 312 ;; ===================================== ;  fCOCLKDIV = REFO x (FLLN+1)
 313 ;;            MOV     #0078h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=78h
 314 ;                                        ; fCOCLKDIV = 32768 x (120+1) = 3.965 MHz ; measured : 3.96MHz
 315 ;
 316 ;            MOV     #0079h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=79h
 317 ;                                        ; fCOCLKDIV = 32768 x (121+1) = 3.997 MHz ; measured : 3.99MHz
 318 ;
 319 ;;            MOV     #007Ah,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=7Ah
 320 ;                                        ; fCOCLKDIV = 32768 x (122+1) = 4.030 MHz ; measured : 4.020MHz
 321 ;; =====================================
 322 ;            MOV     #64,X
 323 ;
 324 ;    .ELSEIF FREQUENCY = 8
 325 ;
 326 ;
 327 ;            MOV #00F3h,&CSCTL0          ; preset DCO = 0xF2 (measured value @ 0x180)
 328 ;
 329 ;            MOV     #0007h,&CSCTL1      ; Set 8MHZ DCORSEL,disable DCOFTRIM,Modulation
 330 ;; ===================================== ;  fCOCLKDIV = REFO x (FLLN+1)
 331 ;;            MOV     #00F2h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=F2h
 332 ;                                        ; fCOCLKDIV = 32768 x (242+1) = 7.963 MHz ; measured : 7.943MHz
 333 ;;            MOV     #00F3h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=F3h
 334 ;                                        ; fCOCLKDIV = 32768 x (243+1) = 7.995 MHz ; measured : 7.976MHz
 335 ;            MOV     #00F4h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=F4h
 336 ;                                        ; fCOCLKDIV = 32768 x (244+1) = 8.028 MHz ; measured : 8.009MHz
 337 ;
 338 ;;            MOV     #00F5h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=F5h
 339 ;                                        ; fCOCLKDIV = 32768 x (245+1) = 8.061 MHz ; measured : 8.042MHz
 340 ;
 341 ;;            MOV     #00F8h,&CSCTL2      ; don't work with cp2102 (by low value)
 342 ;;            MOV     #00FAh,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=FAh
 343 ;
 344 ;; =====================================
 345 ;            MOV     #128,X
 346 ;
 347 ;    .ELSEIF FREQUENCY = 16
 348 ;
 349 ;            MOV #0129h,&CSCTL0          ; preset DCO = 0x129 (measured value @ 0x180)
 350 ;
 351 ;            MOV     #000Bh,&CSCTL1      ; Set 16MHZ DCORSEL,disable DCOFTRIM,Modulation
 352 ;; ===================================== ;  fCOCLKDIV = REFO x (FLLN+1)
 353 ;;            MOV     #01E6h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1E6h
 354 ;                                        ; fCOCLKDIV = 32768 x 486+1) = 15.958 MHz ; measured : 15.92MHz
 355 ;;            MOV     #01E7h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1E7h
 356 ;                                        ; fCOCLKDIV = 32768 x 487+1) = 15.991 MHz ; measured : 15.95MHz
 357 ;;            MOV     #01E8h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1E8h
 358 ;                                        ; fCOCLKDIV = 32768 x 488+1) = 16.023 MHz ; measured : 15.99MHz
 359 ;            MOV     #01E9h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1E9h
 360 ;                                        ; fCOCLKDIV = 32768 x 489+1) = 16.056 MHz ; measured : 16.02MHz
 361 ;; =====================================
 362 ;            MOV     #256,X
 363
 364     .IF FREQUENCY = 0.5
 365
 366 ;            MOV     #058h,&CSCTL0       ; preset DCO = measured value @ 0x180 (88)
 367 ;            MOV     #0001h,&CSCTL1      ; Set 1MHZ DCORSEL,disable DCOFTRIM,Modulation
 368             MOV     #1ED1h,&CSCTL0       ; preset MOD=31, DCO = measured value @ 0x180 (209)
 369             MOV     #00B0h,&CSCTL1      ; Set 1MHZ DCORSEL,enable DCOFTRIM=3h ,enable Modulation to reduce EMI
 370 ; ===================================== ;  fCOCLKDIV = REFO x (FLLN+1)
 371 ;            MOV     #100Dh,&CSCTL2      ; Set FLLD=1 (DCOCLKCDIV=DCO/2),set FLLN=0Dh
 372                                         ; fCOCLKDIV = 32768 x (13+1) = 0.459 MHz ; measured :  MHz
 373 ;            MOV     #100Eh,&CSCTL2      ; Set FLLD=1 (DCOCLKCDIV=DCO/2),set FLLN=0Eh
 374                                         ; fCOCLKDIV = 32768 x (14+1) = 0.491 MHz ; measured :  MHz
 375             MOV     #100Fh,&CSCTL2      ; Set FLLD=1 (DCOCLKCDIV=DCO/2),set FLLN=0Fh
 376                                         ; fCOCLKDIV = 32768 x (15+1) = 0.524 MHz ; measured :  MHz
 377 ; =====================================
 378             MOV     #8,X
 379
 380     .ELSEIF FREQUENCY = 1
 381
 382 ;            MOV     #100h,&CSCTL0       ; preset DCO = 256
 383 ;            MOV     #00B1h,&CSCTL1      ; Set 1MHZ DCORSEL,enable DCOFTRIM=3h ,disable Modulation
 384             MOV     #1EFFh,&CSCTL0       ; preset MOD=31, DCO=255
 385             MOV     #00B0h,&CSCTL1      ; Set 1MHZ DCORSEL,enable DCOFTRIM=3h ,enable Modulation to reduce EMI
 386 ; ===================================== ;  fCOCLKDIV = REFO x (FLLN+1)
 387 ;            MOV     #001Dh,&CSCTL2        ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1Dh
 388                                         ; fCOCLKDIV = 32768 x (29+1) = 0.983 MHz ; measured : 0.989MHz
 389             MOV     #001Eh,&CSCTL2         ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1Eh
 390                                         ; fCOCLKDIV = 32768 x (30+1) = 1.015 MHz ; measured : 1.013MHz
 391 ;            MOV     #001Fh,&CSCTL2        ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1Fh
 392                                         ; fCOCLKDIV = 32768 x (31+1) = 1.049 MHz ; measured : 1.046MHz
 393 ; =====================================
 394             MOV     #16,X
 395
 396     .ELSEIF FREQUENCY = 2
 397
 398 ;            MOV     #100h,&CSCTL0       ; preset DCO = 256
 399 ;            MOV     #00B3h,&CSCTL1      ; Set 2MHZ DCORSEL,enable DCOFTRIM=3h ,disable Modulation
 400             MOV     #1EFFh,&CSCTL0       ; preset MOD=31, DCO=255
 401             MOV     #00B2h,&CSCTL1      ; Set 2MHZ DCORSEL,enable DCOFTRIM=3h ,enable Modulation to reduce EMI
 402 ; ===================================== ;  fCOCLKDIV = REFO x (FLLN+1)
 403 ;            MOV     #003Bh,&CSCTL2        ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=3Bh
 404                                         ; fCOCLKDIV = 32768 x (59+1) = 1.996 MHz ; measured :  MHz
 405             MOV     #003Ch,&CSCTL2         ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=3Ch
 406                                         ; fCOCLKDIV = 32768 x (60+1) = 1.998 MHz ; measured :  MHz
 407 ;            MOV     #003Dh,&CSCTL2        ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=3Dh
 408                                         ; fCOCLKDIV = 32768 x (61+1) = 2.031 MHz ; measured :  MHz
 409 ; =====================================
 410             MOV     #32,X
 411
 412     .ELSEIF FREQUENCY = 4
 413
 414 ;            MOV     #100h,&CSCTL0       ; preset DCO = 256
 415 ;            MOV     #00B5h,&CSCTL1      ; Set 4MHZ DCORSEL,enable DCOFTRIM=3h ,disable Modulation
 416             MOV     #1EFFh,&CSCTL0       ; preset MOD=31, DCO=255
 417             MOV     #00B4h,&CSCTL1      ; Set 4MHZ DCORSEL,enable DCOFTRIM=3h ,enable Modulation to reduce EMI
 418 ; ===================================== ;  fCOCLKDIV = REFO x (FLLN+1)
 419 ;            MOV     #0078h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=78h
 420                                         ; fCOCLKDIV = 32768 x (120+1) = 3.965 MHz ; measured : 3.96MHz
 421
 422             MOV     #0079h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=79h
 423                                         ; fCOCLKDIV = 32768 x (121+1) = 3.997 MHz ; measured : 3.99MHz
 424
 425 ;            MOV     #007Ah,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=7Ah
 426                                         ; fCOCLKDIV = 32768 x (122+1) = 4.030 MHz ; measured : 4.020MHz
 427 ; =====================================
 428             MOV     #64,X
 429
 430     .ELSEIF FREQUENCY = 8
 431
 432 ;            MOV     #100h,&CSCTL0       ; preset DCO = 256
 433 ;            MOV     #00B7h,&CSCTL1      ; Set 8MHZ DCORSEL,enable DCOFTRIM=3h ,disable Modulation
 434             MOV     #1EFFh,&CSCTL0       ; preset MOD=31, DCO=255
 435             MOV     #00B6h,&CSCTL1      ; Set 8MHZ DCORSEL,enable DCOFTRIM=3h ,enable Modulation to reduce EMI
 436 ; ===================================== ;  fCOCLKDIV = REFO x (FLLN+1)
 437 ;            MOV     #00F2h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=F2h
 438                                         ; fCOCLKDIV = 32768 x (242+1) = 7.963 MHz ; measured : 7.943MHz
 439 ;            MOV     #00F3h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=F3h
 440                                         ; fCOCLKDIV = 32768 x (243+1) = 7.995 MHz ; measured : 7.976MHz
 441             MOV     #00F4h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=F4h
 442                                         ; fCOCLKDIV = 32768 x (244+1) = 8.028 MHz ; measured : 8.009MHz
 443
 444 ;            MOV     #00F5h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=F5h
 445                                         ; fCOCLKDIV = 32768 x (245+1) = 8.061 MHz ; measured : 8.042MHz
 446
 447 ;            MOV     #00F8h,&CSCTL2      ; don't work with cp2102 (by low value)
 448 ;            MOV     #00FAh,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=FAh
 449
 450 ; =====================================
 451             MOV     #128,X
 452
 453     .ELSEIF FREQUENCY = 12
 454
 455 ;            MOV     #100h,&CSCTL0       ; preset DCO = 256
 456 ;            MOV     #00B9h,&CSCTL1      ; Set 12MHZ DCORSEL,enable DCOFTRIM=3h ,disable Modulation
 457             MOV     #1EFFh,&CSCTL0       ; preset MOD=31, DCO=255
 458             MOV     #00B8h,&CSCTL1      ; Set 12MHZ DCORSEL,enable DCOFTRIM=3h ,enable Modulation to reduce EMI
 459 ; ===================================== ;  fCOCLKDIV = REFO x (FLLN+1)
 460 ;            MOV     #016Ch,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1E6h
 461                                         ; fCOCLKDIV = 32768 x 364+1) = 12.960 MHz ; measured : 11.xxxMHz
 462 ;            MOV     #016Dh,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1E7h
 463                                         ; fCOCLKDIV = 32768 x 365+1) = 11.993 MHz ; measured : 11.xxxMHz
 464             MOV     #016Eh,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1E8h
 465                                         ; fCOCLKDIV = 32768 x 366+1) = 12.025 MHz ; measured : 12.xxxMHz
 466 ;            MOV     #016Fh,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1E9h
 467                                         ; fCOCLKDIV = 32768 x 367+1) = 12.058 MHz ; measured : 12.xxxMHz
 468 ; =====================================
 469             MOV     #192,X
 470
 471     .ELSEIF FREQUENCY = 16
 472
 473 ;            MOV     #100h,&CSCTL0       ; preset DCO = 256
 474 ;            MOV     #00BBh,&CSCTL1      ; Set 16MHZ DCORSEL,enable DCOFTRIM=3h ,disable Modulation
 475             MOV     #1EFFh,&CSCTL0       ; preset MOD=31, DCO=255
 476             MOV     #00BAh,&CSCTL1      ; Set 16MHZ DCORSEL,enable DCOFTRIM=3h ,enable Modulation to reduce EMI
 477 ; ===================================== ;  fCOCLKDIV = REFO x (FLLN+1)
 478 ;            MOV     #01E6h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1E6h
 479                                         ; fCOCLKDIV = 32768 x 486+1) = 15.958 MHz ; measured : 15.92MHz
 480 ;            MOV     #01E7h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1E7h
 481                                         ; fCOCLKDIV = 32768 x 487+1) = 15.991 MHz ; measured : 15.95MHz
 482             MOV     #01E8h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1E8h
 483                                         ; fCOCLKDIV = 32768 x 488+1) = 16.023 MHz ; measured : 15.99MHz
 484 ;            MOV     #01E9h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1E9h
 485                                         ; fCOCLKDIV = 32768 x 489+1) = 16.056 MHz ; measured : 16.02MHz
 486 ; =====================================
 487             MOV     #256,X
 488
 489     .ELSEIF
 490     .error "bad frequency setting, only 0.5,1,2,4,8,12,16 MHz"
 491     .ENDIF
 492
 493     .IFDEF LF_XTAL
 494 ;           MOV     #0000h,&CSCTL3      ; FLL select XT1, FLLREFDIV=0 (default value)
 495             MOV     #0000h,&CSCTL4      ; ACLOCK select XT1, MCLK & SMCLK select DCOCLKDIV
 496     .ELSE
 497             BIS     #0010h,&CSCTL3      ; FLL select REFCLOCK
 498 ;           MOV     #0100h,&CSCTL4      ; ACLOCK select REFO, MCLK & SMCLK select DCOCLKDIV (default value)
 499     .ENDIF
 500
 501             BIS &SYSRSTIV,&SAVE_SYSRSTIV; store volatile SYSRSTIV preserving a pending request for DEEP_RST
 502             CMP #2,&SAVE_SYSRSTIV       ; POWER ON ?
 503             JZ      ClockWaitX          ; yes
 504             .word   0749h               ; no  RRUM #1,X --> wait anyway 250 ms because FLL lock time = 200 ms
 505 ClockWaitX  MOV     #5209,Y             ; wait 0.5s before starting after POR
 506
 507 ClockWaitY  SUB     #1,Y                ;1
 508             JNZ     ClockWaitY          ;2 5209x3 = 15625 cycles delay = 15.625ms @ 1MHz
 509             SUB     #1,X                ; x 32 @ 1 MHZ = 500ms
 510             JNZ     ClockWaitX          ; time to stabilize power source ( 500ms )
 511
 512 ;WAITFLL     BIT #300h,&CSCTL7         ; wait FLL lock
 513 ;            JNZ WAITFLL