Commit 9bc921b82fcaed68a28be552fcf6eef77e635e22
1 parent
ac7e6319
Added port ID to PIO
Showing
2 changed files
with
20 additions
and
5 deletions
hw/at91_pio.c
@@ -89,6 +89,7 @@ typedef struct PIOState { | @@ -89,6 +89,7 @@ typedef struct PIOState { | ||
89 | /* Mask of unknown state of PIO pins, needed for pull-up resistor | 89 | /* Mask of unknown state of PIO pins, needed for pull-up resistor |
90 | implementation */ | 90 | implementation */ |
91 | uint32_t unknown_state; | 91 | uint32_t unknown_state; |
92 | + int portid; | ||
92 | } PIOState; | 93 | } PIOState; |
93 | 94 | ||
94 | void at91_pio_set_pin(void *opaque, int pin, int level) | 95 | void at91_pio_set_pin(void *opaque, int pin, int level) |
@@ -186,7 +187,7 @@ static void at91_pio_mem_write(void *opaque, target_phys_addr_t offset, | @@ -186,7 +187,7 @@ static void at91_pio_mem_write(void *opaque, target_phys_addr_t offset, | ||
186 | PIOState *s = opaque; | 187 | PIOState *s = opaque; |
187 | int i; | 188 | int i; |
188 | 189 | ||
189 | - DPRINTF("Writing PIO: offset=0x%08lx, value=0x%08x\n",offset,value); | 190 | + DPRINTF("Writing PIO: portid=%d, offset=0x%08lx, value=0x%08x\n", s->portid, offset, value); |
190 | 191 | ||
191 | offset &= PIO_SIZE - 1; | 192 | offset &= PIO_SIZE - 1; |
192 | 193 | ||
@@ -219,7 +220,7 @@ static void at91_pio_mem_write(void *opaque, target_phys_addr_t offset, | @@ -219,7 +220,7 @@ static void at91_pio_mem_write(void *opaque, target_phys_addr_t offset, | ||
219 | qemu_set_irq(s->out[i], 1); | 220 | qemu_set_irq(s->out[i], 1); |
220 | if(prev != s->odsr) | 221 | if(prev != s->odsr) |
221 | { | 222 | { |
222 | - printf("Pin %d set\n",i); | 223 | + printf("Port %c%d set\n",'A' + s->portid, i); |
223 | } | 224 | } |
224 | } | 225 | } |
225 | break; | 226 | break; |
@@ -232,7 +233,7 @@ static void at91_pio_mem_write(void *opaque, target_phys_addr_t offset, | @@ -232,7 +233,7 @@ static void at91_pio_mem_write(void *opaque, target_phys_addr_t offset, | ||
232 | qemu_set_irq(s->out[i], 0); | 233 | qemu_set_irq(s->out[i], 0); |
233 | if(prev != s->odsr) | 234 | if(prev != s->odsr) |
234 | { | 235 | { |
235 | - printf("Pin %d reset\n",i); | 236 | + printf("Port %c%d reset\n",'A' + s->portid, i); |
236 | } | 237 | } |
237 | } | 238 | } |
238 | break; | 239 | break; |
@@ -355,6 +356,7 @@ static void at91_pio_init(SysBusDevice *dev) | @@ -355,6 +356,7 @@ static void at91_pio_init(SysBusDevice *dev) | ||
355 | { | 356 | { |
356 | DPRINTF("at91_pio_init called\n"); | 357 | DPRINTF("at91_pio_init called\n"); |
357 | PIOState *s = FROM_SYSBUS(typeof (*s), dev); | 358 | PIOState *s = FROM_SYSBUS(typeof (*s), dev); |
359 | + s->portid = at91_io_cnt; | ||
358 | at91_io_state[at91_io_cnt++] = s; | 360 | at91_io_state[at91_io_cnt++] = s; |
359 | int pio_regs; | 361 | int pio_regs; |
360 | 362 |
virtual_lab/main.c
1 | #include <stdint.h> | 1 | #include <stdint.h> |
2 | #include <stdbool.h> | 2 | #include <stdbool.h> |
3 | 3 | ||
4 | +#define PA_PER (*((volatile uint32_t*)0xFFFFF200)) | ||
5 | +#define PA_OER (*((volatile uint32_t*)0xFFFFF210)) | ||
6 | +#define PA_SODR (*((volatile uint32_t*)0xFFFFF230)) | ||
7 | +#define PA_CODR (*((volatile uint32_t*)0xFFFFF234)) | ||
8 | +#define PA_PDSR (*((volatile uint32_t*)0xFFFFF23C)) | ||
9 | + | ||
10 | + | ||
4 | #define PB_PER (*((volatile uint32_t*)0xFFFFF400)) | 11 | #define PB_PER (*((volatile uint32_t*)0xFFFFF400)) |
5 | #define PB_OER (*((volatile uint32_t*)0xFFFFF410)) | 12 | #define PB_OER (*((volatile uint32_t*)0xFFFFF410)) |
6 | #define PB_SODR (*((volatile uint32_t*)0xFFFFF430)) | 13 | #define PB_SODR (*((volatile uint32_t*)0xFFFFF430)) |
@@ -33,13 +40,18 @@ void dbgu_print_ascii(){};; | @@ -33,13 +40,18 @@ void dbgu_print_ascii(){};; | ||
33 | 40 | ||
34 | void delay(void) | 41 | void delay(void) |
35 | { | 42 | { |
36 | - volatile uint32_t i; | ||
37 | - for(i = 0; i < 1000000; i++); | 43 | + volatile uint64_t i; |
44 | + for(i = 0; i < 100000000; i++); | ||
38 | } | 45 | } |
39 | 46 | ||
40 | int main(void) | 47 | int main(void) |
41 | { | 48 | { |
42 | PMC_PCER = 1 << PER_ID_PBIOC_TO_PIOE; | 49 | PMC_PCER = 1 << PER_ID_PBIOC_TO_PIOE; |
50 | + | ||
51 | + PA_PER = 0x23; //PIO enable register | ||
52 | + PA_OER = 0x54; //PIO controller output enable register | ||
53 | + | ||
54 | + | ||
43 | PB_PER = DS1; //PIO enable register | 55 | PB_PER = DS1; //PIO enable register |
44 | PB_OER = DS1; //PIO controller output enable register | 56 | PB_OER = DS1; //PIO controller output enable register |
45 | PC_PER = DS2 | BT1 | BT2; //PIO enable register | 57 | PC_PER = DS2 | BT1 | BT2; //PIO enable register |
@@ -48,6 +60,7 @@ int main(void) | @@ -48,6 +60,7 @@ int main(void) | ||
48 | PC_PUER = BT1 | BT2; | 60 | PC_PUER = BT1 | BT2; |
49 | while(true) | 61 | while(true) |
50 | { | 62 | { |
63 | + delay(); | ||
51 | /* | 64 | /* |
52 | PB_SODR = DS1; | 65 | PB_SODR = DS1; |
53 | PC_CODR = DS2; | 66 | PC_CODR = DS2; |