author | Tero Marttila <terom@paivola.fi> |
Thu, 01 May 2014 23:55:53 +0300 | |
changeset 85 | ee05d89bde77 |
parent 18 | 79b25e81721f |
permissions | -rw-r--r-- |
9 | 1 |
.nolist |
2 |
.include "m168def.inc" ; Same family as 328P |
|
3 |
.list |
|
4 |
||
18 | 5 |
.include "macros.inc" |
9 | 6 |
|
7 |
;; Load a 16-bit *word* address into the given register a a byte address |
|
8 |
.macro loadp_16_i |
|
9 |
ldi @0, high(2 * @2) |
|
10 |
ldi @1, low(2 * @2) |
|
11 |
.endm |
|
12 |
||
13 |
.macro load_16_i |
|
14 |
ldi @0, high(@2) |
|
15 |
ldi @1, low(@2) |
|
16 |
.endm |
|
17 |
||
14
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
18 |
;; Data |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
19 |
.dseg |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
20 |
buffer: .byte 0 |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
21 |
|
9 | 22 |
;; Interrupt Vector |
14
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
23 |
.cseg |
13 | 24 |
.org 0x0000 |
9 | 25 |
rjmp Main |
26 |
||
13 | 27 |
;; Libraries |
28 |
.include "div.inc" ; Division routines |
|
29 |
||
9 | 30 |
;; Serial |
31 |
.set SERIAL_BAUD = 103 ; 9.6k @ 16Mhz |
|
32 |
||
33 |
;; Initialize the UART for |
|
34 |
Serial_Init: |
|
35 |
; Set up control registers |
|
36 |
; Single-speed |
|
37 |
poke [UCSR0A, r16, (0 << U2X0)] |
|
38 |
||
39 |
; Async |
|
40 |
; n parity |
|
41 |
; 1 stop |
|
42 |
; 8 bits |
|
43 |
poke [UCSR0C, r16, (0b00 << UMSEL00) | (0b00 << UPM00) | (0 << USBS0) | (0b11 << UCSZ00)] |
|
44 |
||
45 |
; Baud rate |
|
46 |
poke [UBRR0L, r16:r17, SERIAL_BAUD] |
|
47 |
||
48 |
; Enable RX |
|
49 |
; Enable TX |
|
50 |
; 8 bits |
|
11 | 51 |
poke [UCSR0B, r16, (1 << RXEN0) | (1 << TXEN0) | (0 << UCSZ02)] |
9 | 52 |
|
53 |
; Done |
|
54 |
ret |
|
55 |
||
56 |
;; Send a single byte on serial port |
|
57 |
; Input byte in r16 |
|
58 |
Serial_Send: |
|
59 |
; Wait for idle |
|
60 |
lds r0, UCSR0A |
|
61 |
sbrs r0, UDRE0 |
|
62 |
rjmp Serial_Send |
|
63 |
||
64 |
; Copy byte to buffer |
|
65 |
sts UDR0, r16 |
|
66 |
||
67 |
; Done |
|
68 |
ret |
|
69 |
||
11 | 70 |
;; Read a single byte from serial port |
71 |
; Output byte in r16 |
|
72 |
Serial_Recv: |
|
73 |
; Wait for recv |
|
74 |
lds r0, UCSR0A |
|
75 |
sbrs r0, RXC0 |
|
76 |
rjmp Serial_Recv |
|
77 |
||
78 |
; Copy byte from buffer |
|
79 |
lds r16, UDR0 |
|
80 |
||
81 |
; Done |
|
82 |
ret |
|
83 |
||
14
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
84 |
;; Write nul-terminated string from program mem to serial port |
9 | 85 |
; Input string in Z |
14
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
86 |
Serial_pprint: |
9 | 87 |
; Load byte to r16 |
88 |
lpm r16, Z+ |
|
89 |
||
90 |
; Quit if nul |
|
91 |
tst r16 |
|
14
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
92 |
breq _serial_pprint_end |
9 | 93 |
|
94 |
; Write it |
|
95 |
rcall Serial_Send |
|
96 |
||
97 |
; Continue |
|
14
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
98 |
rjmp Serial_pprint |
9 | 99 |
|
14
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
100 |
_serial_pprint_end: |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
101 |
ret |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
102 |
|
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
103 |
;; Write nul-terminated string from sram and \r\n to serial port |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
104 |
; Input string in Z |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
105 |
Serial_sprintln: |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
106 |
; Load byte to r16 |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
107 |
ld r16, Z+ |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
108 |
|
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
109 |
; Quit if nul |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
110 |
tst r16 |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
111 |
breq _serial_sprintln_end |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
112 |
|
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
113 |
; Write it |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
114 |
rcall Serial_Send |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
115 |
|
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
116 |
; Continue |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
117 |
rjmp Serial_sprintln |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
118 |
|
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
119 |
_serial_sprintln_end: |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
120 |
; \r\n |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
121 |
ldi r16, 13 |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
122 |
rcall Serial_Send |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
123 |
ldi r16, 10 |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
124 |
rcall Serial_Send |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
125 |
|
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
126 |
; Done |
9 | 127 |
ret |
128 |
||
13 | 129 |
;; Write char to serial port |
130 |
; Input byte in r16 |
|
14
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
131 |
Serial_bprint: |
13 | 132 |
; ASCII offset for '0' |
133 |
ldi r17, 48 |
|
134 |
mov r4, r17 |
|
135 |
||
136 |
; Convert |
|
137 |
ldi r17, 100 |
|
138 |
call div8u |
|
139 |
add r16, r4 |
|
140 |
rcall Serial_Send |
|
141 |
mov r16, r15 |
|
142 |
||
143 |
ldi r17, 10 |
|
144 |
call div8u |
|
145 |
add r16, r4 |
|
146 |
rcall Serial_Send |
|
147 |
mov r16, r15 |
|
148 |
||
149 |
add r16, r4 |
|
150 |
rcall Serial_Send |
|
151 |
||
152 |
ret |
|
153 |
||
9 | 154 |
;; Program |
155 |
message: .db "Hello World", 13, 10, 0 |
|
156 |
||
157 |
Main: |
|
158 |
; Initialization |
|
159 |
; Stack |
|
160 |
poke [SPL, r16:r17, RAMEND] |
|
161 |
||
162 |
; Enable interrupts |
|
163 |
sei |
|
164 |
||
165 |
; Init |
|
166 |
rcall Serial_Init |
|
167 |
||
168 |
; Main program |
|
169 |
ldi ZH, high(message * 2) |
|
170 |
ldi ZL, low(message * 2) |
|
171 |
||
14
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
172 |
rcall Serial_pprint |
11 | 173 |
|
174 |
; Echo out |
|
175 |
sbi DDRB, PORTB5 |
|
176 |
ldi r20, 0 |
|
13 | 177 |
ldi r21, 0 |
14
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
178 |
ldi r22, 0 |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
179 |
|
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
180 |
; pointer to memory buffer |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
181 |
ldi XH, high(buffer) |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
182 |
ldi XL, low(buffer) |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
183 |
|
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
184 |
st X, r22 ; '\0' |
11 | 185 |
|
186 |
Main_Echo: |
|
13 | 187 |
; blink LED |
11 | 188 |
out PORTB, r20 |
13 | 189 |
|
190 |
; read |
|
11 | 191 |
rcall Serial_Recv |
13 | 192 |
push r16 |
193 |
||
14
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
194 |
; display |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
195 |
rcall Serial_bprint |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
196 |
ldi r16, 32 |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
197 |
rcall Serial_Send |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
198 |
|
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
199 |
pop r16 |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
200 |
|
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
201 |
; test for control chars |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
202 |
cpi r16, 127 ; DEL |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
203 |
breq backspace |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
204 |
|
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
205 |
cpi r16, 13 ; '\r' |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
206 |
breq cr |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
207 |
|
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
208 |
cpi r16, 10 ; '\n' |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
209 |
breq Main_Echo ; ignore |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
210 |
|
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
211 |
rjmp char ; buffer char |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
212 |
|
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
213 |
; Erase last char |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
214 |
backspace: |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
215 |
; ignore if already at zero |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
216 |
cpi XL, low(buffer) |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
217 |
ldi r23, high(buffer) |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
218 |
cpc XH, r23 |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
219 |
breq echo |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
220 |
|
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
221 |
; use pre-decrement to store nul |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
222 |
st -X, r22 ; '\0' |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
223 |
|
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
224 |
rjmp echo |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
225 |
|
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
226 |
; Erase line |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
227 |
cr: |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
228 |
; seek to start |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
229 |
ldi XH, high(buffer) |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
230 |
ldi XL, low(buffer) |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
231 |
|
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
232 |
; store nul |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
233 |
st X, r22 ; '\0' |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
234 |
|
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
235 |
rjmp echo |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
236 |
|
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
237 |
char: |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
238 |
; buffer char |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
239 |
st X+, r16 |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
240 |
st X, r22 ; '\0' |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
241 |
|
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
242 |
echo: |
13 | 243 |
; running counter |
244 |
inc r21 |
|
245 |
mov r16, r21 |
|
14
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
246 |
rcall Serial_bprint |
13 | 247 |
|
248 |
; ' ' |
|
249 |
ldi r16, 32 |
|
11 | 250 |
rcall Serial_Send |
14
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
251 |
|
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
252 |
; length |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
253 |
mov r16, XL |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
254 |
rcall Serial_bprint |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
255 |
|
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
256 |
; ' ' |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
257 |
ldi r16, 32 |
13 | 258 |
rcall Serial_Send |
259 |
||
14
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
260 |
; output buffer |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
261 |
ldi ZH, high(buffer) |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
262 |
ldi ZL, low(buffer) |
1ebd5fc73d86
a weird interactive console...
Tero Marttila <terom@fixme.fi>
parents:
13
diff
changeset
|
263 |
rcall Serial_sprintln |
13 | 264 |
|
265 |
; toggle |
|
11 | 266 |
com r20 |
13 | 267 |
|
268 |
; continue |
|
11 | 269 |
rjmp Main_Echo |
270 |