OpenEdv-开源电子网

 找回密码
 立即注册
正点原子全套STM32/Linux/FPGA开发资料,上千讲STM32视频教程免费下载...
查看: 1373|回复: 1

把freertos内存管理heap4改为多内存管理

[复制链接]

49

主题

340

帖子

0

精华

论坛元老

Rank: 8Rank: 8

积分
5246
金钱
5246
注册时间
2012-8-25
在线时间
1024 小时
发表于 2020-5-11 16:52:04 | 显示全部楼层 |阅读模式
本帖最后由 gotofly21 于 2020-5-11 16:57 编辑

stm32h7里面内存分块太多了,而且每块用途有区别.用heap5吧不能分配指定内存.于是乎,我就把heap4改为多块内存管理,并且可以再指定或者禁止块来分配内存,
测试有限,不敢保证没问题,内存数组定义是iar格式
头文件 heap_4_5.h
  1. #define configUSE_MALLOC_FAILED_HOOK 1

  2. #define  MEM_DTCM          0x01
  3. #define  MEM_ARAM           0x02
  4. #define  MEM_ARAM_DMA   0x04
  5. #define  MEM_RAM1          0x08
  6. #define  MEM_RAM2          0x10
  7. #define  MEM_RAM3         0x20
  8. #define  MEM_RAM4         0x40
  9. #define  MEM_SDRAM      0x80
  10. #define  MEM_NOMER      (0xff-(MEM_ARAM_DMA|MEM_RAM3))
  11. #define  MEM_ALL        0xff
  12. #define  MEM_NO_NOMER   (MEM_ARAM_DMA|MEM_RAM3)
  13.    
  14. #define configTOTAL_HEAP_SIZE_DTCM      ((size_t)20*1024)   //128K
  15. #define configTOTAL_HEAP_SIZE_ARAM      ((size_t)400*1024)  //496k
  16. #define configTOTAL_HEAP_SIZE_ARAM_DMA  ((size_t)15*1024)    //16k  
  17. #define configTOTAL_HEAP_SIZE_RAM1      ((size_t)128*1024)   //128k
  18. #define configTOTAL_HEAP_SIZE_RAM2      ((size_t)128*1024)   //128k
  19. #define configTOTAL_HEAP_SIZE_RAM3      ((size_t)5*1024)   //32k eth
  20. #define configTOTAL_HEAP_SIZE_RAM4      ((size_t)64*1024)   //64k
  21. #define configTOTAL_HEAP_SIZE_SDRAM     ((size_t)16*1024*1024 - 128) //16M
  22. #define configTOTAL_HEAP_SIZE           configTOTAL_HEAP_SIZE_DTCM      

  23. #define  MEM_BLOCKS  8  




  24. void *pvPortMalloc( size_t xSize ) PRIVILEGED_FUNCTION;
  25. void vPortFree( void *pv ) PRIVILEGED_FUNCTION;
  26. void vPortInitialiseBlocks( void ) PRIVILEGED_FUNCTION;
  27. size_t xPortGetFreeHeapSize( void ) PRIVILEGED_FUNCTION;
  28. size_t xPortGetMinimumEverFreeHeapSize( void ) PRIVILEGED_FUNCTION;

  29. void *pvPortMalloc_DMA( size_t xWantedSize ) PRIVILEGED_FUNCTION;
  30. void *pvPortMalloc_eth( size_t xWantedSize ) PRIVILEGED_FUNCTION;
  31. void *pvPortMalloc_temp( size_t xWantedSize ) PRIVILEGED_FUNCTION;
  32. void *pvPortMalloc_nomer( size_t xWantedSize ) PRIVILEGED_FUNCTION;
  33. void *pvPortMalloc_block( size_t xSize,uint8_t block_Fist,uint8_t block_forbid) PRIVILEGED_FUNCTION;
  34. void *pvPortMalloc_block_fixd( size_t xSize,uint8_t block) PRIVILEGED_FUNCTION;
  35. size_t xPortGetFreeHeapSize_block( uint8_t block ) PRIVILEGED_FUNCTION;
  36. size_t xPortGetMinimumEverFreeHeapSize_block( uint8_t block ) PRIVILEGED_FUNCTION;
复制代码

