git.sur5r.net Git - freertos/blob - Source/portable/GCC/ColdFire_V2/portasm.S

   1 /*\r
   2         FreeRTOS.org V5.0.4 - Copyright (C) 2003-2008 Richard Barry.\r
   3 \r
   4         This file is part of the FreeRTOS.org distribution.\r
   5 \r
   6         FreeRTOS.org is free software; you can redistribute it and/or modify\r
   7         it under the terms of the GNU General Public License as published by\r
   8         the Free Software Foundation; either version 2 of the License, or\r
   9         (at your option) any later version.\r
  10 \r
  11         FreeRTOS.org is distributed in the hope that it will be useful,\r
  12         but WITHOUT ANY WARRANTY; without even the implied warranty of\r
  13         MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the\r
  14         GNU General Public License for more details.\r
  15 \r
  16         You should have received a copy of the GNU General Public License\r
  17         along with FreeRTOS.org; if not, write to the Free Software\r
  18         Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA\r
  19 \r
  20         A special exception to the GPL can be applied should you wish to distribute\r
  21         a combined work that includes FreeRTOS.org, without being obliged to provide\r
  22         the source code for any proprietary components.  See the licensing section\r
  23         of http://www.FreeRTOS.org for full details of how and when the exception\r
  24         can be applied.\r
  25 \r
  26     ***************************************************************************\r
  27     ***************************************************************************\r
  28     *                                                                         *\r
  29     * SAVE TIME AND MONEY!  We can port FreeRTOS.org to your own hardware,    *\r
  30     * and even write all or part of your application on your behalf.          *\r
  31     * See http://www.OpenRTOS.com for details of the services we provide to   *\r
  32     * expedite your project.                                                  *\r
  33     *                                                                         *\r
  34     ***************************************************************************\r
  35     ***************************************************************************\r
  36 \r
  37         Please ensure to read the configuration and relevant port sections of the\r
  38         online documentation.\r
  39 \r
  40         http://www.FreeRTOS.org - Documentation, latest information, license and\r
  41         contact details.\r
  42 \r
  43         http://www.SafeRTOS.com - A version that is certified for use in safety\r
  44         critical systems.\r
  45 \r
  46         http://www.OpenRTOS.com - Commercial support, development, porting,\r
  47         licensing and training services.\r
  48 */\r
  49 \r
  50 /*\r
  51  * Purpose: Lowest level routines for all ColdFire processors.\r
  52  *\r
  53  * Notes:\r
  54  * \r
  55  * ulPortSetIPL() and mcf5xxx_wr_cacr() copied with permission from FreeScale\r
  56  * supplied source files.\r
  57  */\r
  58 \r
  59     .global ulPortSetIPL\r
  60     .global mcf5xxx_wr_cacr\r
  61     .global __cs3_isr_interrupt_80\r
  62     .global vPortStartFirstTask\r
  63 \r
  64     .text\r
  65 \r
  66 .macro portSAVE_CONTEXT\r
  67 \r
  68         lea.l           (-60, %sp), %sp\r
  69         movem.l         %d0-%fp, (%sp)\r
  70         move.l          pxCurrentTCB, %a0\r
  71         move.l          %sp, (%a0)\r
  72 \r
  73         .endm\r
  74 \r
  75 .macro portRESTORE_CONTEXT\r
  76 \r
  77         move.l          pxCurrentTCB, %a0\r
  78         move.l          (%a0), %sp\r
  79         movem.l         (%sp), %d0-%fp\r
  80         lea.l           %sp@(60), %sp\r
  81         rte\r
  82 \r
  83         .endm\r
  84 \r
  85 /********************************************************************/\r
  86 /*\r
  87  * This routines changes the IPL to the value passed into the routine.\r
  88  * It also returns the old IPL value back.\r
  89  * Calling convention from C:\r
  90  *   old_ipl = asm_set_ipl(new_ipl);\r
  91  * For the Diab Data C compiler, it passes return value thru D0.\r
  92  * Note that only the least significant three bits of the passed\r
  93  * value are used.\r
  94  */\r
  95 \r
  96 ulPortSetIPL:\r
  97     link    A6,#-8\r
  98     movem.l D6-D7,(SP)\r
  99 \r
 100     move.w  SR,D7       /* current sr    */\r
 101 \r
 102     move.l  D7,D0       /* prepare return value  */\r
 103     andi.l  #0x0700,D0  /* mask out IPL  */\r
 104     lsr.l   #8,D0       /* IPL   */\r
 105 \r
 106     move.l  8(A6),D6    /* get argument  */\r
 107     andi.l  #0x07,D6    /* least significant three bits  */\r
 108     lsl.l   #8,D6       /* move over to make mask    */\r
 109 \r
 110     andi.l  #0x0000F8FF,D7  /* zero out current IPL  */\r
 111     or.l    D6,D7           /* place new IPL in sr   */\r
 112     move.w  D7,SR\r
 113 \r
 114     movem.l (SP),D6-D7\r
 115     lea     8(SP),SP\r
 116     unlk    A6\r
 117     rts\r
 118 /********************************************************************/\r
 119 \r
 120 mcf5xxx_wr_cacr:\r
 121     move.l  4(sp),d0\r
 122     .long   0x4e7b0002  /* movec d0,cacr   */\r
 123     nop\r
 124     rts\r
 125 \r
 126 /********************************************************************/\r
 127 \r
 128 /* Yield interrupt. */\r
 129 __cs3_isr_interrupt_80:\r
 130         portSAVE_CONTEXT\r
 131         jsr vPortYieldHandler\r
 132         portRESTORE_CONTEXT\r
 133 \r
 134 /********************************************************************/\r
 135 \r
 136 \r
 137 vPortStartFirstTask:\r
 138         portRESTORE_CONTEXT\r
 139 \r
 140     .end\r
 141 \r
 142 \r