diff options
author | patacongo <patacongo@42af7a65-404d-4744-a932-0658087f49c3> | 2011-06-08 23:30:39 +0000 |
---|---|---|
committer | patacongo <patacongo@42af7a65-404d-4744-a932-0658087f49c3> | 2011-06-08 23:30:39 +0000 |
commit | 19b8bf8f79b7f678e2d2c473bf07ecb1add9fb42 (patch) | |
tree | 243a21828280bdd27b32f5252f5a19e4eecc5249 /nuttx/arch/avr/src/at90usb/at90usb_head.S | |
parent | fe2959c7e6d314cc44cf5472d20b8ac6d5806b51 (diff) | |
download | px4-nuttx-19b8bf8f79b7f678e2d2c473bf07ecb1add9fb42.tar.gz px4-nuttx-19b8bf8f79b7f678e2d2c473bf07ecb1add9fb42.tar.bz2 px4-nuttx-19b8bf8f79b7f678e2d2c473bf07ecb1add9fb42.zip |
This finishes ALL AVR assembly language
git-svn-id: svn://svn.code.sf.net/p/nuttx/code/trunk@3685 42af7a65-404d-4744-a932-0658087f49c3
Diffstat (limited to 'nuttx/arch/avr/src/at90usb/at90usb_head.S')
-rwxr-xr-x | nuttx/arch/avr/src/at90usb/at90usb_head.S | 554 |
1 files changed, 277 insertions, 277 deletions
diff --git a/nuttx/arch/avr/src/at90usb/at90usb_head.S b/nuttx/arch/avr/src/at90usb/at90usb_head.S index 608595f90..a9ec75700 100755 --- a/nuttx/arch/avr/src/at90usb/at90usb_head.S +++ b/nuttx/arch/avr/src/at90usb/at90usb_head.S @@ -1,277 +1,277 @@ -/****************************************************************************
- * arch/avr32/src/at90usb/at90usb_head.S
- *
- * Copyright (C) 2011 Gregory Nutt. All rights reserved.
- * Author: Gregory Nutt <spudmonkey@racsa.co.cr>
- *
- * Redistribution and use in source and binary forms, with or without
- * modification, are permitted provided that the following conditions
- * are met:
- *
- * 1. Redistributions of source code must retain the above copyright
- * notice, this list of conditions and the following disclaimer.
- * 2. Redistributions in binary form must reproduce the above copyright
- * notice, this list of conditions and the following disclaimer in
- * the documentation and/or other materials provided with the
- * distribution.
- * 3. Neither the name NuttX nor the names of its contributors may be
- * used to endorse or promote products derived from this software
- * without specific prior written permission.
- *
- * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
- * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
- * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
- * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
- * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
- * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
- * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
- * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
- * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
- * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
- * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
- * POSSIBILITY OF SUCH DAMAGE.
- *
- ****************************************************************************/
-
-/****************************************************************************
- * Included Files
- ****************************************************************************/
-
-#include <nuttx/config.h>
-
-#include <avr/io.h>
-#include <avr/sfr_defs.h>
-
-/****************************************************************************
- * Pre-processor definitions
- ****************************************************************************/
-
-/* Stack is allocated just after .bss and before the heap */
-
-#define STACKBASE (_ebss+CONFIG_IDLETHREAD_STACKSIZE-1)
-
-/* The RAMPZ register is only available for CPUs with more than 64Kb of FLASH.
- * Only the AT90USB646, 647, 1286, and 1287 are supported by this file.
- *
- * - Support for the EPLMX instructions is assumed if RAMPZ is present
- * - If RAMPZ is not present, support for LPMX is assumed
- */
-
-#if defined(CONFIG_ARCH_CHIP_AT90USB1286) || defined(CONFIG_ARCH_CHIP_AT90USB1286)
-# define HAVE_RAMPZ 1
-#endif
-
-/****************************************************************************
- * External Symbols
- ****************************************************************************/
-
- .file "up_nommuhead.S"
- .global __start /* Entry point */
- .global _sbss /* Start of .bss. Defined by ld.script */
- .global _ebss /* End of .bss. Defined by ld.script */
- .global _sdata /* Start of .data section in RAM */
- .global _edata /* End of .data section in RAM */
- .global _eronly /* Start of .data section in FLASH */
- .global up_lowinit /* Perform low level initialization */
- .global os_start /* NuttX entry point */
-
- .global vectortab
- .global at90usb_int0 /* External interrupt request 0 */
- .global at90usb_int1 /* External interrupt request 1 */
- .global at90usb_int2 /* External interrupt request 2 */
- .global at90usb_int3 /* External interrupt request 3 */
- .global at90usb_int4 /* External interrupt request 4 */
- .global at90usb_int5 /* External interrupt request 5 */
- .global at90usb_int6 /* External interrupt request 6 */
- .global at90usb_int7 /* External interrupt request 7 */
- .global at90usb_pcint0 /* Pin Change Interrupt Request 0 */
- .global at90usb_usbgen /* USB General USB General Interrupt request */
- .global at90usb_usbep /* USB Endpoint/Pipe USB ENdpoint/Pipe Interrupt request */
- .global at90usb_wdt /* Watchdog Time-out Interrupt */
- .global at90usb_t2compa /* TIMER2 COMPA Timer/Counter2 Compare Match A */
- .global at90usb_t2compb /* TIMER2 COMPB Timer/Counter2 Compare Match B */
- .global at90usb_t2ovf /* TIMER2 OVF Timer/Counter2 Overflow */
- .global at90usb_t1capt /* TIMER1 CAPT Timer/Counter1 Capture Event */
- .global at90usb_t1compa /* TIMER1 COMPA Timer/Counter1 Compare Match A */
- .global at90usb_t1compb /* TIMER1 COMPB Timer/Counter1 Compare Match B */
- .global at90usb_t1compc /* TIMER1 COMPC Timer/Counter1 Compare Match c */
- .global at90usb_t1ovf /* TIMER1 OVF Timer/Counter1 Overflow */
- .global at90usb_t0compa /* TIMER0 COMPA Timer/Counter0 Compare Match A */
- .global at90usb_t0compb /* TIMER0 COMPB Timer/Counter0 Compare Match B */
- .global at90usb_t0ovf /* TIMER0 OVF Timer/Counter0 Overflow */
- .global at90usb_spi /* STC SPI Serial Transfer Complete */
- .global at90usb_u1rx /* USART1 Rx Complete */
- .global at90usb_u1dre /* USART1 Data Register Empty */
- .global at90usb_u1tx /* USART1 Tx Complete */
- .global at90usb_anacomp /* ANALOG COMP Analog Comparator */
- .global at90usb_adc /* ADC Conversion Complete */
- .global at90usb_ee /* EEPROM Ready */
- .global at90usb_t3capt /* TIMER3 CAPT Timer/Counter3 Capture Event */
- .global at90usb_t3compa /* TIMER3 COMPA Timer/Counter3 Compare Match A */
- .global at90usb_t3compb /* TIMER3 COMPB Timer/Counter3 Compare Match B */
- .global at90usb_t3compc /* TIMER3 COMPC Timer/Counter3 Compare Match C */
- .global at90usb_t3ovf /* TIMER3 OVF Timer/Counter3 Overflow */
- .global at90usb_twi /* TWI Two-wire Serial Interface */
- .global at90usb_spmrdy /* Store Program Memory Ready */
-
-/****************************************************************************
- * Macros
- ****************************************************************************/
-
- .macro vector name
- jmp \name
- .endm
-
-/****************************************************************************
- * Vector Table
- ****************************************************************************/
-
-/* The AT90USB has 38 interrupt vectors including vector 0, the reset
- * vector.
- */
-
- .section .vectors, "ax", @progbits
- .func vectortab
-vectortab:
- jmp __start /* 0: Vector 0 is the reset vector */
- vector at90usb_int0 /* 1: External interrupt request 0 */
- vector at90usb_int1 /* 2: External interrupt request 1 */
- vector at90usb_int2 /* 3: External interrupt request 2 */
- vector at90usb_int3 /* 4: External interrupt request 3 */
- vector at90usb_int4 /* 5: External interrupt request 4 */
- vector at90usb_int5 /* 6: External interrupt request 5 */
- vector at90usb_int6 /* 7: External interrupt request 6 */
- vector at90usb_int7 /* 8: External interrupt request 7 */
- vector at90usb_pcint0 /* 9: PCINT0 Pin Change Interrupt Request 0 */
- vector at90usb_usbgen /* 10: USB General USB General Interrupt request */
- vector at90usb_usbep /* 11: USB Endpoint/Pipe USB ENdpoint/Pipe Interrupt request */
- vector at90usb_wdt /* 12: Watchdog Time-out Interrupt */
- vector at90usb_t2compa /* 13: TIMER2 COMPA Timer/Counter2 Compare Match A */
- vector at90usb_t2compb /* 14: TIMER2 COMPB Timer/Counter2 Compare Match B */
- vector at90usb_t2ovf /* 15: TIMER2 OVF Timer/Counter2 Overflow */
- vector at90usb_t1capt /* 16: TIMER1 CAPT Timer/Counter1 Capture Event */
- vector at90usb_t1compa /* 17: TIMER1 COMPA Timer/Counter1 Compare Match A */
- vector at90usb_t1compb /* 18: TIMER1 COMPB Timer/Counter1 Compare Match B */
- vector at90usb_t1compc /* 19: TIMER1 COMPC Timer/Counter1 Compare Match c */
- vector at90usb_t1ovf /* 20: TIMER1 OVF Timer/Counter1 Overflow */
- vector at90usb_t0compa /* 21: TIMER0 COMPA Timer/Counter0 Compare Match A */
- vector at90usb_t0compb /* 22: TIMER0 COMPB Timer/Counter0 Compare Match B */
- vector at90usb_t0ovf /* 23: TIMER0 OVF Timer/Counter0 Overflow */
- vector at90usb_spi /* 24: STC SPI Serial Transfer Complete */
- vector at90usb_u1rx /* 25: USART1 Rx Complete */
- vector at90usb_u1dre /* 26: USART1 Data Register Empty */
- vector at90usb_u1tx /* 27: USART1 Tx Complete */
- vector at90usb_anacomp /* 28: ANALOG COMP Analog Comparator */
- vector at90usb_adc /* 29: ADC Conversion Complete */
- vector at90usb_ee /* 30: EEPROM Ready */
- vector at90usb_t3capt /* 31: TIMER3 CAPT Timer/Counter3 Capture Event */
- vector at90usb_t3compa /* 32: TIMER3 COMPA Timer/Counter3 Compare Match A */
- vector at90usb_t3compb /* 33: TIMER3 COMPB Timer/Counter3 Compare Match B */
- vector at90usb_t3compc /* 34: TIMER3 COMPC Timer/Counter3 Compare Match C */
- vector at90usb_t3ovf /* 35: TIMER3 OVF Timer/Counter3 Overflow */
- vector at90usb_twi /* 36: TWI Two-wire Serial Interface */
- vector at90usb_spmrdy /* 37: Store Program Memory Ready */
- .endfunc
-
-/****************************************************************************
- * Reset Entry Point
- ****************************************************************************/
-
- .section .init, "ax", @progbits
- .func __start
-__start:
-
- /* Clear the zero register, clear the status register and initialize the
- * IDLE thread stack
- */
-
- clr r1
- out _SFR_IO_ADDR(SREG), r1
- ldi r28, lo8(STACKBASE)
- ldi r29, hi8(STACKBASE)
- out _SFR_IO_ADDR(SPH), r29
- out _SFR_IO_ADDR(SPL), r28
-
- /* Copy initial global data values from FLASH into RAM */
-
- .global __do_copy_data; /* Required to suppress dragging in logic from libgcc */
-__do_copy_data:
-
-#ifdef HAVE_RAMPZ
- ldi r17, hi8(_edata)
- ldi r26, lo8(_sdata)
- ldi r27, hi8(_sdata)
- ldi r30, lo8(_eronly)
- ldi r31, hi8(_eronly)
- ldi r16, hh8(_eronly)
- out _SFR_IO_ADDR(RAMPZ), r16
- rjmp .Lcopystart
-
-.Lcopyloop:
- elpm r0, Z+
- st X+, r0
-
-.Lcopystart:
- cpi r26, lo8(_edata)
- cpc r27, r17
- brne .Lcopyloop
-#else
- ldi r17, hi8(_edata)
- ldi r26, lo8(_sdata)
- ldi r27, hi8(_sdata)
- ldi r30, lo8(_eronly)
- ldi r31, hi8(_eronly)
- rjmp .Lcopystart
-
-.Lcopyloop:
- lpm r0, Z+
- st X+, r0
-.Lcopystart:
- cpi r26, lo8(_edata)
- cpc r27, r17
- brne .Lcopyloop
-#endif
-
- /* Clear uninitialized data */
-
- .global __do_clear_bss; /* Required to suppress dragging in logic from libgcc */
-__do_clear_bss:
-
- ldi r17, hi8(_ebss)
- ldi r26, lo8(_sbss)
- ldi r27, hi8(_sbss)
- rjmp .Lclearstart
-
-.Lclearloop:
- st X+, r1
-.Lclearstart:
- cpi r26, lo8(_ebss)
- cpc r27, r17
- brne .Lclearloop
-
- /* Perform any low-level initialization */
-
- call up_lowinit
-
- /* Now start NuttX */
-
- call os_start
- jmp exit
- .endfunc
-
-/****************************************************************************
- * Heap Base
- ****************************************************************************/
-
- /* This global variable is unsigned long g_heapbase and is
- * exported from here only because of its coupling to other
- * uses of _ebss in this file
- */
-
- .data
- .globl g_heapbase
- .type g_heapbase, object
-g_heapbase:
- .word _ebss+CONFIG_IDLETHREAD_STACKSIZE
- .size g_heapbase, .-g_heapbase
- .end
+/**************************************************************************** + * arch/avr32/src/at90usb/at90usb_head.S + * + * Copyright (C) 2011 Gregory Nutt. All rights reserved. + * Author: Gregory Nutt <spudmonkey@racsa.co.cr> + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in + * the documentation and/or other materials provided with the + * distribution. + * 3. Neither the name NuttX nor the names of its contributors may be + * used to endorse or promote products derived from this software + * without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS + * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT + * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS + * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE + * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, + * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, + * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS + * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED + * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN + * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE + * POSSIBILITY OF SUCH DAMAGE. + * + ****************************************************************************/ + +/**************************************************************************** + * Included Files + ****************************************************************************/ + +#include <nuttx/config.h> + +#include <avr/io.h> +#include <avr/sfr_defs.h> + +/**************************************************************************** + * Pre-processor definitions + ****************************************************************************/ + +/* Stack is allocated just after .bss and before the heap */ + +#define STACKBASE (_ebss+CONFIG_IDLETHREAD_STACKSIZE-1) + +/* The RAMPZ register is only available for CPUs with more than 64Kb of FLASH. + * Only the AT90USB646, 647, 1286, and 1287 are supported by this file. + * + * - Support for the EPLMX instructions is assumed if RAMPZ is present + * - If RAMPZ is not present, support for LPMX is assumed + */ + +#if defined(CONFIG_ARCH_CHIP_AT90USB1286) || defined(CONFIG_ARCH_CHIP_AT90USB1286) +# define HAVE_RAMPZ 1 +#endif + +/**************************************************************************** + * External Symbols + ****************************************************************************/ + + .file "up_nommuhead.S" + .global __start /* Entry point */ + .global _sbss /* Start of .bss. Defined by ld.script */ + .global _ebss /* End of .bss. Defined by ld.script */ + .global _sdata /* Start of .data section in RAM */ + .global _edata /* End of .data section in RAM */ + .global _eronly /* Start of .data section in FLASH */ + .global up_lowinit /* Perform low level initialization */ + .global os_start /* NuttX entry point */ + + .global vectortab + .global at90usb_int0 /* External interrupt request 0 */ + .global at90usb_int1 /* External interrupt request 1 */ + .global at90usb_int2 /* External interrupt request 2 */ + .global at90usb_int3 /* External interrupt request 3 */ + .global at90usb_int4 /* External interrupt request 4 */ + .global at90usb_int5 /* External interrupt request 5 */ + .global at90usb_int6 /* External interrupt request 6 */ + .global at90usb_int7 /* External interrupt request 7 */ + .global at90usb_pcint0 /* Pin Change Interrupt Request 0 */ + .global at90usb_usbgen /* USB General USB General Interrupt request */ + .global at90usb_usbep /* USB Endpoint/Pipe USB ENdpoint/Pipe Interrupt request */ + .global at90usb_wdt /* Watchdog Time-out Interrupt */ + .global at90usb_t2compa /* TIMER2 COMPA Timer/Counter2 Compare Match A */ + .global at90usb_t2compb /* TIMER2 COMPB Timer/Counter2 Compare Match B */ + .global at90usb_t2ovf /* TIMER2 OVF Timer/Counter2 Overflow */ + .global at90usb_t1capt /* TIMER1 CAPT Timer/Counter1 Capture Event */ + .global at90usb_t1compa /* TIMER1 COMPA Timer/Counter1 Compare Match A */ + .global at90usb_t1compb /* TIMER1 COMPB Timer/Counter1 Compare Match B */ + .global at90usb_t1compc /* TIMER1 COMPC Timer/Counter1 Compare Match c */ + .global at90usb_t1ovf /* TIMER1 OVF Timer/Counter1 Overflow */ + .global at90usb_t0compa /* TIMER0 COMPA Timer/Counter0 Compare Match A */ + .global at90usb_t0compb /* TIMER0 COMPB Timer/Counter0 Compare Match B */ + .global at90usb_t0ovf /* TIMER0 OVF Timer/Counter0 Overflow */ + .global at90usb_spi /* STC SPI Serial Transfer Complete */ + .global at90usb_u1rx /* USART1 Rx Complete */ + .global at90usb_u1dre /* USART1 Data Register Empty */ + .global at90usb_u1tx /* USART1 Tx Complete */ + .global at90usb_anacomp /* ANALOG COMP Analog Comparator */ + .global at90usb_adc /* ADC Conversion Complete */ + .global at90usb_ee /* EEPROM Ready */ + .global at90usb_t3capt /* TIMER3 CAPT Timer/Counter3 Capture Event */ + .global at90usb_t3compa /* TIMER3 COMPA Timer/Counter3 Compare Match A */ + .global at90usb_t3compb /* TIMER3 COMPB Timer/Counter3 Compare Match B */ + .global at90usb_t3compc /* TIMER3 COMPC Timer/Counter3 Compare Match C */ + .global at90usb_t3ovf /* TIMER3 OVF Timer/Counter3 Overflow */ + .global at90usb_twi /* TWI Two-wire Serial Interface */ + .global at90usb_spmrdy /* Store Program Memory Ready */ + +/**************************************************************************** + * Macros + ****************************************************************************/ + + .macro vector name + jmp \name + .endm + +/**************************************************************************** + * Vector Table + ****************************************************************************/ + +/* The AT90USB has 38 interrupt vectors including vector 0, the reset + * vector. + */ + + .section .vectors, "ax", @progbits + .func vectortab +vectortab: + jmp __start /* 0: Vector 0 is the reset vector */ + vector at90usb_int0 /* 1: External interrupt request 0 */ + vector at90usb_int1 /* 2: External interrupt request 1 */ + vector at90usb_int2 /* 3: External interrupt request 2 */ + vector at90usb_int3 /* 4: External interrupt request 3 */ + vector at90usb_int4 /* 5: External interrupt request 4 */ + vector at90usb_int5 /* 6: External interrupt request 5 */ + vector at90usb_int6 /* 7: External interrupt request 6 */ + vector at90usb_int7 /* 8: External interrupt request 7 */ + vector at90usb_pcint0 /* 9: PCINT0 Pin Change Interrupt Request 0 */ + vector at90usb_usbgen /* 10: USB General USB General Interrupt request */ + vector at90usb_usbep /* 11: USB Endpoint/Pipe USB ENdpoint/Pipe Interrupt request */ + vector at90usb_wdt /* 12: Watchdog Time-out Interrupt */ + vector at90usb_t2compa /* 13: TIMER2 COMPA Timer/Counter2 Compare Match A */ + vector at90usb_t2compb /* 14: TIMER2 COMPB Timer/Counter2 Compare Match B */ + vector at90usb_t2ovf /* 15: TIMER2 OVF Timer/Counter2 Overflow */ + vector at90usb_t1capt /* 16: TIMER1 CAPT Timer/Counter1 Capture Event */ + vector at90usb_t1compa /* 17: TIMER1 COMPA Timer/Counter1 Compare Match A */ + vector at90usb_t1compb /* 18: TIMER1 COMPB Timer/Counter1 Compare Match B */ + vector at90usb_t1compc /* 19: TIMER1 COMPC Timer/Counter1 Compare Match c */ + vector at90usb_t1ovf /* 20: TIMER1 OVF Timer/Counter1 Overflow */ + vector at90usb_t0compa /* 21: TIMER0 COMPA Timer/Counter0 Compare Match A */ + vector at90usb_t0compb /* 22: TIMER0 COMPB Timer/Counter0 Compare Match B */ + vector at90usb_t0ovf /* 23: TIMER0 OVF Timer/Counter0 Overflow */ + vector at90usb_spi /* 24: STC SPI Serial Transfer Complete */ + vector at90usb_u1rx /* 25: USART1 Rx Complete */ + vector at90usb_u1dre /* 26: USART1 Data Register Empty */ + vector at90usb_u1tx /* 27: USART1 Tx Complete */ + vector at90usb_anacomp /* 28: ANALOG COMP Analog Comparator */ + vector at90usb_adc /* 29: ADC Conversion Complete */ + vector at90usb_ee /* 30: EEPROM Ready */ + vector at90usb_t3capt /* 31: TIMER3 CAPT Timer/Counter3 Capture Event */ + vector at90usb_t3compa /* 32: TIMER3 COMPA Timer/Counter3 Compare Match A */ + vector at90usb_t3compb /* 33: TIMER3 COMPB Timer/Counter3 Compare Match B */ + vector at90usb_t3compc /* 34: TIMER3 COMPC Timer/Counter3 Compare Match C */ + vector at90usb_t3ovf /* 35: TIMER3 OVF Timer/Counter3 Overflow */ + vector at90usb_twi /* 36: TWI Two-wire Serial Interface */ + vector at90usb_spmrdy /* 37: Store Program Memory Ready */ + .endfunc + +/**************************************************************************** + * Reset Entry Point + ****************************************************************************/ + + .section .init, "ax", @progbits + .func __start +__start: + + /* Clear the zero register, clear the status register and initialize the + * IDLE thread stack + */ + + clr r1 + out _SFR_IO_ADDR(SREG), r1 + ldi r28, lo8(STACKBASE) + ldi r29, hi8(STACKBASE) + out _SFR_IO_ADDR(SPH), r29 + out _SFR_IO_ADDR(SPL), r28 + + /* Copy initial global data values from FLASH into RAM */ + + .global __do_copy_data; /* Required to suppress dragging in logic from libgcc */ +__do_copy_data: + +#ifdef HAVE_RAMPZ + ldi r17, hi8(_edata) + ldi r26, lo8(_sdata) + ldi r27, hi8(_sdata) + ldi r30, lo8(_eronly) + ldi r31, hi8(_eronly) + ldi r16, hh8(_eronly) + out _SFR_IO_ADDR(RAMPZ), r16 + rjmp .Lcopystart + +.Lcopyloop: + elpm r0, Z+ + st X+, r0 + +.Lcopystart: + cpi r26, lo8(_edata) + cpc r27, r17 + brne .Lcopyloop +#else + ldi r17, hi8(_edata) + ldi r26, lo8(_sdata) + ldi r27, hi8(_sdata) + ldi r30, lo8(_eronly) + ldi r31, hi8(_eronly) + rjmp .Lcopystart + +.Lcopyloop: + lpm r0, Z+ + st X+, r0 +.Lcopystart: + cpi r26, lo8(_edata) + cpc r27, r17 + brne .Lcopyloop +#endif + + /* Clear uninitialized data */ + + .global __do_clear_bss; /* Required to suppress dragging in logic from libgcc */ +__do_clear_bss: + + ldi r17, hi8(_ebss) + ldi r26, lo8(_sbss) + ldi r27, hi8(_sbss) + rjmp .Lclearstart + +.Lclearloop: + st X+, r1 +.Lclearstart: + cpi r26, lo8(_ebss) + cpc r27, r17 + brne .Lclearloop + + /* Perform any low-level initialization */ + + call up_lowinit + + /* Now start NuttX */ + + call os_start + jmp exit + .endfunc + +/**************************************************************************** + * Heap Base + ****************************************************************************/ + + /* This global variable is unsigned long g_heapbase and is + * exported from here only because of its coupling to other + * uses of _ebss in this file + */ + + .data + .globl g_heapbase + .type g_heapbase, object +g_heapbase: + .word _ebss+CONFIG_IDLETHREAD_STACKSIZE + .size g_heapbase, .-g_heapbase + .end |