Commit c45a3a030ed776f8590170e1f4cf1e320656d0a9
1 parent
3c6f9b87
added push buttons
Showing
9 changed files
with
472 additions
and
179 deletions
monitor.c
| ... | ... | @@ -92,6 +92,9 @@ struct Monitor { |
| 92 | 92 | LIST_ENTRY(Monitor) entry; |
| 93 | 93 | }; |
| 94 | 94 | |
| 95 | +static QEMUTimer *button_timer1; | |
| 96 | +static QEMUTimer *button_timer2; | |
| 97 | + | |
| 95 | 98 | static LIST_HEAD(mon_list, Monitor) mon_list; |
| 96 | 99 | |
| 97 | 100 | static const mon_cmd_t mon_cmds[]; |
| ... | ... | @@ -543,11 +546,45 @@ static void do_set_gpio(Monitor* mon, const char* port, const char* value) |
| 543 | 546 | printf("Invalid channel\n"); |
| 544 | 547 | } |
| 545 | 548 | |
| 549 | + | |
| 550 | +static void button_handler1(void *mon) | |
| 551 | +{ | |
| 552 | + qemu_del_timer(button_timer1); | |
| 553 | + do_set_gpio((Monitor*)mon, "C5", "1"); | |
| 554 | +} | |
| 555 | + | |
| 556 | +static void button_handler2(void *mon) | |
| 557 | +{ | |
| 558 | + qemu_del_timer(button_timer2); | |
| 559 | + do_set_gpio((Monitor*)mon, "C4", "1"); | |
| 560 | +} | |
| 561 | + | |
| 562 | + | |
| 563 | +static void do_b1(Monitor* mon) | |
| 564 | +{ | |
| 565 | + do_set_gpio(mon, "C5", "0"); | |
| 566 | + qemu_mod_timer(button_timer1, qemu_get_clock(vm_clock) + | |
| 567 | + muldiv64(ticks_per_sec, 100, 1000)); | |
| 568 | +} | |
| 569 | + | |
| 570 | +static void do_b2(Monitor* mon) | |
| 571 | +{ | |
| 572 | + do_set_gpio(mon, "C4", "0"); | |
| 573 | + qemu_mod_timer(button_timer2, qemu_get_clock(vm_clock) + | |
| 574 | + muldiv64(ticks_per_sec, 100, 1000)); | |
| 575 | +} | |
| 576 | + | |
| 577 | + | |
| 578 | + | |
| 579 | + | |
| 580 | + | |
| 546 | 581 | static void do_p1(Monitor* mon) |
| 547 | 582 | { |
| 548 | 583 | do_set_gpio(mon, "C5", "0"); |
| 549 | 584 | } |
| 550 | 585 | |
| 586 | + | |
| 587 | + | |
| 551 | 588 | static void do_p2(Monitor* mon) |
| 552 | 589 | { |
| 553 | 590 | do_set_gpio(mon, "C4", "0"); |
| ... | ... | @@ -3240,13 +3277,15 @@ void monitor_init(CharDriverState *chr, int flags) |
| 3240 | 3277 | static int is_first_init = 1; |
| 3241 | 3278 | Monitor *mon; |
| 3242 | 3279 | |
| 3280 | + mon = qemu_mallocz(sizeof(*mon)); | |
| 3281 | + | |
| 3243 | 3282 | if (is_first_init) { |
| 3244 | 3283 | key_timer = qemu_new_timer(vm_clock, release_keys, NULL); |
| 3284 | + button_timer1 = qemu_new_timer(vm_clock, button_handler1, mon); | |
| 3285 | + button_timer2 = qemu_new_timer(vm_clock, button_handler2, mon); | |
| 3245 | 3286 | is_first_init = 0; |
| 3246 | 3287 | } |
| 3247 | 3288 | |
| 3248 | - mon = qemu_mallocz(sizeof(*mon)); | |
| 3249 | - | |
| 3250 | 3289 | mon->chr = chr; |
| 3251 | 3290 | mon->flags = flags; |
| 3252 | 3291 | if (mon->chr->focus != 0) | ... | ... |
qemu-monitor.hx
| ... | ... | @@ -683,6 +683,21 @@ STEXI |
| 683 | 683 | Release button 2 |
| 684 | 684 | ETEXI |
| 685 | 685 | |
| 686 | + { "b2", "", do_b2, "", | |
| 687 | + "button 2" }, | |
| 688 | +STEXI | |
| 689 | +@item b2 | |
| 690 | +Button 2 | |
| 691 | +ETEXI | |
| 692 | + | |
| 693 | + { "b1", "", do_b1, "", | |
| 694 | + "button 1" }, | |
| 695 | +STEXI | |
| 696 | +@item b1 | |
| 697 | +Button 1 | |
| 698 | +ETEXI | |
| 699 | + | |
| 700 | + | |
| 686 | 701 | |
| 687 | 702 | STEXI |
| 688 | 703 | @end table | ... | ... |
virtual_lab/Makefile
0 → 100644
| 1 | +# SW VirtualLab DMCS@2020 | |
| 2 | + | |
| 3 | +CCFLAGS=-g -mcpu=arm9 -Os -Wall | |
| 4 | +CC=arm-none-eabi-gcc | |
| 5 | +#LDFLAGS+=-nostartfiles -Wl,--cref -lc -lgcc -T /opt/arm_user/elf32-littlearm.lds -g -Ttext 0x20000000 -Tdata 0x300000 -n | |
| 6 | +LDFLAGS+=-nostartfiles -W -lc -lgcc -T script.lds -g -Ttext 0x20000000 -Tdata 0x300000 -n | |
| 7 | +OBJS=cstartup.o lowlevel.o | |
| 8 | +#koniec, dalej mozna dowolnie zmieniac | |
| 9 | + | |
| 10 | +PROGRAM_NAME=led_blink2.elf | |
| 11 | + | |
| 12 | +all: $(PROGRAM_NAME) | |
| 13 | + | |
| 14 | +rebuild: clean $(PROGRAM_NAME) | |
| 15 | + | |
| 16 | +$(PROGRAM_NAME): main.o | |
| 17 | + $(CC) $(LDFLAGS) $(OBJS) $< -o $@ | |
| 18 | + | |
| 19 | +main.o: main.c | |
| 20 | + $(CC) -c $(CCFLAGS) $< -o $@ | |
| 21 | + | |
| 22 | +clean: | |
| 23 | + rm -f *.o *.elf | ... | ... |
virtual_lab/compileme.sh
| 1 | 1 | arm-none-eabi-gcc -E -I include -D__ASSEMBLY__ cstartup.S > cstartup_pre.S |
| 2 | 2 | arm-none-eabi-gcc -g -mcpu=arm926ej-s -c cstartup_pre.S -o cstartup.o |
| 3 | +arm-none-eabi-gcc -g -mcpu=arm926ej-s -I include -c lowlevel.c -o lowlevel.o | |
| 3 | 4 | arm-none-eabi-gcc -g -mcpu=arm926ej-s -I include lowlevel.c main.c cstartup.o -o main.elf -Ttext 0x20000000 -Tdata 0x300000 -T script.lds |
| 4 | 5 | # -Wl,--verbose |
| 5 | 6 | ... | ... |
virtual_lab/cstartup_pre.S
0 → 100644
| 1 | +# 1 "cstartup.S" | |
| 2 | +# 1 "<built-in>" | |
| 3 | +# 1 "<command-line>" | |
| 4 | +# 1 "cstartup.S" | |
| 5 | +# 39 "cstartup.S" | |
| 6 | +# 1 "project.h" 1 | |
| 7 | +# 44 "project.h" | |
| 8 | +# 1 "include/AT91SAM9263-EK.h" 1 | |
| 9 | +# 45 "project.h" 2 | |
| 10 | +# 1 "include/AT91SAM9263.h" 1 | |
| 11 | +# 46 "project.h" 2 | |
| 12 | +# 40 "cstartup.S" 2 | |
| 13 | +# 55 "cstartup.S" | |
| 14 | + .globl reset_handler | |
| 15 | + .align 4 | |
| 16 | + | |
| 17 | +.section .vectors | |
| 18 | +.arm | |
| 19 | + | |
| 20 | + | |
| 21 | + | |
| 22 | +_exception_vectors: | |
| 23 | +reset_vector: | |
| 24 | + ldr pc, =reset_handler | |
| 25 | +undef_vector: | |
| 26 | + b undef_vector | |
| 27 | +swi_vector: | |
| 28 | + b swi_vector | |
| 29 | +pabt_vector: | |
| 30 | + ldr pc, =pabt_handler | |
| 31 | +dabt_vector: | |
| 32 | + ldr pc, =dabt_handler | |
| 33 | +rsvd_vector: | |
| 34 | + b rsvd_vector | |
| 35 | +irq_vector: | |
| 36 | + b irq_handler | |
| 37 | +fiq_vector: | |
| 38 | + | |
| 39 | + | |
| 40 | + | |
| 41 | + | |
| 42 | + | |
| 43 | +fiq_handler: | |
| 44 | + b fiq_handler | |
| 45 | + | |
| 46 | + | |
| 47 | + | |
| 48 | + | |
| 49 | + | |
| 50 | + | |
| 51 | +irq_handler: | |
| 52 | + | |
| 53 | + | |
| 54 | + sub lr, lr, #4 | |
| 55 | + stmfd sp!, {lr} | |
| 56 | + | |
| 57 | + mrs r14, SPSR | |
| 58 | + stmfd sp!, {r0,r14} | |
| 59 | + | |
| 60 | + | |
| 61 | + | |
| 62 | + | |
| 63 | + ldr r14, =( 0xFFFFF000) | |
| 64 | + ldr r0 , [r14, #( 0x00000100)] | |
| 65 | + str r14, [r14, #( 0x00000100)] | |
| 66 | + | |
| 67 | + | |
| 68 | + msr CPSR_c, #0x13 | |
| 69 | + | |
| 70 | + | |
| 71 | + stmfd sp!, {r1-r3, r12, r14} | |
| 72 | + | |
| 73 | + | |
| 74 | + mov r14, pc | |
| 75 | + bx r0 | |
| 76 | + | |
| 77 | + | |
| 78 | + ldmia sp!, {r1-r3, r12, r14} | |
| 79 | + | |
| 80 | + | |
| 81 | + msr CPSR_c, #0x12 | 0x80 | |
| 82 | + | |
| 83 | + | |
| 84 | + ldr r14, =( 0xFFFFF000) | |
| 85 | + str r14, [r14, #( 0x00000130)] | |
| 86 | + | |
| 87 | + | |
| 88 | + ldmia sp!, {r0,r14} | |
| 89 | + msr SPSR_cxsf, r14 | |
| 90 | + | |
| 91 | + | |
| 92 | + ldmia sp!, {pc}^ | |
| 93 | + | |
| 94 | + | |
| 95 | + | |
| 96 | + | |
| 97 | + | |
| 98 | + | |
| 99 | + | |
| 100 | +.section .text | |
| 101 | +reset_handler: | |
| 102 | + ldr pc, =_low_level_init | |
| 103 | + | |
| 104 | + | |
| 105 | + | |
| 106 | + | |
| 107 | + | |
| 108 | + | |
| 109 | +_low_level_init: | |
| 110 | + ldr r2, =_lp_ll_init | |
| 111 | + ldmia r2, {r0, r1} | |
| 112 | + mov sp, r1 | |
| 113 | + mov lr, pc | |
| 114 | + bx r0 | |
| 115 | + | |
| 116 | + | |
| 117 | + | |
| 118 | + | |
| 119 | +_stack_init: | |
| 120 | + ldr r2, =_lp_stack_init | |
| 121 | + ldmia r2, {r0, r1, r2} | |
| 122 | + | |
| 123 | + | |
| 124 | + msr CPSR_c, #0x17 | 0x80 | 0x40 | |
| 125 | + mov sp, r0 | |
| 126 | + sub r0, r0, r1 | |
| 127 | + | |
| 128 | + | |
| 129 | + msr CPSR_c, #0x12 | 0x80 | 0x40 | |
| 130 | + mov sp, r0 | |
| 131 | + sub r0, r0, r2 | |
| 132 | + | |
| 133 | + | |
| 134 | + msr CPSR_c, #0x13 | 0x40 | |
| 135 | + mov sp, r0 | |
| 136 | + | |
| 137 | + | |
| 138 | + | |
| 139 | + | |
| 140 | + | |
| 141 | +_init_data: | |
| 142 | + ldr r2, =_lp_data | |
| 143 | + ldmia r2, {r1, r3, r4} | |
| 144 | +1: | |
| 145 | + cmp r3, r4 | |
| 146 | + ldrcc r2, [r1], #4 | |
| 147 | + strcc r2, [r3], #4 | |
| 148 | + bcc 1b | |
| 149 | + | |
| 150 | + | |
| 151 | +_init_bss: | |
| 152 | + ldr r2, =_lp_bss | |
| 153 | + ldmia r2, {r3, r4} | |
| 154 | + mov r2, #0 | |
| 155 | +1: | |
| 156 | + cmp r3, r4 | |
| 157 | + strcc r2, [r3], #4 | |
| 158 | + bcc 1b | |
| 159 | + | |
| 160 | + | |
| 161 | + | |
| 162 | + | |
| 163 | +_branch_main: | |
| 164 | + ldr r0, =main | |
| 165 | + mov lr, pc | |
| 166 | + bx r0 | |
| 167 | + | |
| 168 | + | |
| 169 | + | |
| 170 | + | |
| 171 | +_lp_ll_init: | |
| 172 | + .word lowlevel_init | |
| 173 | + .word ((0x00300000) + (0x00014000)) | |
| 174 | + | |
| 175 | +_lp_stack_init: | |
| 176 | + .word ((0x00300000) + (0x00014000)) | |
| 177 | + .word 8*3*4 | |
| 178 | + .word 8*3*4 | |
| 179 | + | |
| 180 | +_lp_bss: | |
| 181 | + .word _sbss | |
| 182 | + .word _ebss | |
| 183 | + | |
| 184 | +_lp_data: | |
| 185 | + .word _etext | |
| 186 | + .word _sdata | |
| 187 | + .word _edata | ... | ... |
virtual_lab/led_blink2.elf
0 → 100755
No preview for this file type
virtual_lab/lowlevel.c
| 1 | -/* ---------------------------------------------------------------------------- | |
| 2 | - * ATMEL Microcontroller Software Support - ROUSSET - | |
| 3 | - * ---------------------------------------------------------------------------- | |
| 4 | - * Copyright (c) 2006, Atmel Corporation | |
| 5 | - * | |
| 6 | - * All rights reserved. | |
| 7 | - * | |
| 8 | - * Redistribution and use in source and binary forms, with or without | |
| 9 | - * modification, are permitted provided that the following conditions are met: | |
| 10 | - * | |
| 11 | - * - Redistributions of source code must retain the above copyright notice, | |
| 12 | - * this list of conditions and the disclaiimer below. | |
| 13 | - * | |
| 14 | - * - Redistributions in binary form must reproduce the above copyright notice, | |
| 15 | - * this list of conditions and the disclaimer below in the documentation and/or | |
| 16 | - * other materials provided with the distribution. | |
| 17 | - * | |
| 18 | - * Atmel's name may not be used to endorse or promote products derived from | |
| 19 | - * this software without specific prior written permission. | |
| 20 | - * | |
| 21 | - * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR | |
| 22 | - * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF | |
| 23 | - * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE | |
| 24 | - * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT, | |
| 25 | - * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT | |
| 26 | - * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, | |
| 27 | - * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF | |
| 28 | - * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING | |
| 29 | - * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, | |
| 30 | - * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. | |
| 31 | - * ---------------------------------------------------------------------------- | |
| 32 | - */ | |
| 33 | -/*----------------------------------------------------------------------------- | |
| 34 | - * File Name : lowlevel.c | |
| 35 | - * Object : low level initialization file | |
| 36 | - * Creation : FDy 20-Nov-2006 | |
| 37 | - *----------------------------------------------------------------------------- | |
| 38 | - */ | |
| 39 | - | |
| 40 | -/* Include Standard files */ | |
| 41 | -#include "project.h" | |
| 42 | - | |
| 43 | - | |
| 44 | -/*----------------------------------------------------------------------------- | |
| 45 | - * Function Name : default_spurious_handler | |
| 46 | - * Object : default handler for spurious interrupt | |
| 47 | - *-----------------------------------------------------------------------------*/ | |
| 48 | -void default_spurious_handler(void) | |
| 49 | -{ | |
| 50 | - dbgu_print_ascii("-F- Spurious Interrupt\n\r "); | |
| 51 | - while (1); | |
| 52 | -} | |
| 53 | - | |
| 54 | -/*----------------------------------------------------------------------------- | |
| 55 | - * Function Name : default_fiq_handler | |
| 56 | - * Object : default handler for fast interrupt | |
| 57 | - *-----------------------------------------------------------------------------*/ | |
| 58 | -void default_fiq_handler(void) | |
| 59 | -{ | |
| 60 | - dbgu_print_ascii("-F- Unexpected FIQ Interrupt\n\r "); | |
| 61 | - while (1); | |
| 62 | -} | |
| 63 | - | |
| 64 | -/*----------------------------------------------------------------------------- | |
| 65 | - * Function Name : default_irq_handler | |
| 66 | - * Object : default handler for irq | |
| 67 | - *-----------------------------------------------------------------------------*/ | |
| 68 | -void default_irq_handler(void) | |
| 69 | -{ | |
| 70 | - dbgu_print_ascii("-F- Unexpected IRQ Interrupt\n\r "); | |
| 71 | - while (1); | |
| 72 | -} | |
| 73 | - | |
| 74 | -/*----------------------------------------------------------------------------- | |
| 75 | - * Function Name : lowlevel_init | |
| 76 | - * Object : This function performs very low level HW initialization | |
| 77 | - * this function can use a Stack, depending the compilation | |
| 78 | - * optimization mode | |
| 79 | - *-----------------------------------------------------------------------------*/ | |
| 80 | -void lowlevel_init(void) | |
| 81 | -{ | |
| 82 | - unsigned char i = 0; | |
| 83 | - | |
| 84 | - /////////////////////////////////////////////////////////////////////////// | |
| 85 | - // Init PMC Step 1. Enable Main Oscillator | |
| 86 | - // Main Oscillator startup time is board specific: | |
| 87 | - // Main Oscillator Startup Time worst case (3MHz) corresponds to 15ms | |
| 88 | - // (0x40 for AT91C_CKGR_OSCOUNT field) | |
| 89 | - /////////////////////////////////////////////////////////////////////////// | |
| 90 | - AT91C_BASE_PMC->PMC_MOR = (((AT91C_CKGR_OSCOUNT & (0x40 << 8)) | AT91C_CKGR_MOSCEN)); | |
| 91 | - // Wait Main Oscillator stabilization | |
| 92 | - while (!(AT91C_BASE_PMC->PMC_SR & AT91C_PMC_MOSCS)); | |
| 93 | - | |
| 94 | - /////////////////////////////////////////////////////////////////////////// | |
| 95 | - // Init PMC Step 2. | |
| 96 | - // Set PLLA to 200MHz (198,656MHz) | |
| 97 | - // PLL Startup time depends on PLL RC filter: worst case is choosen | |
| 98 | - /////////////////////////////////////////////////////////////////////////// | |
| 99 | - AT91C_BASE_PMC->PMC_PLLAR = AT91C_CKGR_SRCA | | |
| 100 | - AT91C_CKGR_OUTA_2 | | |
| 101 | - (0x3F << 8) | | |
| 102 | - (AT91C_CKGR_MULA & (0x6D << 16)) | | |
| 103 | - (AT91C_CKGR_DIVA & 9); | |
| 104 | - // Wait for PLLA stabilization | |
| 105 | - while (!(AT91C_BASE_PMC->PMC_SR & AT91C_PMC_LOCKA)); | |
| 106 | - // Wait until the master clock is established for the case we already | |
| 107 | - // turn on the PLLA | |
| 108 | - while (!(AT91C_BASE_PMC->PMC_SR & AT91C_PMC_MCKRDY)); | |
| 109 | - | |
| 110 | - /////////////////////////////////////////////////////////////////////////// | |
| 111 | - // Init PMC Step 3. | |
| 112 | - // Selection of Master Clock MCK equal to (Processor Clock PCK) PLLA/2=100MHz | |
| 113 | - // The PMC_MCKR register must not be programmed in a single write operation | |
| 114 | - // (see. Product Errata Sheet) | |
| 115 | - /////////////////////////////////////////////////////////////////////////// | |
| 116 | - AT91C_BASE_PMC->PMC_MCKR = AT91C_PMC_PRES_CLK | AT91C_PMC_MDIV_2; | |
| 117 | - // Wait until the master clock is established | |
| 118 | - while (!(AT91C_BASE_PMC->PMC_SR & AT91C_PMC_MCKRDY)); | |
| 119 | - | |
| 120 | - AT91C_BASE_PMC->PMC_MCKR |= AT91C_PMC_CSS_PLLA_CLK; | |
| 121 | - // Wait until the master clock is established | |
| 122 | - while (!(AT91C_BASE_PMC->PMC_SR & AT91C_PMC_MCKRDY)); | |
| 123 | - | |
| 124 | - /////////////////////////////////////////////////////////////////////////// | |
| 125 | - // Reset AIC: assign default handler for each interrupt source | |
| 126 | - /////////////////////////////////////////////////////////////////////////// | |
| 127 | - AT91C_BASE_AIC->AIC_SVR[0] = (int) default_fiq_handler ; | |
| 128 | - for (i = 1; i < 31; i++) { | |
| 129 | - AT91C_BASE_AIC->AIC_SVR[i] = (int) default_irq_handler ; | |
| 130 | - } | |
| 131 | - AT91C_BASE_AIC->AIC_SPU = (unsigned int) default_spurious_handler; | |
| 132 | - | |
| 133 | - // Perform 8 IT acknoledge (write any value in EOICR) | |
| 134 | - for (i = 0; i < 8 ; i++) { | |
| 135 | - AT91C_BASE_AIC->AIC_EOICR = 0; | |
| 136 | - } | |
| 137 | - | |
| 138 | - /////////////////////////////////////////////////////////////////////////// | |
| 139 | - // Disable Watchdog | |
| 140 | - /////////////////////////////////////////////////////////////////////////// | |
| 141 | - AT91C_BASE_WDTC->WDTC_WDMR = AT91C_WDTC_WDDIS; | |
| 142 | - | |
| 143 | - /////////////////////////////////////////////////////////////////////////// | |
| 144 | - // Remap | |
| 145 | - /////////////////////////////////////////////////////////////////////////// | |
| 146 | - AT91C_BASE_MATRIX->MATRIX_MRCR = AT91C_MATRIX_RCA926I | AT91C_MATRIX_RCA926D; | |
| 147 | -} | |
| 1 | +/* ---------------------------------------------------------------------------- | |
| 2 | + * ATMEL Microcontroller Software Support - ROUSSET - | |
| 3 | + * ---------------------------------------------------------------------------- | |
| 4 | + * Copyright (c) 2006, Atmel Corporation | |
| 5 | + * | |
| 6 | + * All rights reserved. | |
| 7 | + * | |
| 8 | + * Redistribution and use in source and binary forms, with or without | |
| 9 | + * modification, are permitted provided that the following conditions are met: | |
| 10 | + * | |
| 11 | + * - Redistributions of source code must retain the above copyright notice, | |
| 12 | + * this list of conditions and the disclaiimer below. | |
| 13 | + * | |
| 14 | + * - Redistributions in binary form must reproduce the above copyright notice, | |
| 15 | + * this list of conditions and the disclaimer below in the documentation and/or | |
| 16 | + * other materials provided with the distribution. | |
| 17 | + * | |
| 18 | + * Atmel's name may not be used to endorse or promote products derived from | |
| 19 | + * this software without specific prior written permission. | |
| 20 | + * | |
| 21 | + * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR | |
| 22 | + * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF | |
| 23 | + * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE | |
| 24 | + * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT, | |
| 25 | + * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT | |
| 26 | + * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, | |
| 27 | + * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF | |
| 28 | + * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING | |
| 29 | + * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, | |
| 30 | + * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. | |
| 31 | + * ---------------------------------------------------------------------------- | |
| 32 | + */ | |
| 33 | +/*----------------------------------------------------------------------------- | |
| 34 | + * File Name : lowlevel.c | |
| 35 | + * Object : low level initialization file | |
| 36 | + * Creation : FDy 20-Nov-2006 | |
| 37 | + *----------------------------------------------------------------------------- | |
| 38 | + */ | |
| 148 | 39 | |
| 149 | -void _exit(int c){while(1);}; | |
| 40 | +/* Include Standard files */ | |
| 41 | +#include "project.h" | |
| 150 | 42 | |
| 151 | -void dabt_handler(){}; | |
| 152 | -void pabt_handler(){}; | |
| 153 | -void dbgu_print_ascii(const char* p){}; | |
| 154 | 43 | \ No newline at end of file |
| 44 | +void dbgu_print_ascii (const char * buffer) {}; | |
| 45 | +void dabt_handler (void) {}; | |
| 46 | +void pabt_handler (void) {}; | |
| 47 | +void _exit (int c) {while(1);}; | |
| 48 | + | |
| 49 | +/*----------------------------------------------------------------------------- | |
| 50 | + * Function Name : default_spurious_handler | |
| 51 | + * Object : default handler for spurious interrupt | |
| 52 | + *-----------------------------------------------------------------------------*/ | |
| 53 | +void default_spurious_handler(void) | |
| 54 | +{ | |
| 55 | + dbgu_print_ascii("-F- Spurious Interrupt\n\r "); | |
| 56 | + while (1); | |
| 57 | +} | |
| 58 | + | |
| 59 | +/*----------------------------------------------------------------------------- | |
| 60 | + * Function Name : default_fiq_handler | |
| 61 | + * Object : default handler for fast interrupt | |
| 62 | + *-----------------------------------------------------------------------------*/ | |
| 63 | +void default_fiq_handler(void) | |
| 64 | +{ | |
| 65 | + dbgu_print_ascii("-F- Unexpected FIQ Interrupt\n\r "); | |
| 66 | + while (1); | |
| 67 | +} | |
| 68 | + | |
| 69 | +/*----------------------------------------------------------------------------- | |
| 70 | + * Function Name : default_irq_handler | |
| 71 | + * Object : default handler for irq | |
| 72 | + *-----------------------------------------------------------------------------*/ | |
| 73 | +void default_irq_handler(void) | |
| 74 | +{ | |
| 75 | + dbgu_print_ascii("-F- Unexpected IRQ Interrupt\n\r "); | |
| 76 | + while (1); | |
| 77 | +} | |
| 78 | + | |
| 79 | +/*----------------------------------------------------------------------------- | |
| 80 | + * Function Name : lowlevel_init | |
| 81 | + * Object : This function performs very low level HW initialization | |
| 82 | + * this function can use a Stack, depending the compilation | |
| 83 | + * optimization mode | |
| 84 | + *-----------------------------------------------------------------------------*/ | |
| 85 | +void lowlevel_init(void) | |
| 86 | +{ | |
| 87 | + unsigned char i = 0; | |
| 88 | + | |
| 89 | + /////////////////////////////////////////////////////////////////////////// | |
| 90 | + // Init PMC Step 1. Enable Main Oscillator | |
| 91 | + // Main Oscillator startup time is board specific: | |
| 92 | + // Main Oscillator Startup Time worst case (3MHz) corresponds to 15ms | |
| 93 | + // (0x40 for AT91C_CKGR_OSCOUNT field) | |
| 94 | + /////////////////////////////////////////////////////////////////////////// | |
| 95 | + AT91C_BASE_PMC->PMC_MOR = (((AT91C_CKGR_OSCOUNT & (0x40 << 8)) | AT91C_CKGR_MOSCEN)); | |
| 96 | + // Wait Main Oscillator stabilization | |
| 97 | + while (!(AT91C_BASE_PMC->PMC_SR & AT91C_PMC_MOSCS)); | |
| 98 | + | |
| 99 | + /////////////////////////////////////////////////////////////////////////// | |
| 100 | + // Init PMC Step 2. | |
| 101 | + // Set PLLA to 200MHz (198,656MHz) | |
| 102 | + // PLL Startup time depends on PLL RC filter: worst case is choosen | |
| 103 | + /////////////////////////////////////////////////////////////////////////// | |
| 104 | + AT91C_BASE_PMC->PMC_PLLAR = AT91C_CKGR_SRCA | | |
| 105 | + AT91C_CKGR_OUTA_2 | | |
| 106 | + (0x3F << 8) | | |
| 107 | + (AT91C_CKGR_MULA & (0x6D << 16)) | | |
| 108 | + (AT91C_CKGR_DIVA & 9); | |
| 109 | + // Wait for PLLA stabilization | |
| 110 | + while (!(AT91C_BASE_PMC->PMC_SR & AT91C_PMC_LOCKA)); | |
| 111 | + // Wait until the master clock is established for the case we already | |
| 112 | + // turn on the PLLA | |
| 113 | + while (!(AT91C_BASE_PMC->PMC_SR & AT91C_PMC_MCKRDY)); | |
| 114 | + | |
| 115 | + /////////////////////////////////////////////////////////////////////////// | |
| 116 | + // Init PMC Step 3. | |
| 117 | + // Selection of Master Clock MCK equal to (Processor Clock PCK) PLLA/2=100MHz | |
| 118 | + // The PMC_MCKR register must not be programmed in a single write operation | |
| 119 | + // (see. Product Errata Sheet) | |
| 120 | + /////////////////////////////////////////////////////////////////////////// | |
| 121 | + AT91C_BASE_PMC->PMC_MCKR = AT91C_PMC_PRES_CLK | AT91C_PMC_MDIV_2; | |
| 122 | + // Wait until the master clock is established | |
| 123 | + while (!(AT91C_BASE_PMC->PMC_SR & AT91C_PMC_MCKRDY)); | |
| 124 | + | |
| 125 | + AT91C_BASE_PMC->PMC_MCKR |= AT91C_PMC_CSS_PLLA_CLK; | |
| 126 | + // Wait until the master clock is established | |
| 127 | + while (!(AT91C_BASE_PMC->PMC_SR & AT91C_PMC_MCKRDY)); | |
| 128 | + | |
| 129 | + /////////////////////////////////////////////////////////////////////////// | |
| 130 | + // Reset AIC: assign default handler for each interrupt source | |
| 131 | + /////////////////////////////////////////////////////////////////////////// | |
| 132 | + AT91C_BASE_AIC->AIC_SVR[0] = (int) default_fiq_handler ; | |
| 133 | + for (i = 1; i < 31; i++) { | |
| 134 | + AT91C_BASE_AIC->AIC_SVR[i] = (int) default_irq_handler ; | |
| 135 | + } | |
| 136 | + AT91C_BASE_AIC->AIC_SPU = (unsigned int) default_spurious_handler; | |
| 137 | + | |
| 138 | + // Perform 8 IT acknoledge (write any value in EOICR) | |
| 139 | + for (i = 0; i < 8 ; i++) { | |
| 140 | + AT91C_BASE_AIC->AIC_EOICR = 0; | |
| 141 | + } | |
| 142 | + | |
| 143 | + /////////////////////////////////////////////////////////////////////////// | |
| 144 | + // Disable Watchdog | |
| 145 | + /////////////////////////////////////////////////////////////////////////// | |
| 146 | + AT91C_BASE_WDTC->WDTC_WDMR = AT91C_WDTC_WDDIS; | |
| 147 | + | |
| 148 | + /////////////////////////////////////////////////////////////////////////// | |
| 149 | + // Remap | |
| 150 | + /////////////////////////////////////////////////////////////////////////// | |
| 151 | + AT91C_BASE_MATRIX->MATRIX_MRCR = AT91C_MATRIX_RCA926I | AT91C_MATRIX_RCA926D; | |
| 152 | +} | ... | ... |
virtual_lab/main.c
| 1 | 1 | #include <stdint.h> |
| 2 | 2 | #include <stdbool.h> |
| 3 | 3 | |
| 4 | -#define PA_PER (*((volatile uint32_t*)0xFFFFF200)) | |
| 5 | -#define PA_PDR (*((volatile uint32_t*)0xFFFFF204)) | |
| 6 | -#define PA_OER (*((volatile uint32_t*)0xFFFFF210)) | |
| 7 | -#define PA_SODR (*((volatile uint32_t*)0xFFFFF230)) | |
| 8 | -#define PA_CODR (*((volatile uint32_t*)0xFFFFF234)) | |
| 9 | -#define PA_PDSR (*((volatile uint32_t*)0xFFFFF23C)) | |
| 10 | - | |
| 11 | - | |
| 12 | 4 | #define PB_PER (*((volatile uint32_t*)0xFFFFF400)) |
| 13 | -#define PB_PDR (*((volatile uint32_t*)0xFFFFF404)) | |
| 14 | 5 | #define PB_OER (*((volatile uint32_t*)0xFFFFF410)) |
| 15 | 6 | #define PB_SODR (*((volatile uint32_t*)0xFFFFF430)) |
| 16 | 7 | #define PB_CODR (*((volatile uint32_t*)0xFFFFF434)) |
| ... | ... | @@ -26,7 +17,7 @@ |
| 26 | 17 | |
| 27 | 18 | #define PMC_PCER (*((volatile uint32_t*)0xFFFFFC10)) |
| 28 | 19 | |
| 29 | -#define PER_ID_PBIOC_TO_PIOE 4 | |
| 20 | +#define CLK_PIO_CDE 4 | |
| 30 | 21 | |
| 31 | 22 | #define DS1 (1 << 8) //PB8 |
| 32 | 23 | #define DS2 (1 << 29) //PC29 |
| ... | ... | @@ -34,15 +25,38 @@ |
| 34 | 25 | #define BT2 (1 << 4) //PC4 |
| 35 | 26 | #define BT1 (1 << 5) //PC5 |
| 36 | 27 | |
| 37 | -void delay(void) | |
| 28 | +void delay_ms (int delay) | |
| 29 | +{ | |
| 30 | + volatile uint64_t DelayStep; | |
| 31 | + for(DelayStep = 0; DelayStep < 100000*delay; DelayStep++); | |
| 32 | +} | |
| 33 | + | |
| 34 | +void ConfigureLEDs (void) | |
| 35 | +{ | |
| 36 | + PB_PER = DS1; | |
| 37 | + PC_PER = DS2; | |
| 38 | + PB_OER = DS1; | |
| 39 | + PC_OER = DS2; | |
| 40 | + PB_SODR = DS1; | |
| 41 | + PC_SODR = DS2; | |
| 42 | +} | |
| 43 | + | |
| 44 | + | |
| 45 | +void ConfigureButtons (void) | |
| 38 | 46 | { |
| 39 | - volatile uint64_t i; | |
| 40 | - for(i = 0; i < 100000000; i++); | |
| 47 | + PMC_PCER = 1 << CLK_PIO_CDE; | |
| 48 | + PC_PER = BT1 | BT2; | |
| 49 | + PC_ODR = BT1 | BT2; | |
| 50 | + PC_PUER = BT1 | BT2; | |
| 41 | 51 | } |
| 42 | 52 | |
| 43 | 53 | int main(void) |
| 44 | 54 | { |
| 45 | - PMC_PCER = 1 << PER_ID_PBIOC_TO_PIOE; | |
| 55 | + int Decimator=0; | |
| 56 | + ConfigureLEDs(); | |
| 57 | + ConfigureButtons(); | |
| 58 | +#if 0 | |
| 59 | + PMC_PCER = 1 << PER_ID_PBIOC_TO_PIOE; | |
| 46 | 60 | PB_PER = DS1; //PIO enable register |
| 47 | 61 | // PB_PDR = 0xffffffff; //PIO disable register |
| 48 | 62 | |
| ... | ... | @@ -51,16 +65,32 @@ int main(void) |
| 51 | 65 | PC_OER = DS2; //PIO controller output enable register |
| 52 | 66 | PC_ODR = BT1 | BT2; |
| 53 | 67 | PC_PUER = BT1 | BT2; |
| 54 | - while(true) | |
| 55 | - { | |
| 56 | -// delay(); | |
| 57 | - if(PC_PDSR & BT1) | |
| 58 | - PB_SODR = DS1; | |
| 59 | - else | |
| 60 | - PB_CODR = DS1; | |
| 61 | - if(PC_PDSR & BT2) | |
| 62 | - PC_SODR = DS2; | |
| 63 | - else | |
| 64 | - PC_CODR = DS2; | |
| 65 | - } | |
| 68 | +#endif | |
| 69 | + | |
| 70 | + while(true) | |
| 71 | + { | |
| 72 | + for (Decimator=0; Decimator<100; Decimator++) | |
| 73 | + { | |
| 74 | + if((PC_PDSR & BT1) == 0) | |
| 75 | + PB_SODR = DS1; | |
| 76 | + | |
| 77 | + if((PC_PDSR & BT2) == 0) | |
| 78 | + PB_CODR = DS1; | |
| 79 | + delay_ms(10); | |
| 80 | + } | |
| 81 | + | |
| 82 | + PC_CODR = DS2; | |
| 83 | + | |
| 84 | + for (Decimator=0; Decimator<100; Decimator++) | |
| 85 | + { | |
| 86 | + if((PC_PDSR & BT1) == 0) | |
| 87 | + PB_SODR = DS1; | |
| 88 | + | |
| 89 | + if((PC_PDSR & BT2) == 0) | |
| 90 | + PB_CODR = DS1; | |
| 91 | + delay_ms(10); | |
| 92 | + } | |
| 93 | + | |
| 94 | + PC_SODR = DS2; | |
| 95 | + } | |
| 66 | 96 | } | ... | ... |
virtual_lab/main.elf
0 → 100755
No preview for this file type