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