inc/LP_MSP430FR2476.asm

   1 ; -*- coding: utf-8 -*-
   2 ; LP_MSP430FR2476.asm
   3
   4 ; ===================================================================================
   5 ; in case of 3.3V powered by UARTtoUSB bridge, open J13 straps {RST,TST,V+,5V} BEFORE
   6 ; ===================================================================================
   7
   8 ;     J101 Target    J101    eZ-FET             UARTtoUSB
   9 ;
  10 ;            DVSS 14 o--o 13 GND
  11 ;             5V0 12 o--o 11 5V0
  12 ;            DVCC 10 o--o 9  3V3
  13 ;    P1.5 UCA0_RX  8 o--o 7  <------------ TX   UARTtoUSB
  14 ;    P1.4 UCA0_TX  6 o--o 5  <---------+-> RX   UARTtoUSB
  15 ;     SBWTDIO/RST  4 o--o 3            |         _
  16 ;      SBWTCK/TST  2 o--o 1            +--4k7---o o-- GND
  17 ;                                             DeepRST
  18 ; SD_Card socket
  19 ;  VCC -                       ----> VCC  SD_CardAdapter
  20 ;  GND -                       <---> GND  SD_CardAdapter
  21 ; P2.4 - UCA1 CLK       J2     ----> CLK  SD_CardAdapter (SCK)
  22 ; P2.6 - UCA1 TXD/SIMO  J1     ----> SDI  SD_CardAdapter (MOSI)
  23 ; P2.5 - UCA1 RXD/SOMI  J1     <---- SDO  SD_CardAdapter (MISO)
  24 ; P1.6 -                J4     ----> CS   SD_CardAdapter (Card Select)
  25 ; P1.7 -                J4     <---- CD   SD_CardAdapter (Card Detect)
  26 ;
  27 ; ======================================================================
  28 ; LP_MSP430FR2476 board
  29 ; ======================================================================
  30
  31 ; J1 - left ext.
  32 ; 3v3
  33 ; P1.6/UCA0CLK/TA1CLK/TDI/TCLK/A6
  34 ; P2.5/UCA1RXD/UCA1SOMI/CAP1.2
  35 ; P2.6/UCA1TXD/UCA1SIMO/CAP1.3
  36 ; P2.2/SYNC/ACLK/COMP0.1
  37 ; P5.4/UCB1STE/TA3CLK/A11
  38 ; P3.5/UCB1CLK/TB0TRG/CAP3.1
  39 ; P4.5/UCB0SOMI/UCB0SCL/TA3.2
  40 ; P1.3/UCB0SOMI/UCB0SCL/MCLK/A3
  41 ; P1.2/UCB0SIMO/UCB0SDA/TA0.2/A2/VEREF-
  42 ;
  43 ;
  44 ; J3 - left int.
  45 ; 5V
  46 ; GND
  47 ; P1.7/UCA0STE/SMCLK/TDO/A7
  48 ; P4.3/UCB1SOMI/UCB1SCL/TB0.5/A8
  49 ; P4.4/UCB1SIMO/UCB1SDA/TB0.6/A9
  50 ; P5.3/UCB1CLK/TA3.0/A10
  51 ; P1.0/UCB0STE/TA0CLK/A0/VEREF+     -<J7>- LED1
  52 ; P1.1/UCB0CLK/TA0.1/COMP0.0/A1     --- TEMPERATURE SENSOR ---<J9>--- 3V3
  53 ; P5.7/TA2.1/COMP0.2
  54 ; P3.7/TA3.2/CAP2.0
  55 ;
  56 ; J4 - right int.
  57 ; P5.2/UCA0TXD/UCA0SIMO/TB0.4
  58 ; P5.1/UCA0RXD/UCA0SOMI/TB0.3       -<J8>- LED2Red
  59 ; P5.0/UCA0CLK/TB0.2                -<J8>- LED2Green
  60 ; P4.7/UCA0STE/TB0.1                -<J8>- LED2Blue
  61 ; P6.0/TA2.2/COMP0.3
  62 ; P3.3/TA2.1/CAP0.1
  63 ; P6.1/TB0CLK
  64 ; P6.2/TB0.0
  65 ; P4.1/TA3.0/CAP2.2
  66 ; P3.1/UCA1STE/CAP1.0
  67 ;
  68 ; J2 - right ext.
  69 ; GND
  70 ; P4.6/UCB0SIMO/UCB0SDA/TA3.1
  71 ; P2.1/XIN
  72 ; P2.0/XOUT
  73 ; /RST/SBWTDIO
  74 ; P3.2/UCB1SIMO/UCB1SDA/CAP3.2
  75 ; P3.6/UCB1SOMI/UCB1SCL/CAP3.3
  76 ; P4.2/TA3CLK/CAP2.3
  77 ; P2.7/UCB1STE/CAP3.0
  78 ; P2.4/UCA1CLK/CAP1.1
  79 ;
  80 ; switch-keys:
  81 ; P4.0/TA3.1/CAP2.1                 - S1
  82 ; P2.3/TA2.0/CAP0.2                 - S2
  83 ; /RST                              - S3
  84 ;
  85 ; XTAL LF 32768 Hz
  86 ; P2.0/XOUT
  87 ; P2.1/XIN
  88 ;
  89 ;
  90 ; Clocks:
  91 ; 8 MHz DCO intern
  92 ;
  93 ;
  94 ; ----------------------------------------------------------------------
  95 ; POWER ON RESET AND INITIALIZATION : I/O
  96 ; ----------------------------------------------------------------------
  97 ; ----------------------------------------------------------------------
  98 ; POWER ON RESET AND INITIALIZATION : PORT1/2
  99 ; ----------------------------------------------------------------------
 100
 101 ; reset state : Px{DIR,REN,SEL0,SEL1,SELC,IE,IFG,IV} = 0 ; Px{IN,OUT,IES} = ?
 102
 103 ; PORT1 usage
 104 ; P1.0 - green LED2
 105
 106 LED2_OUT    .equ    P1OUT
 107 LED2_DIR    .equ    P1DIR
 108 LED2        .equ    1
 109
 110
 111 ; PORTx default wanted state : pins as input with pullup resistor
 112
 113             BIS     #-1,&PAREN      ; all pins with pull up/down resistors
 114             MOV     #0FFFEh,&PAOUT  ; all pins with pull up resistors  else P1.0 (LED2)
 115
 116     .IFDEF UCA0_TERM
 117 ; P1.4  UCA0-TXD    --> USB2UART RXD
 118 ; P1.5  UCA0-RXD    <-- USB2UART TXD
 119 TERM_IN     .equ P1IN
 120 TERM_SEL    .equ P1SEL0
 121 TERM_REN    .equ P1REN
 122 TXD         .equ 10h      ; P1.4 = TX
 123 RXD         .equ 20h      ; P1.5 = RX
 124 BUS_TERM    .equ 30h
 125     .ENDIF
 126
 127 CD_SD       .equ 080h   ; P1.7 as Card Detect
 128 SD_CDIN     .equ P1IN
 129
 130 CS_SD       .equ 040h   ; P1.6 as Card Select
 131 SD_CSOUT    .equ P1OUT
 132 SD_CSDIR    .equ P1DIR
 133
 134     .IFDEF UCA1_SD
 135 BUS_SD      .equ 7000h  ; pins P2.4 as UCA1CLK, P2.6 as UCA1SIMO & P2.5 as UCA1SOMI
 136 SD_SEL      .equ PASEL0 ; to configure UCA1
 137 SD_REN      .equ PAREN  ; to configure pullup resistors
 138     .ENDIF
 139
 140 ; P2.3/TA2.0/CAP0.2                 - S2
 141 SW2_IN      .equ    P2IN
 142 SW2         .equ    8
 143
 144 ; ----------------------------------------------------------------------
 145 ; POWER ON RESET AND INITIALIZATION : PORT3/4
 146 ; ----------------------------------------------------------------------
 147 ; reset state : Px{DIR,REN,SEL0,SEL1,SELC,IE,IFG,IV} = 0 ; Px{IN,OUT,IES} = ?
 148
 149             BIS     #-1,&PBREN      ; all pins 1 with pull up/down resistors
 150             MOV     #07FFFh,&PBOUT  ; all pins with pull up resistors else P4.7 (LED2B)
 151
 152 ; PORT3 usage
 153
 154     .IFDEF UCB1_TERM        ;
 155 TERM_SEL    .equ    P3SEL0
 156 TERM_REN    .equ    P3REN
 157 TERM_OUT    .equ    P3OUT
 158 BUS_TERM    .equ    0Ch     ; P3.2=SDA P3.3=SCL
 159     .ENDIF
 160
 161 ; PORT4 usage
 162
 163 ; S1 - P4.0
 164 SW1_IN      .equ    P4IN
 165 SW1         .equ    1       ; P4.0 = S1
 166 WIPE_IN     .equ    P4IN
 167 IO_WIPE     .equ    1       ; P4.0 = S1 = FORTH Deep_RST pin
 168
 169
 170 ; LED2B - J8 - P4.7
 171
 172 ; ----------------------------------------------------------------------
 173 ; POWER ON RESET AND INITIALIZATION : PORT5/6
 174 ; ----------------------------------------------------------------------
 175 ; reset state : Px{DIR,REN,SEL0,SEL1,SELC,IE,IFG,IV} = 0 ; Px{IN,OUT,IES} = ?
 176
 177 ; PORT5 usage
 178
 179 ; LED2R - J8 - P5.1  red LED1
 180 ; LED2G - J8 - P5.0
 181
 182 LED1_OUT    .equ P5OUT
 183 LED1_DIR    .equ P5DIR
 184 LED1        .equ 2
 185
 186 ; PORT6 usage
 187
 188 HANDSHAKOUT .equ    P6OUT
 189 HANDSHAKIN  .equ    P6IN
 190 RTS         .equ    2           ; P6.1
 191 CTS         .equ    4           ; P6.2
 192
 193 ;            BIS     #00003h,&PCDIR  ; all pins 0 as input else P5.0 (LED2G) P5.1 (LED2R)
 194 ;            MOV     #0FFFCh,&PCOUT  ; all pins high  else P5.0 (LED2G) P5.1 (LED2R)
 195 ;            BIS     #0FFFCh,&PCREN  ; all pins with pull resistors else P5.0 (LED2G) P5.1 (LED2R)
 196
 197             BIS     #-1,&PCREN      ; all pins with pull up/down resistors
 198             MOV     #0FFFCh,&PCOUT  ; all pins with pull up resistors else P5.0 (LED2G) P5.1 (LED2R)
 199
 200     .IFDEF TERMINAL4WIRES
 201 ; RTS output is wired to the CTS input of UART2USB bridge
 202 ; configure RTS as output high to disable RX TERM during start FORTH
 203             BIS.B #RTS,&P6DIR   ; RTS as output high
 204         .IFDEF TERMINAL5WIRES
 205 ; CTS input must be wired to the RTS output of UART2USB bridge
 206 ; configure CTS as input low (true) to avoid lock when CTS is not wired
 207             BIC.B #CTS,&P6OUT   ; CTS input pulled down
 208         .ENDIF  ; TERMINAL5WIRES
 209     .ENDIF  ; TERMINAL4WIRES
 210
 211 ; ----------------------------------------------------------------------
 212 ; FRAM config
 213 ; ----------------------------------------------------------------------
 214
 215     .IF  FREQUENCY > 8
 216             MOV.B   #0A5h,&FRCTL0_H ; enable FRCTL0 access
 217             MOV.B   #10h,&FRCTL0    ; 1 waitstate @ 16 MHz
 218             MOV.B   #01h,&FRCTL0_H  ; disable FRCTL0 access
 219     .ENDIF
 220
 221 ; ----------------------------------------------------------------------
 222 ; POWER ON RESET SYS config
 223 ; ----------------------------------------------------------------------
 224
 225 ; SYS code
 226 ;    BIC #1,&SYSCFG0 ; enable write program in FRAM
 227     MOV #0A500h,&SYSCFG0 ; enable write MAIN and INFO
 228
 229 ; ----------------------------------------------------------------------
 230 ; POWER ON RESET AND INITIALIZATION : CLOCK SYSTEM
 231 ; ----------------------------------------------------------------------
 232
 233 ; CS code for MSP430FR2476
 234
 235 ; to measure REFO frequency, output ACLK on P2.2:
 236 ;    BIS.B #4,&P2SEL1
 237 ;    BIS.B #4,&P2DIR
 238 ; result : REFO = xx.xx kHz
 239
 240     .IF FREQUENCY = 0.5
 241
 242 ;            MOV     #058h,&CSCTL0       ; preset DCO = measured value @ 0x180 (88)
 243 ;            MOV     #0001h,&CSCTL1      ; Set 1MHZ DCORSEL,disable DCOFTRIM,Modulation
 244             MOV     #1ED1h,&CSCTL0      ; preset MOD=31, DCO = measured value @ 0x180 (209)
 245             MOV     #00B0h,&CSCTL1      ; Set 1MHZ DCORSEL,enable DCOFTRIM=3h ,enable Modulation to reduce EMI
 246 ; ===================================== ;  fCOCLKDIV = REFO x (FLLN+1)
 247 ;            MOV     #100Dh,&CSCTL2      ; Set FLLD=1 (DCOCLKCDIV=DCO/2),set FLLN=0Dh
 248                                         ; fCOCLKDIV = 32768 x (13+1) = 0.459 MHz ; measured :  MHz
 249 ;            MOV     #100Eh,&CSCTL2      ; Set FLLD=1 (DCOCLKCDIV=DCO/2),set FLLN=0Eh
 250                                         ; fCOCLKDIV = 32768 x (14+1) = 0.491 MHz ; measured :  MHz
 251             MOV     #100Fh,&CSCTL2      ; Set FLLD=1 (DCOCLKCDIV=DCO/2),set FLLN=0Fh
 252                                         ; fCOCLKDIV = 32768 x (15+1) = 0.524 MHz ; measured :  MHz
 253 ; =====================================
 254             MOV     #8,X
 255
 256     .ELSEIF FREQUENCY = 1
 257
 258 ;            MOV     #100h,&CSCTL0       ; preset DCO = 256
 259 ;            MOV     #00B1h,&CSCTL1      ; Set 1MHZ DCORSEL,enable DCOFTRIM=3h ,disable Modulation
 260             MOV     #1EFFh,&CSCTL0       ; preset MOD=31, DCO=255
 261             MOV     #00B0h,&CSCTL1      ; Set 1MHZ DCORSEL,enable DCOFTRIM=3h ,enable Modulation to reduce EMI
 262 ; ===================================== ;  fCOCLKDIV = REFO x (FLLN+1)
 263 ;            MOV     #001Dh,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1Dh
 264                                         ; fCOCLKDIV = 32768 x (29+1) = 0.983 MHz ; measured : 0.989MHz
 265             MOV     #001Eh,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1Eh
 266                                         ; fCOCLKDIV = 32768 x (30+1) = 1.015 MHz ; measured : 1.013MHz
 267 ;            MOV     #001Fh,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1Fh
 268                                         ; fCOCLKDIV = 32768 x (31+1) = 1.049 MHz ; measured : 1.046MHz
 269 ; =====================================
 270             MOV     #16,X
 271
 272     .ELSEIF FREQUENCY = 2
 273
 274 ;            MOV     #100h,&CSCTL0       ; preset DCO = 256
 275 ;            MOV     #00B3h,&CSCTL1      ; Set 2MHZ DCORSEL,enable DCOFTRIM=3h ,disable Modulation
 276             MOV     #1EFFh,&CSCTL0       ; preset MOD=31, DCO=255
 277             MOV     #00B2h,&CSCTL1      ; Set 2MHZ DCORSEL,enable DCOFTRIM=3h ,enable Modulation to reduce EMI
 278 ; ===================================== ;  fCOCLKDIV = REFO x (FLLN+1)
 279 ;            MOV     #003Bh,&CSCTL2        ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=3Bh
 280                                         ; fCOCLKDIV = 32768 x (59+1) = 1.966 MHz ; measured :  MHz
 281             MOV     #003Ch,&CSCTL2         ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=3Ch
 282                                         ; fCOCLKDIV = 32768 x (60+1) = 1.998 MHz ; measured :  MHz
 283 ;            MOV     #003Dh,&CSCTL2        ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=3Dh
 284                                         ; fCOCLKDIV = 32768 x (61+1) = 2.031 MHz ; measured :  MHz
 285 ; =====================================
 286             MOV     #32,X
 287
 288     .ELSEIF FREQUENCY = 4
 289
 290 ;            MOV     #100h,&CSCTL0       ; preset DCO = 256
 291 ;            MOV     #00B5h,&CSCTL1      ; Set 4MHZ DCORSEL,enable DCOFTRIM=3h ,disable Modulation
 292             MOV     #1EFFh,&CSCTL0       ; preset MOD=31, DCO=255
 293             MOV     #00B4h,&CSCTL1      ; Set 4MHZ DCORSEL,enable DCOFTRIM=3h ,enable Modulation to reduce EMI
 294 ; ===================================== ;  fCOCLKDIV = REFO x (FLLN+1)
 295 ;            MOV     #0078h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=78h
 296                                         ; fCOCLKDIV = 32768 x (120+1) = 3.965 MHz ; measured : 3.96MHz
 297
 298             MOV     #0079h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=79h
 299                                         ; fCOCLKDIV = 32768 x (121+1) = 3.997 MHz ; measured : 3.99MHz
 300
 301 ;            MOV     #007Ah,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=7Ah
 302                                         ; fCOCLKDIV = 32768 x (122+1) = 4.030 MHz ; measured : 4.020MHz
 303 ; =====================================
 304             MOV     #64,X
 305
 306     .ELSEIF FREQUENCY = 8
 307
 308 ;            MOV     #100h,&CSCTL0       ; preset DCO = 256
 309 ;            MOV     #00B7h,&CSCTL1      ; Set 8MHZ DCORSEL,enable DCOFTRIM=3h ,disable Modulation
 310             MOV     #1EFFh,&CSCTL0       ; preset MOD=31, DCO=255
 311             MOV     #00B6h,&CSCTL1      ; Set 8MHZ DCORSEL,enable DCOFTRIM=3h ,enable Modulation to reduce EMI
 312 ; ===================================== ;  fCOCLKDIV = REFO x (FLLN+1)
 313 ;            MOV     #00F2h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=F2h
 314                                         ; fCOCLKDIV = 32768 x (242+1) = 7.963 MHz ; measured : 7.943MHz
 315 ;            MOV     #00F3h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=F3h
 316                                         ; fCOCLKDIV = 32768 x (243+1) = 7.995 MHz ; measured : 7.976MHz
 317             MOV     #00F4h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=F4h
 318                                         ; fCOCLKDIV = 32768 x (244+1) = 8.028 MHz ; measured : 8.009MHz
 319
 320 ;            MOV     #00F5h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=F5h
 321                                         ; fCOCLKDIV = 32768 x (245+1) = 8.061 MHz ; measured : 8.042MHz
 322
 323 ;            MOV     #00F8h,&CSCTL2      ; don't work with cp2102 (by low value)
 324 ;            MOV     #00FAh,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=FAh
 325
 326 ; =====================================
 327             MOV     #128,X
 328
 329     .ELSEIF FREQUENCY = 12
 330
 331 ;            MOV     #100h,&CSCTL0       ; preset DCO = 256
 332 ;            MOV     #00B9h,&CSCTL1      ; Set 12MHZ DCORSEL,enable DCOFTRIM=3h ,disable Modulation
 333             MOV     #1EFFh,&CSCTL0       ; preset MOD=31, DCO=255
 334             MOV     #00B8h,&CSCTL1      ; Set 12MHZ DCORSEL,enable DCOFTRIM=3h ,enable Modulation to reduce EMI
 335 ; ===================================== ;  fCOCLKDIV = REFO x (FLLN+1)
 336 ;            MOV     #016Ch,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1E6h
 337                                         ; fCOCLKDIV = 32768 x 364+1) = 12.960 MHz ; measured : 11.xxxMHz
 338 ;            MOV     #016Dh,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1E7h
 339                                         ; fCOCLKDIV = 32768 x 365+1) = 11.993 MHz ; measured : 11.xxxMHz
 340             MOV     #016Eh,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1E8h
 341                                         ; fCOCLKDIV = 32768 x 366+1) = 12.025 MHz ; measured : 12.xxxMHz
 342 ;            MOV     #016Fh,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1E9h
 343                                         ; fCOCLKDIV = 32768 x 367+1) = 12.058 MHz ; measured : 12.xxxMHz
 344 ; =====================================
 345             MOV     #192,X
 346
 347     .ELSEIF FREQUENCY = 16
 348
 349 ;            MOV     #100h,&CSCTL0       ; preset DCO = 256
 350 ;            MOV     #00BBh,&CSCTL1      ; Set 16MHZ DCORSEL,enable DCOFTRIM=3h ,disable Modulation
 351             MOV     #1EFFh,&CSCTL0      ; preset MOD=31, DCO=255
 352             MOV     #00BAh,&CSCTL1      ; Set 16MHZ DCORSEL,enable DCOFTRIM=3h ,enable Modulation to reduce EMI
 353 ; ===================================== ;  fCOCLKDIV = REFO x (FLLN+1)
 354 ;            MOV     #01E6h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1E6h
 355                                         ; fCOCLKDIV = 32768 x 486+1) = 15.958 MHz ; measured : 15.92MHz
 356 ;            MOV     #01E7h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1E7h
 357                                         ; fCOCLKDIV = 32768 x 487+1) = 15.991 MHz ; measured : 15.95MHz
 358             MOV     #01E8h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1E8h
 359                                         ; fCOCLKDIV = 32768 x 488+1) = 16.023 MHz ; measured : 15.99MHz
 360 ;            MOV     #01E9h,&CSCTL2      ; Set FLLD=0 (DCOCLKCDIV=DCO),set FLLN=1E9h
 361                                         ; fCOCLKDIV = 32768 x 489+1) = 16.056 MHz ; measured : 16.02MHz
 362 ; =====================================
 363             MOV     #256,X
 364
 365     .ELSEIF
 366     .error "bad frequency setting, only 0.5,1,2,4,8,12,16 MHz"
 367     .ENDIF
 368
 369
 370     .IFDEF LF_XTAL
 371 ;            MOV     #0000h,&CSCTL3      ; FLL select XT1, FLLREFDIV=0 (default value)
 372             MOV     #0000h,&CSCTL4      ; ACLOCK select XT1, MCLK & SMCLK select DCOCLKDIV
 373
 374             BIS.B   #03,&P2SEL0         ; P2.0 as XOUT, P2.1 as XIN
 375
 376     .ELSE
 377             BIS     #0010h,&CSCTL3      ; FLL select REFCLOCK
 378 ;            MOV     #0100h,&CSCTL4      ; ACLOCK select REFO, MCLK & SMCLK select DCOCLKDIV (default value)
 379
 380     .ENDIF
 381
 382             BIS &SYSRSTIV,&SAVE_SYSRSTIV; store volatile SYSRSTIV preserving a pending request for DEEP_RST
 383 ;            MOV &SAVE_SYSRSTIV,TOS  ;
 384 ;            CMP #2,TOS              ; POWER ON ?
 385 ;            JZ      ClockWaitX      ; yes
 386 ;            RRUM    #1,X            ; wait only 250 ms
 387 ClockWaitX  MOV     #5209,Y         ; wait 0.5s before starting after POR
 388                                     ;       ...because FLL lock time = 280 ms
 389 ClockWaitY  SUB     #1,Y            ;1
 390             JNZ     ClockWaitY      ;2 5209x3 = 15625 cycles delay = 15.625ms @ 1MHz
 391             SUB     #1,X            ; x 32 @ 1 MHZ = 500ms
 392             JNZ     ClockWaitX      ; time to stabilize power source ( 500ms )
 393
 394 ;WAITFLL     BIT #300h,&CSCTL7       ; wait FLL lock
 395 ;            JNZ WAITFLL
 396