c文件 heap_4_5.c
  1. /*
  2. * FreeRTOS Kernel V10.2.1
  3. * Copyright (C) 2019 Amazon.com, Inc. or its affiliates.  All Rights Reserved.
  4. *
  5. * Permission is hereby granted, free of charge, to any person obtaining a copy of
  6. * this software and associated documentation files (the "Software"), to deal in
  7. * the Software without restriction, including without limitation the rights to
  8. * use, copy, modify, merge, publish, distribute, sublicense, and/or sell copies of
  9. * the Software, and to permit persons to whom the Software is furnished to do so,
  10. * subject to the following conditions:
  11. *
  12. * The above copyright notice and this permission notice shall be included in all
  13. * copies or substantial portions of the Software.
  14. *
  15. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  16. * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS
  17. * FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR
  18. * COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER
  19. * IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
  20. * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
  21. *
  22. * http://www.FreeRTOS.org
  23. * http://aws.amazon.com/freertos
  24. *
  25. * 1 tab == 4 spaces!
  26. */

  27. /*
  28. * A sample implementation of pvPortMalloc() and vPortFree() that combines
  29. * (coalescences) adjacent memory blocks as they are freed, and in so doing
  30. * limits memory fragmentation.
  31. *
  32. * See heap_1.c, heap_2.c and heap_3.c for alternative implementations, and the
  33. * memory management pages of http://www.FreeRTOS.org for more information.
  34. */
  35. #include <stdlib.h>
  36. #include <string.h>
  37. /* Defining MPU_WRAPPERS_INCLUDED_FROM_API_FILE prevents task.h from redefining
  38. all the API functions to use the MPU wrappers.  That should only be done when
  39. task.h is included from an application file. */
  40. #define MPU_WRAPPERS_INCLUDED_FROM_API_FILE

  41. #include "FreeRTOS.h"
  42. #include "task.h"
  43. #include "heap_4_5.h"


  44. #undef MPU_WRAPPERS_INCLUDED_FROM_API_FILE

  45. #if( configSUPPORT_DYNAMIC_ALLOCATION == 0 )
  46.         #error This file must not be used if configSUPPORT_DYNAMIC_ALLOCATION is 0
  47. #endif

  48. /* Block sizes must not get too small. */
  49. #define heapMINIMUM_BLOCK_SIZE        ( ( size_t ) ( xHeapStructSize << 1 ) )

  50. /* Assumes 8bit bytes! */
  51. #define heapBITS_PER_BYTE                ( ( size_t ) 8 )

  52. /* Allocate the memory for the heap. */
  53. #if( configAPPLICATION_ALLOCATED_HEAP == 1 )
  54.         /* The application writer has already defined the array used for the RTOS
  55.         heap - probably so it can be placed in a special segment or address. */
  56.         //extern uint8_t ucHeap[ configTOTAL_HEAP_SIZE ];
  57. #else
  58.         //static uint8_t ucHeap[ configTOTAL_HEAP_SIZE ];
  59. #endif /* configAPPLICATION_ALLOCATED_HEAP */

  60. /* Define the linked list structure.  This is used to link free blocks in order
  61. of their memory address. */
  62.         
  63.         
  64.         
  65.         
  66.         
  67. typedef struct A_BLOCK_LINK
  68. {
  69.         struct A_BLOCK_LINK *pxNextFreeBlock;        /*<< The next free block in the list. */
  70.         size_t xBlockSize;                                                /*<< The size of the free block. */
  71. } BlockLink_t;




  72. //#pragma location=".ram3"  
  73. static uint8_t ucHeap_DTCM     [ configTOTAL_HEAP_SIZE_DTCM      ];

  74. #pragma location=".aixram"  
  75. static uint8_t ucHeap_ARAM     [ configTOTAL_HEAP_SIZE_ARAM      ];

  76. #pragma location=".aixram_dma"
  77. static uint8_t ucHeap_ARAM_DMA [ configTOTAL_HEAP_SIZE_ARAM_DMA  ];

  78. #pragma location=".ram1"
  79. static uint8_t ucHeap_RAM1     [ configTOTAL_HEAP_SIZE_RAM1      ];

  80. #pragma location=".ram2"
  81. static uint8_t ucHeap_RAM2     [ configTOTAL_HEAP_SIZE_RAM2      ];

  82. #pragma location=".ram3"
  83. static uint8_t ucHeap_RAM3     [ configTOTAL_HEAP_SIZE_RAM3      ];

  84. #pragma location=".ram4"
  85. static uint8_t ucHeap_RAM4     [ configTOTAL_HEAP_SIZE_RAM4      ];

  86. #pragma location=".sdram"
  87. __no_init static uint8_t ucHeap_SDRAM    [ configTOTAL_HEAP_SIZE_SDRAM     ];








  88. typedef struct
  89. {
  90.   uint8_t *addr_start;
  91.   size_t  Msize;
  92.   uint8_t  mem_type;
  93.   uint8_t  baoliu[3];
  94. }Mem_block_t;


  95. Mem_block_t const Mem_block_s[]=
  96. {
  97.   {ucHeap_DTCM,configTOTAL_HEAP_SIZE_DTCM,MEM_DTCM,0,0,0},
  98.   {ucHeap_ARAM,configTOTAL_HEAP_SIZE_ARAM,MEM_ARAM,0,0,0},
  99.   {ucHeap_ARAM_DMA,configTOTAL_HEAP_SIZE_ARAM_DMA,MEM_ARAM_DMA,0,0,0},
  100.   {ucHeap_RAM1,configTOTAL_HEAP_SIZE_RAM1,MEM_RAM1,0,0,0},
  101.   {ucHeap_RAM2,configTOTAL_HEAP_SIZE_RAM2,MEM_RAM2,0,0,0},
  102.   {ucHeap_RAM3,configTOTAL_HEAP_SIZE_RAM3,MEM_RAM3,0,0,0},
  103.   {ucHeap_RAM4,configTOTAL_HEAP_SIZE_RAM4,MEM_RAM4,0,0,0},
  104.   {ucHeap_SDRAM,configTOTAL_HEAP_SIZE_SDRAM,MEM_SDRAM,0,0,0},
  105. };





  106. typedef struct
  107. {
  108. const Mem_block_t *Mem_block_p;
  109. BlockLink_t xStart, *pxEnd ;
  110. size_t xFreeBytesRemaining;
  111. size_t xMinimumEverFreeBytesRemaining;
  112. size_t xBlockAllocatedBit;
  113. }MemPool_t;

  114. MemPool_t  MemPool_s[MEM_BLOCKS];


  115. /*-----------------------------------------------------------*/

  116. /*
  117. * Inserts a block of memory that is being freed into the correct position in
  118. * the list of free memory blocks.  The block being freed will be merged with
  119. * the block in front it and/or the block behind it if the memory blocks are
  120. * adjacent to each other.
  121. */
  122. static void prvInsertBlockIntoFreeList( BlockLink_t *pxBlockToInsert ,MemPool_t *MemPool_p);

  123. /*
  124. * Called automatically to setup the required heap structures the first time
  125. * pvPortMalloc() is called.
  126. */
  127. static void prvHeapInit_block( uint8_t block_N );
  128. //static void prvHeapInit( void );

  129. /*-----------------------------------------------------------*/

  130. /* The size of the structure placed at the beginning of each allocated memory
  131. block must by correctly byte aligned. */
  132. static const size_t xHeapStructSize        = ( sizeof( BlockLink_t ) + ( ( size_t ) ( portBYTE_ALIGNMENT - 1 ) ) ) & ~( ( size_t ) portBYTE_ALIGNMENT_MASK );

  133. /* Create a couple of list links to mark the start and end of the list. */
  134. //static BlockLink_t xStart, *pxEnd = NULL;

  135. /* Keeps track of the number of free bytes remaining, but says nothing about
  136. fragmentation. */
  137. //static size_t xFreeBytesRemaining = 0U;
  138. //static size_t xMinimumEverFreeBytesRemaining = 0U;

  139. /* Gets set to the top bit of an size_t type.  When this bit in the xBlockSize
  140. member of an BlockLink_t structure is set then the block belongs to the
  141. application.  When the bit is free the block is still part of the free heap
  142. space. */
  143. //static size_t xBlockAllocatedBit = 0;

  144. /*
  145. typedef enum
  146. {
  147. MEM_DTCM=0x01,
  148. MEM_ARAM=0x02,
  149. MEM_ARAM_DMA=0x04,
  150. MEM_RAM1=0x08,
  151. MEM_RAM2=0x10,
  152. MEM_RAM3=0x20,
  153. MEM_RAM4=0x40,
  154. MEM_SDRAM=0x80,
  155. MEM_NOMER=0xff-(MEM_ARAM_DMA|MEM_RAM3),
  156. MEM_ALL=0xff
  157. } MEM_ENEMT;
  158. */
  159. /*
  160. configTOTAL_HEAP_SIZE_DTCM     
  161. configTOTAL_HEAP_SIZE_ARAM     
  162. configTOTAL_HEAP_SIZE_ARAM_DMA
  163. configTOTAL_HEAP_SIZE_RAM1     
  164. configTOTAL_HEAP_SIZE_RAM2     
  165. configTOTAL_HEAP_SIZE_RAM3     
  166. configTOTAL_HEAP_SIZE_RAM4     
  167. configTOTAL_HEAP_SIZE_SDRAM   
  168. */




  169. static int mem_init_f=0;

  170. /*-----------------------------------------------------------*/

  171. int mem_block_get(uint8_t mem_type)
  172. {
  173.   int block_n=-1;
  174.   switch(mem_type   )
  175.   {
  176.   case MEM_DTCM :     block_n=0;break;
  177.   case MEM_ARAM:      block_n=1;break;
  178.   case MEM_ARAM_DMA:  block_n=2;break;
  179.   case MEM_RAM1:      block_n=3;break;
  180.   case MEM_RAM2:      block_n=4;break;
  181.   case MEM_RAM3:      block_n=5;break;
  182.   case MEM_RAM4:      block_n=6;break;
  183.   case MEM_SDRAM:     block_n=7;break;
  184.   }
  185.   
  186.   return block_n;
  187. }



  188. static void *pvPortMalloc_block_dwx( size_t xWantedSize, MemPool_t *MemPool_p)
  189. {
  190. BlockLink_t *pxBlock, *pxPreviousBlock, *pxNewBlockLink;
  191. void *pvReturn = NULL;

  192.         vTaskSuspendAll();
  193.         {
  194.                 /* If this is the first call to malloc then the heap will require
  195.                 initialisation to setup the list of free blocks. */
  196.                 if(mem_init_f==0)
  197.                 {
  198.                   uint8_t block;
  199.                   for( block=0;block< MEM_BLOCKS-1;  block++)      //sdram 后面 初始化         
  200.                   {
  201.                     prvHeapInit_block(block);
  202.                   }
  203.                   mem_init_f=1;
  204.                 }
  205.          
  206.                 if(MemPool_p->pxEnd == NULL )
  207.                 {
  208.                   xWantedSize=0;
  209.                 //        prvHeapInit(MemPool_p);
  210.                 }
  211.                 else
  212.                 {
  213.                         mtCOVERAGE_TEST_MARKER();
  214.                 }

  215.                 /* Check the requested block size is not so large that the top bit is
  216.                 set.  The top bit of the block size member of the BlockLink_t structure
  217.                 is used to determine who owns the block - the application or the
  218.                 kernel, so it must be free. */
  219.                 if( ( xWantedSize & MemPool_p->xBlockAllocatedBit ) == 0 )
  220.                 {
  221.                         /* The wanted size is increased so it can contain a BlockLink_t
  222.                         structure in addition to the requested amount of bytes. */
  223.                         if( xWantedSize > 0 )
  224.                         {
  225.                                 xWantedSize += xHeapStructSize;

  226.                                 /* Ensure that blocks are always aligned to the required number
  227.                                 of bytes. */
  228.                                 if( ( xWantedSize & portBYTE_ALIGNMENT_MASK ) != 0x00 )
  229.                                 {
  230.                                         /* Byte alignment required. */
  231.                                         xWantedSize += ( portBYTE_ALIGNMENT - ( xWantedSize & portBYTE_ALIGNMENT_MASK ) );
  232.                                         configASSERT( ( xWantedSize & portBYTE_ALIGNMENT_MASK ) == 0 );
  233.                                 }
  234.                                 else
  235.                                 {
  236.                                         mtCOVERAGE_TEST_MARKER();
  237.                                 }
  238.                         }
  239.                         else
  240.                         {
  241.                                 mtCOVERAGE_TEST_MARKER();
  242.                         }

  243.                         if( ( xWantedSize > 0 ) && ( xWantedSize <= MemPool_p->xFreeBytesRemaining ) )
  244.                         {
  245.                                 /* Traverse the list from the start        (lowest address) block until
  246.                                 one        of adequate size is found. */
  247.                                 pxPreviousBlock = &MemPool_p->xStart;
  248.                                 pxBlock = MemPool_p->xStart.pxNextFreeBlock;
  249.                                 while( ( pxBlock->xBlockSize < xWantedSize ) && ( pxBlock->pxNextFreeBlock != NULL ) )
  250.                                 {
  251.                                         pxPreviousBlock = pxBlock;
  252.                                         pxBlock = pxBlock->pxNextFreeBlock;
  253.                                 }

  254.                                 /* If the end marker was reached then a block of adequate size
  255.                                 was        not found. */
  256.                                 if( pxBlock != MemPool_p->pxEnd )
  257.                                 {
  258.                                         /* Return the memory space pointed to - jumping over the
  259.                                         BlockLink_t structure at its start. */
  260.                                         pvReturn = ( void * ) ( ( ( uint8_t * ) pxPreviousBlock->pxNextFreeBlock ) + xHeapStructSize );

  261.                                         /* This block is being returned for use so must be taken out
  262.                                         of the list of free blocks. */
  263.                                         pxPreviousBlock->pxNextFreeBlock = pxBlock->pxNextFreeBlock;

  264.                                         /* If the block is larger than required it can be split into
  265.                                         two. */
  266.                                         if( ( pxBlock->xBlockSize - xWantedSize ) > heapMINIMUM_BLOCK_SIZE )
  267.                                         {
  268.                                                 /* This block is to be split into two.  Create a new
  269.                                                 block following the number of bytes requested. The void
  270.                                                 cast is used to prevent byte alignment warnings from the
  271.                                                 compiler. */
  272.                                                 pxNewBlockLink = ( void * ) ( ( ( uint8_t * ) pxBlock ) + xWantedSize );
  273.                                                 configASSERT( ( ( ( size_t ) pxNewBlockLink ) & portBYTE_ALIGNMENT_MASK ) == 0 );

  274.                                                 /* Calculate the sizes of two blocks split from the
  275.                                                 single block. */
  276.                                                 pxNewBlockLink->xBlockSize = pxBlock->xBlockSize - xWantedSize;
  277.                                                 pxBlock->xBlockSize = xWantedSize;

  278.                                                 /* Insert the new block into the list of free blocks. */
  279.                                                 prvInsertBlockIntoFreeList( pxNewBlockLink ,MemPool_p);
  280.                                         }
  281.                                         else
  282.                                         {
  283.                                                 mtCOVERAGE_TEST_MARKER();
  284.                                         }

  285.                                         MemPool_p->xFreeBytesRemaining -= pxBlock->xBlockSize;

  286.                                         if( MemPool_p->xFreeBytesRemaining < MemPool_p->xMinimumEverFreeBytesRemaining )
  287.                                         {
  288.                                                 MemPool_p->xMinimumEverFreeBytesRemaining = MemPool_p->xFreeBytesRemaining;
  289.                                         }
  290.                                         else
  291.                                         {
  292.                                                 mtCOVERAGE_TEST_MARKER();
  293.                                         }

  294.                                         /* The block is being returned - it is allocated and owned
  295.                                         by the application and has no "next" block. */
  296.                                         pxBlock->xBlockSize |= MemPool_p->xBlockAllocatedBit;
  297.                                         pxBlock->pxNextFreeBlock = NULL;
  298.                                 }
  299.                                 else
  300.                                 {
  301.                                         mtCOVERAGE_TEST_MARKER();
  302.                                 }
  303.                         }
  304.                         else
  305.                         {
  306.                                 mtCOVERAGE_TEST_MARKER();
  307.                         }
  308.                 }
  309.                 else
  310.                 {
  311.                         mtCOVERAGE_TEST_MARKER();
  312.                 }

  313.                 traceMALLOC( pvReturn, xWantedSize );
  314.         }
  315.         ( void ) xTaskResumeAll();



  316.         configASSERT( ( ( ( size_t ) pvReturn ) & ( size_t ) portBYTE_ALIGNMENT_MASK ) == 0 );
  317.         return pvReturn;
  318. }


  319. void *pvPortMalloc_block( size_t xSize,uint8_t block_Fist,uint8_t block_forbid)
  320. {
  321.   
  322.   uint8_t N=0x01;
  323.    void *pvReturn = NULL;
  324.   // MemPool_t *MemPool_p
  325.   for(N=0x01;N!=0;N<<=1) // fist
  326.   {
  327.     if((N & MEM_ALL)     ==  0) continue;
  328.     if((N & block_Fist)  ==  0 ) continue;
  329.     if((N & block_forbid)     ) continue;
  330.     pvReturn = pvPortMalloc_block_dwx(xSize,MemPool_s+ mem_block_get( N)) ;
  331.     if(pvReturn != NULL)
  332.     {
  333.       return pvReturn;
  334.     }
  335.   }
  336.   
  337.     for(N=0x01;N!=0;N<<=1) // fist 没成功
  338.   {
  339.     if((N & MEM_ALL )      ==  0) continue;
  340.     if((N & block_Fist )       ) continue;
  341.     if((N &  block_forbid)     ) continue;
  342.     pvReturn = pvPortMalloc_block_dwx(xSize,MemPool_s+ mem_block_get( N)) ;
  343.     if(pvReturn != NULL)
  344.     {
  345.       return pvReturn;
  346.     }
  347.   }
  348.   
  349.   
  350.           #if( configUSE_MALLOC_FAILED_HOOK == 1 )
  351.         {
  352.                 if( pvReturn == NULL )
  353.                 {
  354.                         extern void vApplicationMallocFailedHook( void );
  355.                         vApplicationMallocFailedHook();
  356.                 }
  357.                 else
  358.                 {
  359.                         mtCOVERAGE_TEST_MARKER();
  360.                 }
  361.         }
  362.         #endif
  363.   
  364.   return pvReturn;

  365. }
  366. void *pvPortMalloc_block_fixd( size_t xSize,uint8_t block)
  367. {
  368.   return pvPortMalloc_block( xSize, block, MEM_ALL-block);
  369. }
  370. void *pvPortMalloc( size_t xWantedSize )
  371. {
  372.   return pvPortMalloc_block( xWantedSize, MEM_NOMER, MEM_NO_NOMER);
  373. }
  374. void *pvPortMalloc_nomer( size_t xWantedSize )
  375. {
  376.   return pvPortMalloc_block( xWantedSize, (MEM_NOMER&(MEM_ALL -MEM_DTCM )), MEM_NO_NOMER);
  377. }

  378. void *pvPortMalloc_DMA( size_t xWantedSize )
  379. {
  380.   return pvPortMalloc_block( xWantedSize, MEM_ARAM_DMA, MEM_ALL-MEM_ARAM_DMA);
  381. }

  382. void *pvPortMalloc_eth( size_t xWantedSize )
  383. {
  384.   return pvPortMalloc_block( xWantedSize, MEM_RAM3, MEM_ALL-MEM_RAM3);
  385. }
  386. void *pvPortMalloc_temp( size_t xWantedSize )
  387. {
  388.   return pvPortMalloc_block( xWantedSize, MEM_RAM2, MEM_NO_NOMER|MEM_DTCM);
  389. }

  390. /*-----------------------------------------------------------*/
  391. static void vPortFree_block( void *pv ,MemPool_t *MemPool_p )
  392. {
  393.   
  394. uint8_t *puc = ( uint8_t * ) pv;
  395. BlockLink_t *pxLink;

  396.         if( pv != NULL )
  397.         {
  398.                 /* The memory being freed will have an BlockLink_t structure immediately
  399.                 before it. */
  400.                 puc -= xHeapStructSize;

  401.                 /* This casting is to keep the compiler from issuing warnings. */
  402.                 pxLink = ( void * ) puc;

  403.                 /* Check the block is actually allocated. */
  404.                 configASSERT( ( pxLink->xBlockSize & MemPool_p->xBlockAllocatedBit ) != 0 );
  405.                 configASSERT( pxLink->pxNextFreeBlock == NULL );

  406.                 if( ( pxLink->xBlockSize & MemPool_p->xBlockAllocatedBit ) != 0 )
  407.                 {
  408.                         if( pxLink->pxNextFreeBlock == NULL )
  409.                         {
  410.                                 /* The block is being returned to the heap - it is no longer
  411.                                 allocated. */
  412.                                 pxLink->xBlockSize &= ~MemPool_p->xBlockAllocatedBit;

  413.                                 vTaskSuspendAll();
  414.                                 {
  415.                                         /* Add this block to the list of free blocks. */
  416.                                         MemPool_p->xFreeBytesRemaining += pxLink->xBlockSize;
  417.                                         traceFREE( pv, pxLink->xBlockSize );
  418.                                         prvInsertBlockIntoFreeList( ( ( BlockLink_t * ) pxLink ),MemPool_p  );
  419.                                 }
  420.                                 ( void ) xTaskResumeAll();
  421.                         }
  422.                         else
  423.                         {
  424.                                 mtCOVERAGE_TEST_MARKER();
  425.                         }
  426.                 }
  427.                 else
  428.                 {
  429.                         mtCOVERAGE_TEST_MARKER();
  430.                 }
  431.         }

  432.   
  433. }
  434. void vPortFree( void *pv )
  435. {
  436.   MemPool_t *MemPool_p = MemPool_s;
  437.   int blockN;
  438.   for(blockN=0;blockN<MEM_BLOCKS;blockN++,MemPool_p++)
  439.   {
  440.     if( ( (size_t) pv>= (size_t)MemPool_p->Mem_block_p->addr_start )
  441.       &&(  (size_t) pv < (size_t)MemPool_p->Mem_block_p->addr_start + MemPool_p->Mem_block_p-> Msize))
  442.     {
  443.      vPortFree_block(pv,MemPool_p ) ;
  444.      break;
  445.     }
  446.    
  447.   }

  448. }
  449. /*-----------------------------------------------------------*/

  450. size_t xPortGetFreeHeapSize_block(   uint8_t block )
  451. {
  452.     int block_N = mem_block_get(block);
  453.     if(block_N<0) return 0;
  454.       MemPool_t *MemPool_p = MemPool_s+ block_N;
  455.         return MemPool_p->xFreeBytesRemaining;
  456. }
  457. /*-----------------------------------------------------------*/

  458. size_t xPortGetMinimumEverFreeHeapSize_block( uint8_t block )
  459. {
  460.       int block_N = mem_block_get(block);
  461.     if(block_N<0) return 0;
  462.     MemPool_t *MemPool_p = MemPool_s+ block_N;
  463.         return MemPool_p->xMinimumEverFreeBytesRemaining;
  464. }
  465. /*-----------------------------------------------------------*/

  466. size_t xPortGetFreeHeapSize( void )
  467. {
  468.   size_t  size_r=0;
  469.   uint8_t  block_N ;
  470.   for(block_N=0x01;block_N!=0;block_N<<=1)
  471.   {
  472.     size_r += xPortGetFreeHeapSize_block(block_N);
  473.   }
  474.   return size_r;
  475.   
  476. }
  477. size_t xPortGetMinimumEverFreeHeapSize( void )
  478. {
  479.   size_t  size_r=0;
  480.   uint8_t  block_N ;
  481.   for(block_N=0x01;block_N!=0;block_N<<=1)
  482.   {
  483.     size_r += xPortGetMinimumEverFreeHeapSize_block(block_N);
  484.   }
  485.   return size_r;
  486.   
  487. }

  488. void vPortInitialiseBlocks( void )
  489. {
  490.   prvHeapInit_block(7);//sdram,sdram初始化完成后启用这个,要不然就飞了
  491.         /* This just exists to keep the linker quiet. */
  492. }
  493. /*-----------------------------------------------------------*/

  494. static void prvHeapInit_block( uint8_t block_N )
  495. {
  496.   MemPool_t *MemPool_p = MemPool_s+ block_N;
  497.   memset(MemPool_p,0,sizeof(MemPool_t));
  498.   MemPool_p->Mem_block_p = Mem_block_s+block_N;
  499.   
  500. BlockLink_t *pxFirstFreeBlock;
  501. uint8_t *pucAlignedHeap;
  502. size_t uxAddress;
  503. size_t xTotalHeapSize =MemPool_p->Mem_block_p->Msize;// configTOTAL_HEAP_SIZE;

  504.         /* Ensure the heap starts on a correctly aligned boundary. */
  505.         uxAddress = ( size_t )MemPool_p->Mem_block_p->addr_start;//  ( size_t ) ucHeap;

  506.         if( ( uxAddress & portBYTE_ALIGNMENT_MASK ) != 0 )
  507.         {
  508.                 uxAddress += ( portBYTE_ALIGNMENT - 1 );
  509.                 uxAddress &= ~( ( size_t ) portBYTE_ALIGNMENT_MASK );
  510.                 xTotalHeapSize -= uxAddress - ( size_t ) MemPool_p->Mem_block_p->addr_start;
  511.         }

  512.         pucAlignedHeap = ( uint8_t * ) uxAddress;

  513.         /* xStart is used to hold a pointer to the first item in the list of free
  514.         blocks.  The void cast is used to prevent compiler warnings. */
  515.         MemPool_p->xStart.pxNextFreeBlock = ( void * ) pucAlignedHeap;
  516.         MemPool_p->xStart.xBlockSize = ( size_t ) 0;

  517.         /* pxEnd is used to mark the end of the list of free blocks and is inserted
  518.         at the end of the heap space. */
  519.         uxAddress = ( ( size_t ) pucAlignedHeap ) + xTotalHeapSize;
  520.         uxAddress -= xHeapStructSize;
  521.         uxAddress &= ~( ( size_t ) portBYTE_ALIGNMENT_MASK );
  522.         MemPool_p->pxEnd = ( void * ) uxAddress;
  523.         MemPool_p->pxEnd->xBlockSize = 0;
  524.         MemPool_p->pxEnd->pxNextFreeBlock = NULL;

  525.         /* To start with there is a single free block that is sized to take up the
  526.         entire heap space, minus the space taken by pxEnd. */
  527.         pxFirstFreeBlock = ( void * ) pucAlignedHeap;
  528.         pxFirstFreeBlock->xBlockSize = uxAddress - ( size_t ) pxFirstFreeBlock;
  529.         pxFirstFreeBlock->pxNextFreeBlock = MemPool_p->pxEnd;

  530.         /* Only one block exists - and it covers the entire usable heap space. */
  531.         MemPool_p->xMinimumEverFreeBytesRemaining = pxFirstFreeBlock->xBlockSize;
  532.         MemPool_p->xFreeBytesRemaining = pxFirstFreeBlock->xBlockSize;

  533.         /* Work out the position of the top bit in a size_t variable. */
  534.         MemPool_p->xBlockAllocatedBit = ( ( size_t ) 1 ) << ( ( sizeof( size_t ) * heapBITS_PER_BYTE ) - 1 );
  535. }
  536. /*-----------------------------------------------------------*/


  537. /*-----------------------------------------------------------*/

  538. static void prvInsertBlockIntoFreeList( BlockLink_t *pxBlockToInsert,MemPool_t *MemPool_p )
  539. {
  540. BlockLink_t *pxIterator;
  541. uint8_t *puc;

  542.         /* Iterate through the list until a block is found that has a higher address
  543.         than the block being inserted. */
  544.         for( pxIterator = &MemPool_p->xStart; pxIterator->pxNextFreeBlock < pxBlockToInsert; pxIterator = pxIterator->pxNextFreeBlock )
  545.         {
  546.                 /* Nothing to do here, just iterate to the right position. */
  547.         }

  548.         /* Do the block being inserted, and the block it is being inserted after
  549.         make a contiguous block of memory? */
  550.         puc = ( uint8_t * ) pxIterator;
  551.         if( ( puc + pxIterator->xBlockSize ) == ( uint8_t * ) pxBlockToInsert )
  552.         {
  553.                 pxIterator->xBlockSize += pxBlockToInsert->xBlockSize;
  554.                 pxBlockToInsert = pxIterator;
  555.         }
  556.         else
  557.         {
  558.                 mtCOVERAGE_TEST_MARKER();
  559.         }

  560.         /* Do the block being inserted, and the block it is being inserted before
  561.         make a contiguous block of memory? */
  562.         puc = ( uint8_t * ) pxBlockToInsert;
  563.         if( ( puc + pxBlockToInsert->xBlockSize ) == ( uint8_t * ) pxIterator->pxNextFreeBlock )
  564.         {
  565.                 if( pxIterator->pxNextFreeBlock != MemPool_p->pxEnd )
  566.                 {
  567.                         /* Form one big block from the two blocks. */
  568.                         pxBlockToInsert->xBlockSize += pxIterator->pxNextFreeBlock->xBlockSize;
  569.                         pxBlockToInsert->pxNextFreeBlock = pxIterator->pxNextFreeBlock->pxNextFreeBlock;
  570.                 }
  571.                 else
  572.                 {
  573.                         pxBlockToInsert->pxNextFreeBlock = MemPool_p->pxEnd;
  574.                 }
  575.         }
  576.         else
  577.         {
  578.                 pxBlockToInsert->pxNextFreeBlock = pxIterator->pxNextFreeBlock;
  579.         }

  580.         /* If the block being inserted plugged a gab, so was merged with the block
  581.         before and the block after, then it's pxNextFreeBlock pointer will have
  582.         already been set, and should not be set here as that would make it point
  583.         to itself. */
  584.         if( pxIterator != pxBlockToInsert )
  585.         {
  586.                 pxIterator->pxNextFreeBlock = pxBlockToInsert;
  587.         }
  588.         else
  589.         {
  590.                 mtCOVERAGE_TEST_MARKER();
  591.         }
  592. }

复制代码




正点原子逻辑分析仪DL16劲爆上市
回复

使用道具 举报

0

主题

57

帖子

0

精华

初级会员

Rank: 2

积分
62
金钱
62
注册时间
2018-12-27
在线时间
0 小时
发表于 2020-5-12 13:24:03 | 显示全部楼层
回复 支持 反对

使用道具 举报

您需要登录后才可以回帖 登录 | 立即注册

本版积分规则



关闭

原子哥极力推荐上一条 /2 下一条

正点原子公众号

QQ|手机版|OpenEdv-开源电子网 ( 粤ICP备12000418号-1 )

GMT+8, 2024-11-22 22:17

Powered by OpenEdv-开源电子网

© 2001-2030 OpenEdv-开源电子网

快速回复 返回顶部 返回列表