]>
cloudbase.mooo.com Git - z180-stamp.git/blob - avr/z80-if.c
5 * | Z180-Sig | AVR-Port | Dir | Special Function |
6 * +------------+---------------+-------+-----------------------+
17 * | A10 | PC 2 | O | |
18 * | A11 | PC 3 | O | |
19 * | A12 | PC 4 | O | |
20 * | A13 | PC 5 | O | |
21 * | A14 | PC 6 | O | |
22 * | A15 | PC 7 | O | |
23 * | A16 | PE 2 | O | |
24 * | A17 | PE 3 | O | |
25 * | A18 | PE 4 | O | |
26 * | D0 | PF 0 | I/O | |
27 * | D1 | PF 1 | I/O | |
28 * | D2 | PF 2 | I/O | |
29 * | D3 | PF 3 | I/O | |
30 * | D4 | PF 4 | I/O | |
31 * | D5 | PF 5 | I/O | |
32 * | D6 | PF 6 | I/O | |
33 * | D7 | PF 7 | I/O | |
36 * | MREQ | PD 4 | O | |
37 * | RST | PD 5 | O | |
38 * | BUSREQ | PD 7 | O | |
39 * | BUSACK | PD 6 | I | |
40 * | IOCS1 | PE 5 | I | |
44 * | | P | | af1 USART1_TX |
45 * | | P | | af1 USART1_RX |
46 * | | P |JTDI | remap SPI1_NSS' |
47 * | | P |JTDO | remap SPI1_SCK' |
48 * | | P |JTRST | remap SPI1_MISO' |
49 * | | P | | remap SPI1_MOSI' |
50 * | | P | | af1 OSC32 |
51 * | | P | | af1 OSC32 |
57 #include <util/delay.h>
58 #include <util/atomic.h>
64 /* Number of array elements */
65 #define NELEMS(x) (sizeof x/sizeof *x)
68 #define CONCAT(x,y) x ## y
69 #define EVALUATOR(x,y) CONCAT(x,y)
71 #define GPIO_(X) CONCAT(GPIO, X)
82 } __attribute__((__packed__
));
84 #define SBIT(port,pin) ((*(volatile struct bits*)&port).b##pin)
97 #define P_BUSREQ PORTD
99 #define DDR_BUSREQ DDRD
100 #define P_BUSACK PORTD
101 #define PIN_BUSACK PIND
103 #define DDR_BUSACK DDRD
104 //#define P_HALT PORTA
106 #define P_IOCS1 PORTE
108 #define DDR_IOCS1 DDRE
109 //#define P_NMI PORTB
130 //#define ADB_PORT PORTE
133 #define Z80_O_ZCLK SBIT(P_ZCLK, 7)
134 #define Z80_O_MREQ SBIT(P_MREQ, 4)
135 #define Z80_O_RD SBIT(P_RD, 3)
136 #define Z80_O_WR SBIT(P_WR, 2)
137 #define Z80_O_BUSREQ SBIT(P_BUSREQ, 7)
138 //#define Z80_O_NMI SBIT(P_NMI, )
139 #define Z80_O_RST SBIT(P_RST, 5)
140 #define Z80_I_BUSACK SBIT(PIN_BUSACK, 6)
141 //#define Z80_I_HALT SBIT(P_HALT, )
144 #define MASK(n) ((1<<(n))-1)
145 #define SMASK(w,s) (MASK(w) << (s))
156 static zstate_t zstate
;
158 /*--------------------------------------------------------------------------*/
161 void z80_setup_clock(void)
163 /* ZCLK: Output and low */
164 DDR_ZCLK
|= _BV(ZCLK
);
167 DDRB
|= _BV(6); /* Debug */
168 PORTB
|= _BV(6); /* Debug */
170 PRR0
&= ~_BV(PRTIM1
);
172 /* Timer1: CTC: Toggle OC1C on compare match */
175 TCCR1A
= (0b01 << COM1C0
) | (0b00 << WGM10
);
176 TCCR1B
= (0b01 << WGM12
) | (0b001 << CS10
);
180 int z80_clock_set(unsigned long freq
)
182 unsigned long ocrval
= F_CPU
/ freq
/ 2;
183 uint8_t prescale
= 0;
185 while (ocrval
> (1L<<16)) {
193 if ((ocrval
== 0) || (prescale
> 4))
198 PINB
|= _BV(6); /* Debug */
201 TCCR1B
= (0b01 << WGM12
) | (0b000 << CS10
);
206 TCCR1A
= (0b01 << COM1C0
) | (0b00 << WGM10
);
207 TCCR1B
= (0b01 << WGM12
) | ((prescale
+1) << CS10
);
210 // TCCR1C |= _BV(FOC1C);
211 ATOMIC_BLOCK(ATOMIC_RESTORESTATE
) {
216 PINB
|= _BV(6); /* Debug */
221 uint32_t z80_clock_get(void)
223 uint32_t count
= (OCR1A
+ 1L) * 2;
224 uint8_t pre
= (TCCR1B
& 7) - 1;
240 static void z80_addrbus_set_tristate(void)
242 /* /MREQ, /RD, /WR: Input, no pullup */
243 DDR_MREQ
&= ~(_BV(MREQ
) | _BV(RD
) | _BV(WR
));
252 PIN_ADB
= P_ADB
& ~(MASK(ADB_WIDTH
) << ADB_SHIFT
);
253 DDR_ADB
= DDR_ADB
& ~(MASK(ADB_WIDTH
) << ADB_SHIFT
);
257 static void z80_addrbus_set_active(void)
259 /* /MREQ, /RD, /WR: Output and high */
263 DDR_MREQ
|= _BV(MREQ
) | _BV(RD
) | _BV(WR
);
267 DDR_ADB
= DDR_ADB
| (MASK(ADB_WIDTH
) << ADB_SHIFT
);
271 static void z80_dbus_set_in(void)
278 static void z80_dbus_set_out(void)
284 static void z80_reset_pulse(void)
292 void z80_setup_bus(void)
296 /* /ZRESET: Output and low */
300 /* /BUSREQ: Output and high */
302 DDR_BUSREQ
|= _BV(BUSREQ
);
304 /* /BUSACK: Input, no pullup */
305 DDR_BUSACK
&= ~_BV(BUSACK
);
306 P_BUSACK
&= ~_BV(BUSACK
);
308 /* /IOCS1: Input, no pullup */
309 DDR_IOCS1
&= ~_BV(IOCS1
);
310 P_IOCS1
&= ~_BV(IOCS1
);
312 z80_addrbus_set_tristate();
319 zstate_t
z80_bus_state(void)
325 static void z80_busreq_hpulse(void)
328 z80_addrbus_set_tristate();
330 ATOMIC_BLOCK(ATOMIC_RESTORESTATE
) {
332 Z80_O_BUSREQ
= 1; /* 2 AVR clock cycles */
333 Z80_O_BUSREQ
= 0; /* 2 AVR clock cycles */
336 if (zstate
& ZST_ACQUIRED
) {
337 while(Z80_I_BUSACK
== 1)
339 z80_addrbus_set_active();
347 + State | RESET | RESET_AQRD | RUNNING | RUNNING_AQRD |
351 ----------------+---------------+---------------+---------------+---------------+
353 Reset | 0 | 0 | 0 | 0 |
356 Request | 1 | | 3 | |
359 Release | | 0 | | 2 |
365 Restart | | | 2 | 3 |
373 zstate_t
z80_bus_cmd(bus_cmd_t cmd
)
379 z80_addrbus_set_tristate();
390 while(Z80_I_BUSACK
== 1)
392 z80_addrbus_set_active();
398 while(Z80_I_BUSACK
== 1)
400 z80_addrbus_set_active();
401 zstate
= RUNNING_AQRD
;
413 z80_addrbus_set_tristate();
420 z80_addrbus_set_tristate();
438 z80_addrbus_set_tristate();
440 z80_addrbus_set_active();
441 zstate
= RUNNING_AQRD
;
472 /*--------------------------------------------------------------------------*/
475 //inline __attribute__ ((always_inline))
476 void z80_setaddress(uint32_t addr
)
478 addr_t x
; x
.l
= addr
;
482 PIN_ADB
= ((x
.b
[2] << ADB_SHIFT
) ^ P_ADB
) & MASK(ADB_WIDTH
) << ADB_SHIFT
;
485 void z80_write(uint32_t addr
, uint8_t data
)
487 z80_setaddress(addr
);
498 uint8_t z80_read(uint32_t addr
)
502 z80_setaddress(addr
);
516 void z80_memset(uint32_t addr
, uint8_t data
, uint32_t length
)
521 z80_setaddress(addr
++);
531 void z80_write_block(const __flash
uint8_t *src
, uint32_t dest
, uint32_t length
)
538 z80_setaddress(dest
++);
550 0179' rx.bs_mask: ds 1 ; (buf_len - 1)
551 017A' rx.in_idx: ds 1 ;
552 017B' rx.out_idx: ds 1 ;
553 017C' rx.buf: ds rx.buf_len ;
554 018B' rx.buf_end equ $-1 ; last byte (start+len-1)
556 018C' tx.bs_mask: ds 1 ; (buf_len - 1)
557 018D' tx.in_idx: ds 1 ;
558 018E' tx.out_idx: ds 1 ;
559 018F' tx.buf: ds tx.buf_len ;
560 019E' tx.buf_end equ $-1 ; last byte
564 typedef struct __attribute__((packed
)) {
573 #define FIFO_BUFSIZE_MASK -3
574 #define FIFO_INDEX_IN -2
575 #define FIFO_INDEX_OUT -1
583 } fifo_dsc
[NUM_FIFOS
];
586 void z80_memfifo_init(const fifo_t f
, uint32_t adr
)
589 DBG_P(2, "z80_memfifo_init: %i, %lx\n", f
, adr
);
591 fifo_dsc
[f
].base
= adr
;
593 z80_bus_cmd(Request
);
595 fifo_dsc
[f
].mask
= z80_read(adr
+ FIFO_BUFSIZE_MASK
);
596 fifo_dsc
[f
].idx_in
= z80_read(adr
+ FIFO_INDEX_IN
);
597 fifo_dsc
[f
].idx_out
= z80_read(adr
+ FIFO_INDEX_OUT
);
599 z80_bus_cmd(Release
);
603 int z80_memfifo_is_empty(const fifo_t f
)
607 if (fifo_dsc
[f
].base
!= 0) {
609 uint32_t adr
= fifo_dsc
[f
].base
+ FIFO_INDEX_IN
;
612 z80_bus_cmd(Request
);
614 z80_bus_cmd(Release
);
615 rc
= idx
== fifo_dsc
[f
].idx_out
;
621 int z80_memfifo_is_full(const fifo_t f
)
625 if (fifo_dsc
[f
].base
!= 0) {
626 z80_bus_cmd(Request
);
627 rc
= ((fifo_dsc
[f
].idx_in
+ 1) & fifo_dsc
[f
].mask
)
628 == z80_read(fifo_dsc
[f
].base
+FIFO_INDEX_OUT
);
629 z80_bus_cmd(Release
);
634 uint8_t z80_memfifo_getc(const fifo_t f
)
638 while (z80_memfifo_is_empty(f
))
641 z80_bus_cmd(Request
);
642 idx
= fifo_dsc
[f
].idx_out
;
643 rc
= z80_read(fifo_dsc
[f
].base
+idx
);
644 fifo_dsc
[f
].idx_out
= ++idx
& fifo_dsc
[f
].mask
;
645 z80_write(fifo_dsc
[f
].base
+FIFO_INDEX_OUT
, fifo_dsc
[f
].idx_out
);
646 z80_bus_cmd(Release
);
652 void z80_memfifo_putc(fifo_t f
, uint8_t val
)
656 while (z80_memfifo_is_full(f
))
659 z80_bus_cmd(Request
);
660 idx
= fifo_dsc
[f
].idx_in
;
661 z80_write(fifo_dsc
[f
].base
+idx
, val
);
662 fifo_dsc
[f
].idx_in
= ++idx
& fifo_dsc
[f
].mask
;
663 z80_write(fifo_dsc
[f
].base
+FIFO_INDEX_IN
, fifo_dsc
[f
].idx_in
);
664 z80_bus_cmd(Release
);
667 /*--------------------------------------------------------------------------*/
669 TODO: Rewrite msg_fifo routines for AVR
674 //uint8_t idx_out, idx_in;
679 /*--------------------------------------------------------------------------*/
683 static void tim1_setup(void)
685 RCC_APB2RSTR
|= RCC_APB2RSTR_TIM1RST
;
686 RCC_APB2RSTR
&= ~RCC_APB2RSTR_TIM1RST
;
692 /* | TIM_SMCR_ETF_CK_INT_N_2 */
697 TIM1_DIER
= TIM_DIER_TDE
;
701 | TIM_CCMR1_OC1M_FORCE_LOW
702 | TIM_CCMR1_CC1S_OUT
;
704 TIM1_SMCR
|= TIM_SMCR_SMS_TM
;
709 /*--------------------------------------------------------------------------*/
711 void z80_setup_msg_fifo(void)
713 // gpio_set_mode(P_BUSACK, GPIO_MODE_INPUT,
714 // GPIO_CNF_INPUT_FLOAT, GPIO_BUSACK | GPIO_IOCS1);
718 // msg_fifo.count = NELEMS(msg_fifo.buf);
725 void z80_init_msg_fifo(uint32_t addr
)
728 DBG_P(1, "z80_init_msg_fifo: %lx\n", addr
);
730 z80_bus_cmd(Request
);
731 z80_write(addr
+FIFO_INDEX_OUT
, z80_read(addr
+FIFO_INDEX_IN
));
732 z80_bus_cmd(Release
);
733 msg_fifo
.base
= addr
;
737 int z80_msg_fifo_getc(void)
742 if (msg_fifo
.count
!= (NELEMS(msg_fifo
.buf
) /*- DMA1_CNDTR4 */ )) {
743 c
= msg_fifo
.buf
[msg_fifo
.count
];
744 if (++msg_fifo
.count
== NELEMS(msg_fifo
.buf
))
747 if (msg_fifo
.base
!= 0) {
748 z80_bus_cmd(Request
);
749 z80_write(msg_fifo
.base
+FIFO_INDEX_OUT
, msg_fifo
.count
);
750 z80_bus_cmd(Release
);