summaryrefslogtreecommitdiff
path: root/software/idm/idm.asm
blob: 078261387552f83ae8e37391d885000b17566b40 (plain) (blame)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
  ;;
  ;;  spreadspace pic utils
  ;;
  ;;
  ;;  Copyright (C) 2011 Christian Pointner <equinox@spreadspace.org>
  ;;                         
  ;;  This file is part of spreadspace pic utils.
  ;;
  ;;  spreadspace pic utils is free software: you can redistribute it and/or modify
  ;;  it under the terms of the GNU General Public License as published by
  ;;  the Free Software Foundation, either version 3 of the License, or
  ;;  any later version.
  ;;
  ;;  spreadspace pic utils is distributed in the hope that it will be useful,
  ;;  but WITHOUT ANY WARRANTY; without even the implied warranty of
  ;;  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  ;;  GNU General Public License for more details.
  ;;
  ;;  You should have received a copy of the GNU General Public License
  ;;  along with spreadspace pic utils. If not, see <http://www.gnu.org/licenses/>.
  ;;
  ;; -------------------------------------
  ;; PREAMBLE

  LIST      p=16F1847
  include   "p16f1847.inc"
  __config  _CONFIG1,  _FOSC_INTOSC & _WDTE_OFF & _PWRTE_OFF & _MCLRE_ON & _CP_OFF & _CPD_OFF & _BOREN_OFF & _CLKOUTEN_OFF & _IESO_OFF & _FCMEN_OFF
  __config  _CONFIG2,  _WRT_OFF & _PLLEN_OFF & _STVREN_OFF & _BORV_LO & _LVP_OFF


  ;; -------------------------------------
  ;; DEFINES
#define       DEBUG      1

  ;; constants
BUF_STARTH    EQU        H'0020'
BUF_STARTL    EQU        H'0000'
BUF_ENDH      EQU        H'0023'
BUF_ENDL      EQU        H'00BF'
#define       FSRW       FSR0
#define       FSRWH      FSR0H
#define       FSRWL      FSR0L
#define       INDFW      INDF0
#define       FSRR       FSR1
#define       FSRRH      FSR1H
#define       FSRRL      FSR1L
#define       INDFR      INDF1
  
  ;; I/O Pins
;; PortA
#define       C1m        PORTA,0
#define       C2p        PORTA,1
#define       AMP_OUT    PORTA,2
#define       ADC_IN     PORTA,3
#define       SPEAKER    PORTA,4
#define       DBG2       PORTA,6
#define       DBG1       PORTA,7
;; PortB
#define       DBG0       PORTB,0
#define       SDI        PORTB,1
#define       SDO        PORTB,2
#define       INT        PORTB,3
#define       SCK        PORTB,4
#define       CS         PORTB,5
#define       FILTER_EN  PORTB,7

  ;; variables
  ;;  all Pages
CMD           EQU        H'0070'
TMP           EQU        H'0071'

CMDS          EQU        H'007E'
FLAGS         EQU        H'007F'

    ;; bits
;; CMDS
#define       CMD_READ   CMDS,0

;; FLAGS
#define       UNDERRUN   FLAGS,0
#define       OVERRUN    FLAGS,1
  
  ;; -------------------------------------
  ;; Macros
inc_fsr     MACRO PTR,PTRH,PTRL
            LOCAL fsr_wraparound,inc_fsr_end
  addfsr    PTR,1
  movf      PTRH,w
  sublw     BUF_ENDH
  btfss     STATUS,C
  goto      fsr_wraparound
  btfss     STATUS,Z
  goto      inc_fsr_end
  movf      PTRL,w
  sublw     BUF_ENDL
  btfsc     STATUS,C
  goto      inc_fsr_end
fsr_wraparound
  movlw     BUF_STARTH
  movwf     PTRH
  movlw     BUF_STARTL
  movwf     PTRL
inc_fsr_end
  ENDM

  ;; -------------------------------------
  ;; Reset Vector
  org	      .0
  movlb     .1
;  movlw     b'01011000'         ;  1 MHz
;  movlw     b'01100000'         ;  2 MHz
;  movlw     b'01101000'         ;  4 MHz
;  movlw     b'01110000'         ;  8 MHz
  movlw     b'01111000'         ; 16 MHz
  movwf     OSCCON
  goto      init

  ;; -------------------------------------
  ;; Interrupts
  org       .4
  movlb     .0
if DEBUG == 1
  bsf       SPEAKER
endif
  btfsc     PIR1,SSP1IF
  goto      int_spi
  btfsc     PIR1,ADIF
  goto      int_adc
  retfie

  ;; void adcInterrupt()
  ;; {
  ;;   static char value = 0;
  ;;   if (!overrun) {
  ;;     *writePtr = ++value;
  ;;     wbuf_next();
  ;;   }
  ;; }
int_adc
  bcf       PIR1,ADIF
  btfsc     OVERRUN
  retfie
  ;; movlb     .1
  ;; movf      ADRESH,w
  movf      TMP,w
  movwf     INDFW
  incf      TMP,f
  call      wbuf_next
  goto      int_fsr_norestore

  ;; void sspInterrupt()
  ;; {
  ;;   if (cmd_read && spiData == 0) {
  ;;     *readPtr = 0;
  ;;     rbuf_next();
  ;;     spiData = underrun ? -1 : *readPtr;
  ;;   } else if (spiData == 'r') {
  ;;     cmd_read = TRUE;
  ;;     spiData = underrun ? -1 : *readPtr;
  ;;   } else {
  ;;     cmd_read = FALSE;
  ;;     printf("%s\n", "I don't like you!");
  ;;   }
  ;; }
int_spi
  bcf       PIR1,SSP1IF
  movlb     .4
  movf      SSP1BUF,w
  movwf     CMD
  btfsc     STATUS,Z
  goto      int_spi_0
  movlw     'r'
  xorwf     CMD,w
  btfsc     STATUS,Z
  goto      int_spi_r
  ;; other commands
  clrf      CMDS
  retfie

int_spi_0
  btfss     CMD_READ
  retfie
  call      rbuf_next
  movf      INDFR,w
  btfss     UNDERRUN
  movwf     SSP1BUF
  goto      int_fsr_norestore

int_spi_r
  movf      INDFR,w
  btfss     UNDERRUN
  movwf     SSP1BUF
  clrf      CMDS
  bsf       CMD_READ
  retfie

int_fsr_norestore
  movlb     .31
  movf      FSR0H,w
  movwf     FSR0H_SHAD
  movf      FSR0L,w
  movwf     FSR0L_SHAD
  movf      FSR1H,w
  movwf     FSR1H_SHAD
  movf      FSR1L,w
  movwf     FSR1L_SHAD
  retfie  

  ;; -------------------------------------
  ;; SUBROUTINES
  ;; void buf_init()
  ;; {
  ;;   writePtr = bufferStart;
  ;;   readPtr = bufferStart;
  ;;   overrun = FALSE;
  ;;   underrun = TRUE;
  ;;   cmd_read = FALSE;
  ;; }
buf_init
  movlw     BUF_STARTH
  movwf     FSRWH
  movwf     FSRRH
  movlw     BUF_STARTL
  movwf     FSRWL
  movwf     FSRRL
  bcf       OVERRUN
  bsf       UNDERRUN

  movf      BSR,w
  clrf      BSR
  bsf       INT
if DEBUG == 1
  bcf       DBG1
  bsf       DBG2
endif
  movwf     BSR
  return

  ;; -------------------
  ;; void wbuf_next()
  ;; {
  ;;   if (!overrun) {
  ;;     writePtr++;
  ;;     writePtr = writePtr > bufferEnd ? bufferStart : writePtr;
  ;;     underrun = FALSE;
  ;;     if(writePtr == readPtr) {
  ;;       overrun = TRUE;
  ;;     }
  ;;   }
  ;; }
wbuf_next
  btfsc     OVERRUN
  return

  inc_fsr   FSRW,FSRWH,FSRWL
  bcf       UNDERRUN
  movf      BSR,w
  clrf      BSR
  bcf       INT
if DEBUG == 1
  bcf       DBG2
endif
  movwf     BSR

  movf      FSRRH,w
  xorwf     FSRWH,w
  btfss     STATUS,Z
  return
  movf      FSRRL,w
  xorwf     FSRWL,w
  btfss     STATUS,Z
  return
  bsf       OVERRUN
if DEBUG == 1
  movf      BSR,w
  clrf      BSR
  bsf       DBG1
  movwf     BSR
endif
  return

  ;; -------------------
  ;; void rbuf_next()
  ;; {
  ;;   if(!underrun) {
  ;;     readPtr++;
  ;;     readPtr = readPtr > bufferEnd ? bufferStart : readPtr;
  ;;     overrun = FALSE;
  ;;     if(readPtr == writePtr) {
  ;;       underrun = TRUE;
  ;;     }
  ;;   }
  ;; }
rbuf_next
  btfsc     UNDERRUN
  return

  inc_fsr   FSRR,FSRRH,FSRRL
  bcf       OVERRUN
if DEBUG == 1
  movf      BSR,w
  clrf      BSR
  bcf       DBG1
  movwf     BSR
endif

  movf      FSRWH,w
  xorwf     FSRRH,w
  btfss     STATUS,Z
  return
  movf      FSRWL,w
  xorwf     FSRRL,w
  btfss     STATUS,Z
  return
  bsf       UNDERRUN
  movf      BSR,w
  clrf      BSR
  bsf       INT
if DEBUG == 1
  bsf       DBG2
endif
  movwf     BSR
  return

  ;; -------------------------------------
  ;; INIT
init
  ;; BANK 6
  movlb     .6
  clrf      CCPR4H
  movlw     .124
  movwf     CCPR4L
  movlw     b'00001011'
  movwf     CCP4CON

  ;; BANK 4
  movlb     .4
  movlw     b'01000000'
  movwf     SSP1STAT
  movlw     b'00010000'
  movwf     SSP1CON3
  movlw     b'00100100'
  movwf     SSP1CON1
if DEBUG == 1
  bsf       DBG0                ; Pull-up for DBG0
endif

  ;; BANK 3
  movlb     .3
  movlw     b'00001111'         ; PORTA0:3 analog, PORTA4:7, digital
  movwf     ANSELA
  clrf      ANSELB              ; PORTB0:7 digital

  ;; BANK 1
  movlb     .1
  movlw     b'00101111'
  movwf     TRISA
  movlw     b'01110011'
  movwf     TRISB
  movlw     b'01010000'         ; Left Justified, FOSC/16, NEG=VSS,POS=VDD
  movwf     ADCON1
  movlw     b'00001101'         ; AN3, ADC On
  movwf     ADCON0
  movlw     b'01001000'         ; ADIE,SSPIE
  movwf     PIE1
  movlw     b'01011111'         ; Enable Pull UPs, disable T0CKI
  movwf     OPTION_REG

  ;; BANK 0
  movlb     .0
  movlw     .124                ; 8 kHz @ 16MHz
  movwf     PR2
  clrf      TMR1H               ; reset TMR1
  clrf      TMR1L
  movlw     b'00100000'         ; Source Fosc/4, Prescaler 1:4, LP-Osc off, Sync, Timer off
  movwf     T1CON
  clrf      T1GCON
  clrf      PIR1                ; reset all used interupt flags
  movlw     b'01000000'         ; PEIE
  movwf     INTCON

  bcf       FILTER_EN
  call      buf_init
  clrf      CMDS
  clrf      TMP

  bsf       INTCON,GIE

  ;; -------------------------------------
  ;; MAINLOOP
main
if DEBUG == 1
  bcf       SPEAKER
  btfss     DBG0
  goto      enable_t1

  btfsc     T1CON,TMR1ON
  bcf       T1CON,TMR1ON
  goto      main

enable_t1
  btfss     T1CON,TMR1ON
  bsf       T1CON,TMR1ON
endif
  btfss     CS
  goto      main

powerdown:
  clrf      CMDS
  ;; sleep
  ;; nop
  goto	    main

  ;; -------------------------------------
  ;; END
  end