Added a first-cut version of MapVirtualKeyExW() that has the same
[wine] / memory / local.c
1 /*
2  * Local heap functions
3  *
4  * Copyright 1995 Alexandre Julliard
5  * Copyright 1996 Huw Davies
6  */
7
8 /*
9  * Note:
10  * All local heap functions need the current DS as first parameter
11  * when called from the emulation library, so they take one more
12  * parameter than usual.
13  */
14
15 #include <stdlib.h>
16 #include <string.h>
17 #include "wine/winbase16.h"
18 #include "ldt.h"
19 #include "task.h"
20 #include "global.h"
21 #include "heap.h"
22 #include "instance.h"
23 #include "local.h"
24 #include "module.h"
25 #include "stackframe.h"
26 #include "toolhelp.h"
27 #include "debugtools.h"
28 #include "callback.h"
29
30 DEFAULT_DEBUG_CHANNEL(local);
31 DECLARE_DEBUG_CHANNEL(heap);
32
33 typedef struct
34 {
35 /* Arena header */
36     WORD prev;          /* Previous arena | arena type */
37     WORD next;          /* Next arena */
38 /* Start of the memory block or free-list info */
39     WORD size;          /* Size of the free block */
40     WORD free_prev;     /* Previous free block */
41     WORD free_next;     /* Next free block */
42 } LOCALARENA;
43
44 #define ARENA_HEADER_SIZE      4
45 #define ARENA_HEADER( handle) ( ((handle) & ~3) - ARENA_HEADER_SIZE)
46
47   /* Arena types (stored in 'prev' field of the arena) */
48 #define LOCAL_ARENA_FREE       0
49 #define LOCAL_ARENA_FIXED      1
50
51 /* LocalNotify() msgs */
52
53 #define LN_OUTOFMEM     0
54 #define LN_MOVE         1
55 #define LN_DISCARD      2
56
57 /* Layout of a handle entry table
58  *
59  * WORD                     count of entries
60  * LOCALHANDLEENTRY[count]  entries
61  * WORD                     near ptr to next table
62  */
63 typedef struct
64 {
65     WORD addr;                /* Address of the MOVEABLE block */
66     BYTE flags;               /* Flags for this block */
67     BYTE lock;                /* Lock count */
68 } LOCALHANDLEENTRY;
69
70 /*
71  * We make addr = 4n + 2 and set *((WORD *)addr - 1) = &addr like Windows does
72  * in case something actually relies on this.
73  * Note the ARENA_HEADER(addr) still produces the desired result ie. 4n - 4
74  *
75  * An unused handle has lock = flags = 0xff. In windows addr is that of next
76  * free handle, at the moment in wine we set it to 0.
77  *
78  * A discarded block's handle has lock = addr = 0 and flags = 0x40
79  * (LMEM_DISCARDED >> 8)
80  */
81
82 #include "pshpack1.h"
83
84 typedef struct
85 {
86     WORD check;                 /* 00 Heap checking flag */
87     WORD freeze;                /* 02 Heap frozen flag */
88     WORD items;                 /* 04 Count of items on the heap */
89     WORD first;                 /* 06 First item of the heap */
90     WORD pad1;                  /* 08 Always 0 */
91     WORD last;                  /* 0a Last item of the heap */
92     WORD pad2;                  /* 0c Always 0 */
93     BYTE ncompact;              /* 0e Compactions counter */
94     BYTE dislevel;              /* 0f Discard level */
95     DWORD distotal;             /* 10 Total bytes discarded */
96     WORD htable;                /* 14 Pointer to handle table */
97     WORD hfree;                 /* 16 Pointer to free handle table */
98     WORD hdelta;                /* 18 Delta to expand the handle table */
99     WORD expand;                /* 1a Pointer to expand function (unused) */
100     WORD pstat;                 /* 1c Pointer to status structure (unused) */
101     FARPROC16 notify WINE_PACKED; /* 1e Pointer to LocalNotify() function */
102     WORD lock;                  /* 22 Lock count for the heap */
103     WORD extra;                 /* 24 Extra bytes to allocate when expanding */
104     WORD minsize;               /* 26 Minimum size of the heap */
105     WORD magic;                 /* 28 Magic number */
106 } LOCALHEAPINFO;
107
108 #include "poppack.h"
109
110 #define LOCAL_HEAP_MAGIC  0x484c  /* 'LH' */
111
112 WORD USER_HeapSel = 0;  /* USER heap selector */
113
114   /* All local heap allocations are aligned on 4-byte boundaries */
115 #define LALIGN(word)          (((word) + 3) & ~3)
116
117 #define ARENA_PTR(ptr,arena)       ((LOCALARENA *)((char*)(ptr)+(arena)))
118 #define ARENA_PREV(ptr,arena)      (ARENA_PTR((ptr),(arena))->prev & ~3)
119 #define ARENA_NEXT(ptr,arena)      (ARENA_PTR((ptr),(arena))->next)
120 #define ARENA_FLAGS(ptr,arena)     (ARENA_PTR((ptr),(arena))->prev & 3)
121
122   /* determine whether the handle belongs to a fixed or a moveable block */
123 #define HANDLE_FIXED(handle) (((handle) & 3) == 0)
124 #define HANDLE_MOVEABLE(handle) (((handle) & 3) == 2)
125
126
127 /* ### start build ### */
128 extern WORD CALLBACK LOCAL_CallTo16_word_www(FARPROC16,WORD,HLOCAL16,WORD);
129 /* ### stop build ### */
130
131 /***********************************************************************
132  *           LOCAL_GetHeap
133  *
134  * Return a pointer to the local heap, making sure it exists.
135  */
136 static LOCALHEAPINFO *LOCAL_GetHeap( HANDLE16 ds )
137 {
138     LOCALHEAPINFO *pInfo;
139     INSTANCEDATA *ptr = (INSTANCEDATA *)PTR_SEG_OFF_TO_LIN( ds, 0 );
140     TRACE("Heap at %p, %04x\n", ptr, (ptr != NULL ? ptr->heap : 0xFFFF));
141     if (!ptr || !ptr->heap) return NULL;
142     if (IsBadReadPtr16( (SEGPTR)MAKELONG(ptr->heap,ds), sizeof(LOCALHEAPINFO)))
143     {
144         WARN("Bad pointer\n");
145         return NULL;
146     }
147     pInfo = (LOCALHEAPINFO*)((char*)ptr + ptr->heap);
148     if (pInfo->magic != LOCAL_HEAP_MAGIC)
149     {
150         WARN("Bad magic\n");
151         return NULL;
152     }
153     return pInfo;
154 }
155
156
157 /***********************************************************************
158  *           LOCAL_MakeBlockFree
159  *
160  * Make a block free, inserting it in the free-list.
161  * 'block' is the handle of the block arena; 'baseptr' points to
162  * the beginning of the data segment containing the heap.
163  */
164 static void LOCAL_MakeBlockFree( char *baseptr, WORD block )
165 {
166     LOCALARENA *pArena, *pNext;
167     WORD next;
168
169       /* Mark the block as free */
170
171     pArena = ARENA_PTR( baseptr, block );
172     pArena->prev = (pArena->prev & ~3) | LOCAL_ARENA_FREE;
173     pArena->size = pArena->next - block;
174     
175       /* Find the next free block (last block is always free) */
176
177     next = pArena->next;
178     for (;;)
179     {
180         pNext = ARENA_PTR( baseptr, next );
181         if ((pNext->prev & 3) == LOCAL_ARENA_FREE) break;
182         next = pNext->next;
183     }
184
185     TRACE("%04x, next %04x\n", block, next );
186       /* Insert the free block in the free-list */
187
188     pArena->free_prev = pNext->free_prev;
189     pArena->free_next = next;
190     ARENA_PTR(baseptr,pNext->free_prev)->free_next = block;
191     pNext->free_prev  = block;
192 }
193
194
195 /***********************************************************************
196  *           LOCAL_RemoveFreeBlock
197  *
198  * Remove a block from the free-list.
199  * 'block' is the handle of the block arena; 'baseptr' points to
200  * the beginning of the data segment containing the heap.
201  */
202 static void LOCAL_RemoveFreeBlock( char *baseptr, WORD block )
203 {
204       /* Mark the block as fixed */
205
206     LOCALARENA *pArena = ARENA_PTR( baseptr, block );
207     pArena->prev = (pArena->prev & ~3) | LOCAL_ARENA_FIXED;
208
209       /* Remove it from the list */
210
211     ARENA_PTR(baseptr,pArena->free_prev)->free_next = pArena->free_next;
212     ARENA_PTR(baseptr,pArena->free_next)->free_prev = pArena->free_prev;
213 }
214
215
216 /***********************************************************************
217  *           LOCAL_AddBlock
218  *
219  * Insert a new block in the heap.
220  * 'new' is the handle of the new block arena; 'baseptr' points to
221  * the beginning of the data segment containing the heap; 'prev' is
222  * the block before the new one.
223  */
224 static void LOCAL_AddBlock( char *baseptr, WORD prev, WORD new )
225 {
226     LOCALARENA *pPrev = ARENA_PTR( baseptr, prev );
227     LOCALARENA *pNew  = ARENA_PTR( baseptr, new );
228
229     pNew->prev = (prev & ~3) | LOCAL_ARENA_FIXED;
230     pNew->next = pPrev->next;
231     ARENA_PTR(baseptr,pPrev->next)->prev &= 3;
232     ARENA_PTR(baseptr,pPrev->next)->prev |= new;
233     pPrev->next = new;
234 }
235
236
237 /***********************************************************************
238  *           LOCAL_RemoveBlock
239  *
240  * Remove a block from the heap.
241  * 'block' is the handle of the block arena; 'baseptr' points to
242  * the beginning of the data segment containing the heap.
243  */
244 static void LOCAL_RemoveBlock( char *baseptr, WORD block )
245 {
246     LOCALARENA *pArena, *pTmp;
247
248       /* Remove the block from the free-list */
249
250     TRACE("\n");
251     pArena = ARENA_PTR( baseptr, block );
252     if ((pArena->prev & 3) == LOCAL_ARENA_FREE)
253         LOCAL_RemoveFreeBlock( baseptr, block );
254
255       /* If the previous block is free, expand its size */
256
257     pTmp = ARENA_PTR( baseptr, pArena->prev & ~3 );
258     if ((pTmp->prev & 3) == LOCAL_ARENA_FREE)
259         pTmp->size += pArena->next - block;
260
261       /* Remove the block from the linked list */
262
263     pTmp->next = pArena->next;
264     pTmp = ARENA_PTR( baseptr, pArena->next );
265     pTmp->prev = (pTmp->prev & 3) | (pArena->prev & ~3);
266 }
267
268
269 /***********************************************************************
270  *           LOCAL_PrintHeap
271  */
272 static void LOCAL_PrintHeap( HANDLE16 ds )
273 {
274     char *ptr;
275     LOCALHEAPINFO *pInfo;
276     WORD arena;
277
278     /* FIXME - the test should be done when calling the function! 
279                plus is not clear that we should print this info
280                only when TRACE_ON is on! */
281     if(!TRACE_ON(local)) return;
282
283     ptr = PTR_SEG_OFF_TO_LIN( ds, 0 );
284     pInfo = LOCAL_GetHeap( ds );
285
286     if (!pInfo)
287     {
288         DPRINTF( "Local Heap corrupted!  ds=%04x\n", ds );
289         return;
290     }
291     DPRINTF( "Local Heap  ds=%04x first=%04x last=%04x items=%d\n",
292              ds, pInfo->first, pInfo->last, pInfo->items );
293
294     arena = pInfo->first;
295     for (;;)
296     {
297         LOCALARENA *pArena = ARENA_PTR(ptr,arena);
298         DPRINTF( "  %04x: prev=%04x next=%04x type=%d\n", arena,
299               pArena->prev & ~3, pArena->next, pArena->prev & 3 );
300         if (arena == pInfo->first)
301         {
302             DPRINTF( "        size=%d free_prev=%04x free_next=%04x\n",
303                      pArena->size, pArena->free_prev, pArena->free_next );
304         }
305         if ((pArena->prev & 3) == LOCAL_ARENA_FREE)
306         {
307             DPRINTF( "        size=%d free_prev=%04x free_next=%04x\n",
308                      pArena->size, pArena->free_prev, pArena->free_next );
309             if (pArena->next == arena) break;  /* last one */
310             if (ARENA_PTR(ptr,pArena->free_next)->free_prev != arena)
311             {
312                 DPRINTF( "*** arena->free_next->free_prev != arena\n" );
313                 break;
314             }
315         }
316         if (pArena->next == arena)
317         {
318             DPRINTF( "*** last block is not marked free\n" );
319             break;
320         }
321         if ((ARENA_PTR(ptr,pArena->next)->prev & ~3) != arena)
322         {
323             DPRINTF( "*** arena->next->prev != arena (%04x, %04x)\n",
324                      pArena->next, ARENA_PTR(ptr,pArena->next)->prev);
325             break;
326         }
327         arena = pArena->next;
328     }
329 }
330
331
332 /***********************************************************************
333  *           LocalInit   (KERNEL.4)
334  */
335 BOOL16 WINAPI LocalInit16( HANDLE16 selector, WORD start, WORD end )
336 {
337     char *ptr;
338     WORD heapInfoArena, freeArena, lastArena;
339     LOCALHEAPINFO *pHeapInfo;
340     LOCALARENA *pArena, *pFirstArena, *pLastArena;
341     NE_MODULE *pModule;
342     BOOL16 ret = FALSE;
343
344       /* The initial layout of the heap is: */
345       /* - first arena         (FIXED)      */
346       /* - heap info structure (FIXED)      */
347       /* - large free block    (FREE)       */
348       /* - last arena          (FREE)       */
349
350     TRACE("%04x %04x-%04x\n", selector, start, end);
351     if (!selector) selector = CURRENT_DS;
352
353     if (TRACE_ON(heap))
354     {
355         /* If TRACE_ON(heap) is set, the global heap blocks are */
356         /* cleared before use, so we can test for double initialization. */
357         if (LOCAL_GetHeap(selector))
358         {
359             ERR("Heap %04x initialized twice.\n", selector);
360             LOCAL_PrintHeap(selector);
361         }
362     }
363
364     if (start == 0) 
365     {
366         /* start == 0 means: put the local heap at the end of the segment */
367
368         DWORD size = GlobalSize16( GlobalHandle16( selector ) );
369         start = (WORD)(size > 0xffff ? 0xffff : size) - 1;
370         if ( end > 0xfffe ) end = 0xfffe;
371         start -= end;
372         end += start;
373
374         /* Paranoid check */
375
376         if ((pModule = NE_GetPtr( GlobalHandle16( selector ) )))
377         {
378             SEGTABLEENTRY *pSeg = NE_SEG_TABLE( pModule );
379             int segNr;
380
381             for ( segNr = 0; segNr < pModule->seg_count; segNr++, pSeg++ )
382                 if ( GlobalHandleToSel16(pSeg->hSeg) == selector )
383                     break;
384
385             if ( segNr < pModule->seg_count )
386             {
387                 WORD minsize = pSeg->minsize;
388                 if ( pModule->ss == segNr+1 )
389                     minsize += pModule->stack_size;
390
391                 TRACE(" new start %04x, minstart: %04x\n", start, minsize);
392             }
393         }
394     }
395     ptr = PTR_SEG_OFF_TO_LIN( selector, 0 );
396
397     start = LALIGN( max( start, sizeof(INSTANCEDATA) ) );
398     heapInfoArena = LALIGN(start + sizeof(LOCALARENA) );
399     freeArena = LALIGN( heapInfoArena + ARENA_HEADER_SIZE
400                         + sizeof(LOCALHEAPINFO) );
401     lastArena = (end - sizeof(LOCALARENA)) & ~3;
402
403       /* Make sure there's enough space.       */
404
405     if (freeArena + sizeof(LOCALARENA) >= lastArena) goto done;
406
407       /* Initialise the first arena */
408
409     pFirstArena = ARENA_PTR( ptr, start );
410     pFirstArena->prev      = start | LOCAL_ARENA_FIXED;
411     pFirstArena->next      = heapInfoArena;
412     pFirstArena->size      = LALIGN(sizeof(LOCALARENA));
413     pFirstArena->free_prev = start;  /* this one */
414     pFirstArena->free_next = freeArena;
415
416       /* Initialise the arena of the heap info structure */
417
418     pArena = ARENA_PTR( ptr, heapInfoArena );
419     pArena->prev = start | LOCAL_ARENA_FIXED;
420     pArena->next = freeArena;
421
422       /* Initialise the heap info structure */
423
424     pHeapInfo = (LOCALHEAPINFO *) (ptr + heapInfoArena + ARENA_HEADER_SIZE );
425     memset( pHeapInfo, 0, sizeof(LOCALHEAPINFO) );
426     pHeapInfo->items   = 4;
427     pHeapInfo->first   = start;
428     pHeapInfo->last    = lastArena;
429     pHeapInfo->htable  = 0;
430     pHeapInfo->hdelta  = 0x20;
431     pHeapInfo->extra   = 0x200;
432     pHeapInfo->minsize = lastArena - freeArena;
433     pHeapInfo->magic   = LOCAL_HEAP_MAGIC;
434
435       /* Initialise the large free block */
436
437     pArena = ARENA_PTR( ptr, freeArena );
438     pArena->prev      = heapInfoArena | LOCAL_ARENA_FREE;
439     pArena->next      = lastArena;
440     pArena->size      = lastArena - freeArena;
441     pArena->free_prev = start;
442     pArena->free_next = lastArena;
443
444       /* Initialise the last block */
445
446     pLastArena = ARENA_PTR( ptr, lastArena );
447     pLastArena->prev      = freeArena | LOCAL_ARENA_FREE;
448     pLastArena->next      = lastArena;  /* this one */
449     pLastArena->size      = LALIGN(sizeof(LOCALARENA));
450     pLastArena->free_prev = freeArena;
451     pLastArena->free_next = lastArena;  /* this one */
452
453       /* Store the local heap address in the instance data */
454
455     ((INSTANCEDATA *)ptr)->heap = heapInfoArena + ARENA_HEADER_SIZE;
456     LOCAL_PrintHeap( selector );
457     ret = TRUE;
458
459  done:
460     CURRENT_STACK16->ecx = ret;  /* must be returned in cx too */
461     return ret;
462 }
463
464 /***********************************************************************
465  *           LOCAL_GrowHeap
466  */
467 static BOOL16 LOCAL_GrowHeap( HANDLE16 ds )
468 {
469     HANDLE16 hseg;
470     LONG oldsize;
471     LONG end;
472     LOCALHEAPINFO *pHeapInfo;
473     WORD freeArena, lastArena;
474     LOCALARENA *pArena, *pLastArena;
475     char *ptr;
476     
477     hseg = GlobalHandle16( ds );
478     /* maybe mem allocated by Virtual*() ? */
479     if (!hseg) return FALSE;
480
481     oldsize = GlobalSize16( hseg );
482     /* if nothing can be gained, return */
483     if (oldsize > 0xfff0) return FALSE;
484     hseg = GlobalReAlloc16( hseg, 0x10000, GMEM_FIXED );
485     ptr = PTR_SEG_OFF_TO_LIN( ds, 0 );
486     pHeapInfo = LOCAL_GetHeap( ds );
487     if (pHeapInfo == NULL) {
488         ERR("Heap not found\n" );
489         return FALSE;
490     }
491     end = GlobalSize16( hseg );
492     lastArena = (end - sizeof(LOCALARENA)) & ~3;
493
494       /* Update the HeapInfo */
495     pHeapInfo->items++;
496     freeArena = pHeapInfo->last;
497     pHeapInfo->last = lastArena;
498     pHeapInfo->minsize += end - oldsize;
499     
500       /* grow the old last block */
501     pArena = ARENA_PTR( ptr, freeArena );
502     pArena->size      = lastArena - freeArena;
503     pArena->next      = lastArena;
504     pArena->free_next = lastArena;
505
506       /* Initialise the new last block */
507
508     pLastArena = ARENA_PTR( ptr, lastArena );
509     pLastArena->prev      = freeArena | LOCAL_ARENA_FREE;
510     pLastArena->next      = lastArena;  /* this one */
511     pLastArena->size      = LALIGN(sizeof(LOCALARENA));
512     pLastArena->free_prev = freeArena;
513     pLastArena->free_next = lastArena;  /* this one */
514     
515     /* If block before freeArena is also free then merge them */
516     if((ARENA_PTR(ptr, (pArena->prev & ~3))->prev & 3) == LOCAL_ARENA_FREE)
517     {
518         LOCAL_RemoveBlock(ptr, freeArena);
519         pHeapInfo->items--;
520     }
521
522     TRACE("Heap expanded\n" );
523     LOCAL_PrintHeap( ds );
524     return TRUE;
525 }
526
527
528 /***********************************************************************
529  *           LOCAL_FreeArena
530  */
531 static HLOCAL16 LOCAL_FreeArena( WORD ds, WORD arena )
532 {
533     char *ptr = PTR_SEG_OFF_TO_LIN( ds, 0 );
534     LOCALHEAPINFO *pInfo;
535     LOCALARENA *pArena, *pPrev, *pNext;
536
537     TRACE("%04x ds=%04x\n", arena, ds );
538     if (!(pInfo = LOCAL_GetHeap( ds ))) return arena;
539
540     pArena = ARENA_PTR( ptr, arena );
541     if ((pArena->prev & 3) == LOCAL_ARENA_FREE)
542     {
543         /* shouldn't happen */
544         ERR("Trying to free block %04x twice!\n",
545                  arena );
546         LOCAL_PrintHeap( ds );
547         return arena;
548     }
549
550       /* Check if we can merge with the previous block */
551
552     pPrev = ARENA_PTR( ptr, pArena->prev & ~3 );
553     pNext = ARENA_PTR( ptr, pArena->next );
554     if ((pPrev->prev & 3) == LOCAL_ARENA_FREE)
555     {
556         arena  = pArena->prev & ~3;
557         pArena = pPrev;
558         LOCAL_RemoveBlock( ptr, pPrev->next );
559         pInfo->items--;
560     }
561     else  /* Make a new free block */
562     {
563         LOCAL_MakeBlockFree( ptr, arena );
564     }
565
566       /* Check if we can merge with the next block */
567
568     if ((pArena->next == pArena->free_next) &&
569         (pArena->next != pInfo->last))
570     {
571         LOCAL_RemoveBlock( ptr, pArena->next );
572         pInfo->items--;
573     }
574     return 0;
575 }
576
577
578 /***********************************************************************
579  *           LOCAL_ShrinkArena
580  *
581  * Shrink an arena by creating a free block at its end if possible.
582  * 'size' includes the arena header, and must be aligned.
583  */
584 static void LOCAL_ShrinkArena( WORD ds, WORD arena, WORD size )
585 {
586     char *ptr = PTR_SEG_OFF_TO_LIN( ds, 0 );
587     LOCALARENA *pArena = ARENA_PTR( ptr, arena );
588
589     if (arena + size + LALIGN(sizeof(LOCALARENA)) < pArena->next)
590     {
591         LOCALHEAPINFO *pInfo = LOCAL_GetHeap( ds );
592         if (!pInfo) return;
593         LOCAL_AddBlock( ptr, arena, arena + size );
594         pInfo->items++;
595         LOCAL_FreeArena( ds, arena + size );
596     }
597 }
598
599
600 /***********************************************************************
601  *           LOCAL_GrowArenaDownward
602  *
603  * Grow an arena downward by using the previous arena (must be free).
604  */
605 static void LOCAL_GrowArenaDownward( WORD ds, WORD arena, WORD newsize )
606 {
607     char *ptr = PTR_SEG_OFF_TO_LIN( ds, 0 );
608     LOCALHEAPINFO *pInfo;
609     LOCALARENA *pArena = ARENA_PTR( ptr, arena );
610     WORD prevArena = pArena->prev & ~3;
611     LOCALARENA *pPrevArena = ARENA_PTR( ptr, prevArena );
612     WORD offset, size;
613     char *p;
614
615     if (!(pInfo = LOCAL_GetHeap( ds ))) return;
616     offset = pPrevArena->size;
617     size = pArena->next - arena - ARENA_HEADER_SIZE;
618     LOCAL_RemoveFreeBlock( ptr, prevArena );
619     LOCAL_RemoveBlock( ptr, arena );
620     pInfo->items--;
621     p = (char *)pPrevArena + ARENA_HEADER_SIZE;
622     while (offset < size)
623     {
624         memcpy( p, p + offset, offset );
625         p += offset;
626         size -= offset;
627     }
628     if (size) memcpy( p, p + offset, size );
629     LOCAL_ShrinkArena( ds, prevArena, newsize );
630 }
631
632
633
634 /***********************************************************************
635  *           LOCAL_GrowArenaUpward
636  *
637  * Grow an arena upward by using the next arena (must be free and big
638  * enough). Newsize includes the arena header and must be aligned.
639  */
640 static void LOCAL_GrowArenaUpward( WORD ds, WORD arena, WORD newsize )
641 {
642     char *ptr = PTR_SEG_OFF_TO_LIN( ds, 0 );
643     LOCALHEAPINFO *pInfo;
644     LOCALARENA *pArena = ARENA_PTR( ptr, arena );
645     WORD nextArena = pArena->next;
646
647     if (!(pInfo = LOCAL_GetHeap( ds ))) return;
648     LOCAL_RemoveBlock( ptr, nextArena );
649     pInfo->items--;
650     LOCAL_ShrinkArena( ds, arena, newsize );
651 }
652
653
654 /***********************************************************************
655  *           LOCAL_GetFreeSpace
656  */
657 static WORD LOCAL_GetFreeSpace(WORD ds, WORD countdiscard)
658 {
659     char *ptr = PTR_SEG_OFF_TO_LIN( ds, 0 );
660     LOCALHEAPINFO *pInfo;
661     LOCALARENA *pArena;
662     WORD arena;
663     WORD freespace = 0;
664     
665     if (!(pInfo = LOCAL_GetHeap( ds )))
666     {
667         ERR("Local heap not found\n" );
668         LOCAL_PrintHeap(ds);
669         return 0;
670     }
671     arena = pInfo->first;
672     pArena = ARENA_PTR( ptr, arena );
673     while (arena != pArena->free_next)
674     {
675         arena = pArena->free_next;
676         pArena = ARENA_PTR( ptr, arena );
677         if (pArena->size >= freespace) freespace = pArena->size;
678     }
679     /* FIXME doesn't yet calculate space that would become free if everything
680        were discarded when countdiscard == 1 */
681     if (freespace < ARENA_HEADER_SIZE) freespace = 0;
682     else freespace -= ARENA_HEADER_SIZE;
683     return freespace;
684 }
685
686
687 /***********************************************************************
688  *           LOCAL_Compact
689  */
690 WORD LOCAL_Compact( HANDLE16 ds, UINT16 minfree, UINT16 flags )
691 {
692     char *ptr = PTR_SEG_OFF_TO_LIN( ds, 0 );
693     LOCALHEAPINFO *pInfo;
694     LOCALARENA *pArena, *pMoveArena, *pFinalArena;
695     WORD arena, movearena, finalarena, table;
696     WORD count, movesize, size;
697     WORD freespace;
698     LOCALHANDLEENTRY *pEntry;
699
700     if (!(pInfo = LOCAL_GetHeap( ds )))
701     {
702         ERR("Local heap not found\n" );
703         LOCAL_PrintHeap(ds);
704         return 0;
705     }
706     TRACE("ds = %04x, minfree = %04x, flags = %04x\n",
707                  ds, minfree, flags);
708     freespace = LOCAL_GetFreeSpace(ds, minfree ? 0 : 1);
709     if(freespace >= minfree || (flags & LMEM_NOCOMPACT))
710     {
711         TRACE("Returning %04x.\n", freespace);
712         return freespace;
713     }
714     TRACE("Compacting heap %04x.\n", ds);
715     table = pInfo->htable;
716     while(table)
717     {
718         pEntry = (LOCALHANDLEENTRY *)(ptr + table + sizeof(WORD));
719         for(count = *(WORD *)(ptr + table); count > 0; count--, pEntry++)
720         {
721             if((pEntry->lock == 0) && (pEntry->flags != (LMEM_DISCARDED >> 8)))
722             {
723                 /* OK we can move this one if we want */
724                 TRACE("handle %04x (block %04x) can be moved.\n",
725                              (WORD)((char *)pEntry - ptr), pEntry->addr);
726                 movearena = ARENA_HEADER(pEntry->addr);
727                 pMoveArena = ARENA_PTR(ptr, movearena);
728                 movesize = pMoveArena->next - movearena;
729                 arena = pInfo->first;
730                 pArena = ARENA_PTR(ptr, arena);
731                 size = 0xffff;
732                 finalarena = 0;
733                 /* Try to find the smallest arena that will do, */
734                 /* which is below us in memory */
735                 for(;;)
736                 {
737                     arena = pArena->free_next;
738                     pArena = ARENA_PTR(ptr, arena);
739                     if(arena >= movearena)
740                         break;
741                     if(arena == pArena->free_next)
742                         break;
743                     if((pArena->size >= movesize) && (pArena->size < size))
744                     {
745                         size = pArena->size;
746                         finalarena = arena;
747                     }
748                 }
749                 if (finalarena) /* Actually got somewhere to move */
750                 {
751                     TRACE("Moving it to %04x.\n", finalarena);
752                     pFinalArena = ARENA_PTR(ptr, finalarena);
753                     size = pFinalArena->size;
754                     LOCAL_RemoveFreeBlock(ptr, finalarena);
755                     LOCAL_ShrinkArena( ds, finalarena, movesize );
756                     /* Copy the arena to it's new location */
757                     memcpy((char *)pFinalArena + ARENA_HEADER_SIZE,
758                            (char *)pMoveArena + ARENA_HEADER_SIZE,
759                            movesize - ARENA_HEADER_SIZE );
760                     /* Free the old location */  
761                     LOCAL_FreeArena(ds, movearena);
762                     if (pInfo->notify)
763                         LOCAL_CallTo16_word_www(pInfo->notify, LN_MOVE,
764                         (WORD)((char *)pEntry - ptr), pEntry->addr);
765                     /* Update handle table entry */
766                     pEntry->addr = finalarena + ARENA_HEADER_SIZE + sizeof(HLOCAL16) ;
767                 }
768                 else if((ARENA_PTR(ptr, pMoveArena->prev & ~3)->prev & 3)
769                                == LOCAL_ARENA_FREE)
770                 {
771                     /* Previous arena is free (but < movesize)  */
772                     /* so we can 'slide' movearena down into it */
773                     finalarena = pMoveArena->prev & ~3;
774                     LOCAL_GrowArenaDownward( ds, movearena, movesize );
775                     /* Update handle table entry */
776                     pEntry->addr = finalarena + ARENA_HEADER_SIZE + sizeof(HLOCAL16) ;
777                 }
778             }
779         }
780         table = *(WORD *)pEntry;
781     }
782     freespace = LOCAL_GetFreeSpace(ds, minfree ? 0 : 1);
783     if(freespace >= minfree || (flags & LMEM_NODISCARD))
784     {
785         TRACE("Returning %04x.\n", freespace);
786         return freespace;
787     }
788
789     table = pInfo->htable;
790     while(table)
791     {
792         pEntry = (LOCALHANDLEENTRY *)(ptr + table + sizeof(WORD));
793         for(count = *(WORD *)(ptr + table); count > 0; count--, pEntry++)
794         {
795             if(pEntry->addr && pEntry->lock == 0 &&
796              (pEntry->flags & (LMEM_DISCARDABLE >> 8)))
797             {
798                 TRACE("Discarding handle %04x (block %04x).\n",
799                               (char *)pEntry - ptr, pEntry->addr);
800                 LOCAL_FreeArena(ds, ARENA_HEADER(pEntry->addr));
801                 if (pInfo->notify)
802                     LOCAL_CallTo16_word_www(pInfo->notify, LN_DISCARD,
803                         (char *)pEntry - ptr, pEntry->flags);
804                 pEntry->addr = 0;
805                 pEntry->flags = (LMEM_DISCARDED >> 8);
806             }
807         }
808         table = *(WORD *)pEntry;
809     }
810     return LOCAL_Compact(ds, 0xffff, LMEM_NODISCARD);
811 }
812
813
814 /***********************************************************************
815  *           LOCAL_FindFreeBlock
816  */
817 static HLOCAL16 LOCAL_FindFreeBlock( HANDLE16 ds, WORD size )
818 {
819     char *ptr = PTR_SEG_OFF_TO_LIN( ds, 0 );
820     LOCALHEAPINFO *pInfo;
821     LOCALARENA *pArena;
822     WORD arena;
823
824     if (!(pInfo = LOCAL_GetHeap( ds )))
825     {
826         ERR("Local heap not found\n" );
827         LOCAL_PrintHeap(ds);
828         return 0;
829     }
830
831     arena = pInfo->first;
832     pArena = ARENA_PTR( ptr, arena );
833     for (;;) {
834         arena = pArena->free_next;
835         pArena = ARENA_PTR( ptr, arena );
836         if (arena == pArena->free_next) break;
837         if (pArena->size >= size) return arena;
838     }
839     TRACE("not enough space\n" );
840     LOCAL_PrintHeap(ds);
841     return 0;
842 }
843
844
845 /***********************************************************************
846  *           get_heap_name
847  */
848 static const char *get_heap_name( WORD ds )
849 {
850     HINSTANCE16 inst = LoadLibrary16( "GDI" );
851     if (ds == GlobalHandleToSel16( inst ))
852     {
853         FreeLibrary16( inst );
854         return "GDI";
855     }
856     FreeLibrary16( inst );
857     inst = LoadLibrary16( "USER" );
858     if (ds == GlobalHandleToSel16( inst ))
859     {
860         FreeLibrary16( inst );
861         return "USER";
862     }
863     FreeLibrary16( inst );
864     return "local";
865 }
866
867 /***********************************************************************
868  *           LOCAL_GetBlock
869  * The segment may get moved around in this function, so all callers
870  * should reset their pointer variables.
871  */
872 static HLOCAL16 LOCAL_GetBlock( HANDLE16 ds, WORD size, WORD flags )
873 {
874     char *ptr = PTR_SEG_OFF_TO_LIN( ds, 0 );
875     LOCALHEAPINFO *pInfo;
876     LOCALARENA *pArena;
877     WORD arena;
878
879     if (!(pInfo = LOCAL_GetHeap( ds )))
880     {
881         ERR("Local heap not found\n");
882         LOCAL_PrintHeap(ds);
883         return 0;
884     }
885
886     size += ARENA_HEADER_SIZE;
887     size = LALIGN( max( size, sizeof(LOCALARENA) ) );
888
889 #if 0
890 notify_done:
891 #endif
892       /* Find a suitable free block */
893     arena = LOCAL_FindFreeBlock( ds, size );
894     if (arena == 0) {
895         /* no space: try to make some */
896         LOCAL_Compact( ds, size, flags );
897         arena = LOCAL_FindFreeBlock( ds, size );
898     }
899     if (arena == 0) {
900         /* still no space: try to grow the segment */
901         if (!(LOCAL_GrowHeap( ds )))
902         {
903 #if 0
904             /* FIXME: doesn't work correctly yet */
905             if ((pInfo->notify) && (LOCAL_CallTo16_word_www(pInfo->notify, LN_OUTOFMEM, ds - 20, size))) /* FIXME: "size" correct ? (should indicate bytes needed) */
906                 goto notify_done;
907 #endif
908             return 0;
909         }
910         ptr = PTR_SEG_OFF_TO_LIN( ds, 0 );
911         pInfo = LOCAL_GetHeap( ds );
912         arena = LOCAL_FindFreeBlock( ds, size );
913     }
914     if (arena == 0) {
915         ERR( "not enough space in %s heap %04x for %d bytes\n",
916              get_heap_name(ds), ds, size );
917 #if 0
918         if ((pInfo->notify) &&
919         /* FIXME: "size" correct ? (should indicate bytes needed) */
920         (LOCAL_CallTo16_word_www(pInfo->notify, LN_OUTOFMEM, ds, size)))
921             goto notify_done;
922 #endif
923         return 0;
924     }
925
926       /* Make a block out of the free arena */
927     pArena = ARENA_PTR( ptr, arena );
928     TRACE("size = %04x, arena %04x size %04x\n",
929                   size, arena, pArena->size );
930     LOCAL_RemoveFreeBlock( ptr, arena );
931     LOCAL_ShrinkArena( ds, arena, size );
932
933     if (flags & LMEM_ZEROINIT)
934         memset((char *)pArena + ARENA_HEADER_SIZE, 0, size-ARENA_HEADER_SIZE);
935     return arena + ARENA_HEADER_SIZE;
936 }
937
938
939 /***********************************************************************
940  *           LOCAL_NewHTable
941  */
942 static BOOL16 LOCAL_NewHTable( HANDLE16 ds )
943 {
944     char *ptr = PTR_SEG_OFF_TO_LIN( ds, 0 );
945     LOCALHEAPINFO *pInfo;
946     LOCALHANDLEENTRY *pEntry;
947     HLOCAL16 handle;
948     int i;
949
950     TRACE("\n" );
951     if (!(pInfo = LOCAL_GetHeap( ds )))
952     {
953         ERR("Local heap not found\n");
954         LOCAL_PrintHeap(ds);
955         return FALSE;
956     }
957
958     if (!(handle = LOCAL_GetBlock( ds, pInfo->hdelta * sizeof(LOCALHANDLEENTRY)
959                                    + 2 * sizeof(WORD), LMEM_FIXED )))
960         return FALSE;
961     if (!(ptr = PTR_SEG_OFF_TO_LIN( ds, 0 )))
962         ERR("ptr == NULL after GetBlock.\n");
963     if (!(pInfo = LOCAL_GetHeap( ds )))
964         ERR("pInfo == NULL after GetBlock.\n");
965
966     /* Fill the entry table */
967
968     *(WORD *)(ptr + handle) = pInfo->hdelta;
969     pEntry = (LOCALHANDLEENTRY *)(ptr + handle + sizeof(WORD));
970     for (i = pInfo->hdelta; i > 0; i--, pEntry++) {
971         pEntry->lock = pEntry->flags = 0xff;
972         pEntry->addr = 0;
973     }
974     *(WORD *)pEntry = pInfo->htable;
975     pInfo->htable = handle;
976     return TRUE;
977 }
978
979
980 /***********************************************************************
981  *           LOCAL_GetNewHandleEntry
982  */
983 static HLOCAL16 LOCAL_GetNewHandleEntry( HANDLE16 ds )
984 {
985     char *ptr = PTR_SEG_OFF_TO_LIN( ds, 0 );
986     LOCALHEAPINFO *pInfo;
987     LOCALHANDLEENTRY *pEntry = NULL;
988     WORD table;
989
990     if (!(pInfo = LOCAL_GetHeap( ds )))
991     {
992         ERR("Local heap not found\n");
993         LOCAL_PrintHeap(ds);
994         return 0;
995     }
996
997     /* Find a free slot in existing tables */
998
999     table = pInfo->htable;
1000     while (table)
1001     {
1002         WORD count = *(WORD *)(ptr + table);
1003         pEntry = (LOCALHANDLEENTRY *)(ptr + table + sizeof(WORD));
1004         for (; count > 0; count--, pEntry++)
1005             if (pEntry->lock == 0xff) break;
1006         if (count) break;
1007         table = *(WORD *)pEntry;
1008     }
1009
1010     if (!table)  /* We need to create a new table */
1011     {
1012         if (!LOCAL_NewHTable( ds )) return 0;
1013         ptr = PTR_SEG_OFF_TO_LIN( ds, 0 );
1014         pInfo = LOCAL_GetHeap( ds );
1015         pEntry = (LOCALHANDLEENTRY *)(ptr + pInfo->htable + sizeof(WORD));
1016     }
1017
1018     /* Now allocate this entry */
1019
1020     pEntry->lock = 0;
1021     pEntry->flags = 0;
1022     TRACE("(%04x): %04x\n",
1023                    ds, ((char *)pEntry - ptr) );
1024     return (HLOCAL16)((char *)pEntry - ptr);
1025 }
1026
1027
1028 /***********************************************************************
1029  *           LOCAL_FreeHandleEntry
1030  *
1031  * Free a handle table entry.
1032  */
1033 static void LOCAL_FreeHandleEntry( HANDLE16 ds, HLOCAL16 handle )
1034 {
1035     char *ptr = PTR_SEG_OFF_TO_LIN( ds, 0 );
1036     LOCALHANDLEENTRY *pEntry = (LOCALHANDLEENTRY *)(ptr + handle);
1037     LOCALHEAPINFO *pInfo;
1038     WORD *pTable;
1039     WORD table, count, i;
1040
1041     if (!(pInfo = LOCAL_GetHeap( ds ))) return;
1042
1043     /* Find the table where this handle comes from */
1044
1045     pTable = &pInfo->htable;
1046     while (*pTable)
1047     {
1048         WORD size = (*(WORD *)(ptr + *pTable)) * sizeof(LOCALHANDLEENTRY);
1049         if ((handle >= *pTable + sizeof(WORD)) &&
1050             (handle < *pTable + sizeof(WORD) + size)) break;  /* Found it */
1051         pTable = (WORD *)(ptr + *pTable + sizeof(WORD) + size);
1052     }
1053     if (!*pTable)
1054     {
1055         ERR("Invalid entry %04x\n", handle);
1056         LOCAL_PrintHeap( ds );
1057         return;
1058     }
1059
1060     /* Make the entry free */
1061
1062     pEntry->addr = 0;  /* just in case */
1063     pEntry->lock = 0xff;
1064     pEntry->flags = 0xff; 
1065     /* Now check if all entries in this table are free */
1066
1067     table = *pTable;
1068     pEntry = (LOCALHANDLEENTRY *)(ptr + table + sizeof(WORD));
1069     count = *(WORD *)(ptr + table);
1070     for (i = count; i > 0; i--, pEntry++) if (pEntry->lock != 0xff) return;
1071     
1072     /* Remove the table from the linked list and free it */
1073
1074     TRACE("(%04x): freeing table %04x\n",
1075                    ds, table);
1076     *pTable = *(WORD *)pEntry;
1077     LOCAL_FreeArena( ds, ARENA_HEADER( table ) );
1078 }
1079
1080
1081 /***********************************************************************
1082  *           LOCAL_Free
1083  *
1084  * Implementation of LocalFree().
1085  */
1086 HLOCAL16 LOCAL_Free( HANDLE16 ds, HLOCAL16 handle )
1087 {
1088     char *ptr = PTR_SEG_OFF_TO_LIN( ds, 0 );
1089
1090     TRACE("%04x ds=%04x\n", handle, ds );
1091     
1092     if (!handle) { WARN("Handle is 0.\n" ); return 0; }
1093     if (HANDLE_FIXED( handle ))
1094     {
1095         if (!LOCAL_FreeArena( ds, ARENA_HEADER( handle ) )) return 0;  /* OK */
1096         else return handle;  /* couldn't free it */
1097     }
1098     else
1099     {
1100         LOCALHANDLEENTRY *pEntry = (LOCALHANDLEENTRY *)(ptr + handle);
1101         if (pEntry->flags != (LMEM_DISCARDED >> 8))
1102         {
1103             TRACE("real block at %04x\n",
1104                            pEntry->addr );
1105             if (LOCAL_FreeArena( ds, ARENA_HEADER(pEntry->addr) ))
1106                 return handle; /* couldn't free it */
1107         }
1108         LOCAL_FreeHandleEntry( ds, handle );
1109         return 0;  /* OK */
1110     }
1111 }
1112
1113
1114 /***********************************************************************
1115  *           LOCAL_Alloc
1116  *
1117  * Implementation of LocalAlloc().
1118  *
1119  */
1120 HLOCAL16 LOCAL_Alloc( HANDLE16 ds, WORD flags, WORD size )
1121 {
1122     char *ptr;
1123     HLOCAL16 handle;
1124     
1125     TRACE("%04x %d ds=%04x\n", flags, size, ds );
1126
1127     if(size > 0 && size <= 4) size = 5;
1128     if (flags & LMEM_MOVEABLE)
1129     {
1130         LOCALHANDLEENTRY *plhe;
1131         HLOCAL16 hmem;
1132
1133         if(size)
1134         {
1135             if (!(hmem = LOCAL_GetBlock( ds, size + sizeof(HLOCAL16), flags )))
1136                 return 0;
1137         }
1138         else /* We just need to allocate a discarded handle */
1139             hmem = 0;
1140         if (!(handle = LOCAL_GetNewHandleEntry( ds )))
1141         {
1142             WARN("Couldn't get handle.\n");
1143             if(hmem)
1144                 LOCAL_FreeArena( ds, ARENA_HEADER(hmem) );
1145             return 0;
1146         }
1147         ptr = PTR_SEG_OFF_TO_LIN( ds, 0 );
1148         plhe = (LOCALHANDLEENTRY *)(ptr + handle);
1149         plhe->lock = 0;
1150         if(hmem)
1151         {
1152             plhe->addr = hmem + sizeof(HLOCAL16);
1153             plhe->flags = (BYTE)((flags & 0x0f00) >> 8);
1154             *(HLOCAL16 *)(ptr + hmem) = handle;
1155         }
1156         else
1157         {
1158             plhe->addr = 0;
1159             plhe->flags = LMEM_DISCARDED >> 8;
1160         }
1161     }
1162     else /* FIXED */
1163     {
1164         if(!size)
1165             return 0;
1166         handle = LOCAL_GetBlock( ds, size, flags );
1167     }
1168     return handle;
1169 }
1170
1171
1172 /***********************************************************************
1173  *           LOCAL_ReAlloc
1174  *
1175  * Implementation of LocalReAlloc().
1176  */
1177 HLOCAL16 LOCAL_ReAlloc( HANDLE16 ds, HLOCAL16 handle, WORD size, WORD flags )
1178 {
1179     char *ptr = PTR_SEG_OFF_TO_LIN( ds, 0 );
1180     LOCALHEAPINFO *pInfo;
1181     LOCALARENA *pArena, *pNext;
1182     LOCALHANDLEENTRY *pEntry = NULL;
1183     WORD arena, oldsize;
1184     HLOCAL16 hmem, blockhandle;
1185     LONG nextarena;
1186
1187     if (!handle) return 0;
1188     if(HANDLE_MOVEABLE(handle) &&
1189      ((LOCALHANDLEENTRY *)(ptr + handle))->lock == 0xff) /* An unused handle */
1190         return 0;
1191
1192     TRACE("%04x %d %04x ds=%04x\n",
1193                    handle, size, flags, ds );
1194     if (!(pInfo = LOCAL_GetHeap( ds ))) return 0;
1195     
1196     if (HANDLE_FIXED( handle ))
1197         blockhandle = handle;
1198     else
1199     {
1200         pEntry = (LOCALHANDLEENTRY *) (ptr + handle);
1201         if(pEntry->flags == (LMEM_DISCARDED >> 8))
1202         {
1203             HLOCAL16 hl;
1204             if(pEntry->addr)
1205                 WARN("Dicarded block has non-zero addr.\n");
1206             TRACE("ReAllocating discarded block\n");
1207             if(size <= 4) size = 5;
1208             if (!(hl = LOCAL_GetBlock( ds, size + sizeof(HLOCAL16), flags)))
1209                 return 0;
1210             ptr = PTR_SEG_OFF_TO_LIN( ds, 0 );  /* Reload ptr */
1211             pEntry = (LOCALHANDLEENTRY *) (ptr + handle);
1212             pEntry->addr = hl + sizeof(HLOCAL16);
1213             pEntry->flags = 0;
1214             pEntry->lock = 0;
1215             *(HLOCAL16 *)(ptr + hl) = handle;
1216             return handle;
1217         }
1218         if (((blockhandle = pEntry->addr) & 3) != 2)
1219         {
1220             ERR("(%04x,%04x): invalid handle\n",
1221                      ds, handle );
1222             return 0;
1223         }
1224         if(*((HLOCAL16 *)(ptr + blockhandle) - 1) != handle) {
1225             ERR("Back ptr to handle is invalid\n");
1226             return 0;
1227         }
1228     }
1229
1230     if (flags & LMEM_MODIFY)
1231     {
1232         if (HANDLE_MOVEABLE(handle))
1233         {
1234             pEntry = (LOCALHANDLEENTRY *)(ptr + handle);
1235             pEntry->flags = (flags & 0x0f00) >> 8;
1236             TRACE("Changing flags to %x.\n", pEntry->flags);
1237         }
1238         return handle;
1239     }
1240
1241     if (!size)
1242     {
1243         if (flags & LMEM_MOVEABLE)
1244         {
1245             if (HANDLE_FIXED(handle))
1246             {
1247                 TRACE("Freeing fixed block.\n");
1248                 return LOCAL_Free( ds, handle );
1249             }
1250             else /* Moveable block */
1251             {
1252                 pEntry = (LOCALHANDLEENTRY *)(ptr + handle);
1253                 if (pEntry->lock == 0)
1254                 {
1255                     /* discards moveable blocks */
1256                     TRACE("Discarding block\n");
1257                     LOCAL_FreeArena(ds, ARENA_HEADER(pEntry->addr));
1258                     pEntry->addr = 0;
1259                     pEntry->flags = (LMEM_DISCARDED >> 8);
1260                     return handle;
1261                 }
1262             }
1263             return 0;
1264         }
1265         else if(flags == 0)
1266         {
1267             pEntry = (LOCALHANDLEENTRY *)(ptr + handle);
1268             if (pEntry->lock == 0)
1269             {
1270                 /* Frees block */
1271                 return LOCAL_Free( ds, handle );
1272             }
1273         }
1274         return 0;
1275     }
1276
1277     arena = ARENA_HEADER( blockhandle );
1278     TRACE("arena is %04x\n", arena );
1279     pArena = ARENA_PTR( ptr, arena );
1280
1281     if(size <= 4) size = 5;
1282     oldsize = pArena->next - arena - ARENA_HEADER_SIZE;
1283     nextarena = LALIGN(blockhandle + size);
1284
1285       /* Check for size reduction */
1286
1287     if (nextarena <= pArena->next)
1288     {
1289         TRACE("size reduction, making new free block\n");
1290         LOCAL_ShrinkArena(ds, arena, nextarena - arena);
1291         TRACE("returning %04x\n", handle );
1292         return handle;
1293     }
1294
1295       /* Check if the next block is free and large enough */
1296
1297     pNext = ARENA_PTR( ptr, pArena->next );
1298     if (((pNext->prev & 3) == LOCAL_ARENA_FREE) &&
1299         (nextarena <= pNext->next))
1300     {
1301         TRACE("size increase, making new free block\n");
1302         LOCAL_GrowArenaUpward(ds, arena, nextarena - arena);
1303         TRACE("returning %04x\n", handle );
1304         return handle;
1305     }
1306
1307     /* Now we have to allocate a new block, but not if (fixed block or locked
1308        block) and no LMEM_MOVEABLE */
1309
1310     if (!(flags & LMEM_MOVEABLE))
1311     {
1312         if (HANDLE_FIXED(handle))
1313         {
1314             ERR("Needed to move fixed block, but LMEM_MOVEABLE not specified.\n");
1315             return 0;
1316         }
1317         else
1318         {
1319             if(((LOCALHANDLEENTRY *)(ptr + handle))->lock != 0)
1320             {
1321                 ERR("Needed to move locked block, but LMEM_MOVEABLE not specified.\n");
1322                 return 0;
1323             }
1324         }
1325     }
1326     if(HANDLE_MOVEABLE(handle)) size += sizeof(HLOCAL16);
1327     hmem = LOCAL_GetBlock( ds, size, flags );
1328     ptr = PTR_SEG_OFF_TO_LIN( ds, 0 );  /* Reload ptr                             */
1329     if(HANDLE_MOVEABLE(handle))         /* LOCAL_GetBlock might have triggered    */
1330     {                                   /* a compaction, which might in turn have */
1331       blockhandle = pEntry->addr ;      /* moved the very block we are resizing   */
1332       arena = ARENA_HEADER( blockhandle );   /* thus, we reload arena, too        */
1333     }
1334     if (!hmem)
1335     {
1336         /* Remove the block from the heap and try again */
1337         LPSTR buffer = HeapAlloc( GetProcessHeap(), 0, oldsize );
1338         if (!buffer) return 0;
1339         memcpy( buffer, ptr + arena + ARENA_HEADER_SIZE, oldsize );
1340         LOCAL_FreeArena( ds, arena );
1341         if (!(hmem = LOCAL_GetBlock( ds, size, flags )))
1342         {
1343             if (!(hmem = LOCAL_GetBlock( ds, oldsize, flags )))
1344             {
1345                 ERR("Can't restore saved block\n" );
1346                 HeapFree( GetProcessHeap(), 0, buffer );
1347                 return 0;
1348             }
1349             size = oldsize;
1350         }
1351         ptr = PTR_SEG_OFF_TO_LIN( ds, 0 );  /* Reload ptr */
1352         memcpy( ptr + hmem, buffer, oldsize );
1353         HeapFree( GetProcessHeap(), 0, buffer );
1354     }
1355     else
1356     {
1357         memcpy( ptr + hmem, ptr + (arena + ARENA_HEADER_SIZE), oldsize );
1358         LOCAL_FreeArena( ds, arena );
1359     }
1360     if (HANDLE_MOVEABLE( handle ))
1361     {
1362         TRACE("fixing handle\n");
1363         pEntry = (LOCALHANDLEENTRY *)(ptr + handle);
1364         pEntry->addr = hmem + sizeof(HLOCAL16);
1365         /* Back ptr should still be correct */
1366         if(*(HLOCAL16 *)(ptr + hmem) != handle)
1367             ERR("back ptr is invalid.\n");
1368         hmem = handle;
1369     }
1370     if (size == oldsize) hmem = 0;  /* Realloc failed */
1371     TRACE("returning %04x\n", hmem );
1372     return hmem;
1373 }
1374
1375
1376 /***********************************************************************
1377  *           LOCAL_InternalLock
1378  */
1379 static HLOCAL16 LOCAL_InternalLock( LPSTR heap, HLOCAL16 handle )
1380 {
1381     HLOCAL16 old_handle = handle;
1382
1383     if (HANDLE_MOVEABLE(handle))
1384     {
1385         LOCALHANDLEENTRY *pEntry = (LOCALHANDLEENTRY *)(heap + handle);
1386         if (pEntry->flags == LMEM_DISCARDED) return 0;
1387         if (pEntry->lock < 0xfe) pEntry->lock++;
1388         handle = pEntry->addr;
1389     }
1390     TRACE("%04x returning %04x\n", 
1391                    old_handle, handle );
1392     return handle;
1393 }
1394
1395
1396 /***********************************************************************
1397  *           LOCAL_Lock
1398  */
1399 void *LOCAL_Lock( HANDLE16 ds, HLOCAL16 handle )
1400 {
1401     char *ptr = PTR_SEG_OFF_TO_LIN( ds, 0 );
1402     return handle ? ptr + LOCAL_InternalLock( ptr, handle ) : NULL;
1403 }
1404
1405
1406 /***********************************************************************
1407  *           LOCAL_Unlock
1408  */
1409 BOOL16 LOCAL_Unlock( HANDLE16 ds, HLOCAL16 handle )
1410 {
1411     char *ptr = PTR_SEG_OFF_TO_LIN( ds, 0 );
1412
1413     TRACE("%04x\n", handle );
1414     if (HANDLE_MOVEABLE(handle))
1415     {
1416         LOCALHANDLEENTRY *pEntry = (LOCALHANDLEENTRY *)(ptr + handle);
1417         if (!pEntry->lock || (pEntry->lock == 0xff)) return FALSE;
1418         /* For moveable block, return the new lock count */
1419         /* (see _Windows_Internals_ p. 197) */
1420         return --pEntry->lock;
1421     }
1422     else return FALSE;
1423 }
1424
1425
1426 /***********************************************************************
1427  *           LOCAL_Size
1428  *
1429  * Implementation of LocalSize().
1430  */
1431 WORD LOCAL_Size( HANDLE16 ds, HLOCAL16 handle )
1432 {
1433     char *ptr = PTR_SEG_OFF_TO_LIN( ds, 0 );
1434     LOCALARENA *pArena;
1435
1436     TRACE("%04x ds=%04x\n", handle, ds );
1437
1438     if (HANDLE_MOVEABLE( handle )) handle = *(WORD *)(ptr + handle);
1439     if (!handle) return 0;
1440     pArena = ARENA_PTR( ptr, ARENA_HEADER(handle) );
1441     return pArena->next - handle;
1442 }
1443
1444
1445 /***********************************************************************
1446  *           LOCAL_Flags
1447  *
1448  * Implementation of LocalFlags().
1449  */
1450 WORD LOCAL_Flags( HANDLE16 ds, HLOCAL16 handle )
1451 {
1452     char *ptr = PTR_SEG_OFF_TO_LIN( ds, 0 );
1453
1454     if (HANDLE_MOVEABLE(handle))
1455     {
1456         LOCALHANDLEENTRY *pEntry = (LOCALHANDLEENTRY *)(ptr + handle);
1457         TRACE("(%04x,%04x): returning %04x\n",
1458                        ds, handle, pEntry->lock | (pEntry->flags << 8) );
1459         return pEntry->lock | (pEntry->flags << 8);
1460     }
1461     else
1462     {
1463         TRACE("(%04x,%04x): returning 0\n",
1464                        ds, handle );
1465         return 0;
1466     }
1467 }
1468
1469
1470 /***********************************************************************
1471  *           LOCAL_HeapSize
1472  *
1473  * Implementation of LocalHeapSize().
1474  */
1475 WORD LOCAL_HeapSize( HANDLE16 ds )
1476 {
1477     LOCALHEAPINFO *pInfo = LOCAL_GetHeap( ds );
1478     if (!pInfo) return 0;
1479     return pInfo->last - pInfo->first;
1480 }
1481
1482
1483 /***********************************************************************
1484  *           LOCAL_CountFree
1485  *
1486  * Implementation of LocalCountFree().
1487  */
1488 WORD LOCAL_CountFree( HANDLE16 ds )
1489 {
1490     WORD arena, total;
1491     LOCALARENA *pArena;
1492     LOCALHEAPINFO *pInfo;
1493     char *ptr = PTR_SEG_OFF_TO_LIN( ds, 0 );
1494
1495     if (!(pInfo = LOCAL_GetHeap( ds )))
1496     {
1497         ERR("(%04x): Local heap not found\n", ds );
1498         LOCAL_PrintHeap( ds );
1499         return 0;
1500     }
1501
1502     total = 0;
1503     arena = pInfo->first;
1504     pArena = ARENA_PTR( ptr, arena );
1505     for (;;)
1506     {
1507         arena = pArena->free_next;
1508         pArena = ARENA_PTR( ptr, arena );
1509         if (arena == pArena->free_next) break;
1510         total += pArena->size;
1511     }
1512     TRACE("(%04x): returning %d\n", ds, total);
1513     return total;
1514 }
1515
1516
1517 /***********************************************************************
1518  *           LOCAL_Handle
1519  *
1520  * Implementation of LocalHandle().
1521  */
1522 HLOCAL16 LOCAL_Handle( HANDLE16 ds, WORD addr )
1523
1524     char *ptr = PTR_SEG_OFF_TO_LIN( ds, 0 );
1525     LOCALHEAPINFO *pInfo;
1526     WORD table;
1527
1528     if (!(pInfo = LOCAL_GetHeap( ds )))
1529     {
1530         ERR("(%04x): Local heap not found\n", ds );
1531         LOCAL_PrintHeap( ds );
1532         return 0;
1533     }
1534
1535     /* Find the address in the entry tables */
1536
1537     table = pInfo->htable;
1538     while (table)
1539     {
1540         WORD count = *(WORD *)(ptr + table);
1541         LOCALHANDLEENTRY *pEntry = (LOCALHANDLEENTRY*)(ptr+table+sizeof(WORD));
1542         for (; count > 0; count--, pEntry++)
1543             if (pEntry->addr == addr) return (HLOCAL16)((char *)pEntry - ptr);
1544         table = *(WORD *)pEntry;
1545     }
1546
1547     return (HLOCAL16)addr;  /* Fixed block handle is addr */
1548 }
1549
1550
1551 /***********************************************************************
1552  *           LocalAlloc16   (KERNEL.5)
1553  */
1554 HLOCAL16 WINAPI LocalAlloc16( UINT16 flags, WORD size )
1555 {
1556     HLOCAL16 ret = LOCAL_Alloc( CURRENT_DS, flags, size );
1557     CURRENT_STACK16->ecx = ret;  /* must be returned in cx too */
1558     return ret;
1559 }
1560
1561
1562 /***********************************************************************
1563  *           LocalReAlloc16   (KERNEL.6)
1564  */
1565 HLOCAL16 WINAPI LocalReAlloc16( HLOCAL16 handle, WORD size, UINT16 flags )
1566 {
1567     return LOCAL_ReAlloc( CURRENT_DS, handle, size, flags );
1568 }
1569
1570
1571 /***********************************************************************
1572  *           LocalFree16   (KERNEL.7)
1573  */
1574 HLOCAL16 WINAPI LocalFree16( HLOCAL16 handle )
1575 {
1576     return LOCAL_Free( CURRENT_DS, handle );
1577 }
1578
1579
1580 /***********************************************************************
1581  *           LocalLock16   (KERNEL.8)
1582  *
1583  * Note: only the offset part of the pointer is returned by the relay code.
1584  */
1585 SEGPTR WINAPI LocalLock16( HLOCAL16 handle )
1586 {
1587     WORD ds = CURRENT_DS;
1588     char *ptr = PTR_SEG_OFF_TO_LIN( ds, 0 );
1589     return PTR_SEG_OFF_TO_SEGPTR( ds, LOCAL_InternalLock( ptr, handle ) );
1590 }
1591
1592
1593 /***********************************************************************
1594  *           LocalUnlock16   (KERNEL.9)
1595  */
1596 BOOL16 WINAPI LocalUnlock16( HLOCAL16 handle )
1597 {
1598     return LOCAL_Unlock( CURRENT_DS, handle );
1599 }
1600
1601
1602 /***********************************************************************
1603  *           LocalSize16   (KERNEL.10)
1604  */
1605 UINT16 WINAPI LocalSize16( HLOCAL16 handle )
1606 {
1607     return LOCAL_Size( CURRENT_DS, handle );
1608 }
1609
1610
1611 /***********************************************************************
1612  *           LocalHandle16   (KERNEL.11)
1613  */
1614 HLOCAL16 WINAPI LocalHandle16( WORD addr )
1615
1616     return LOCAL_Handle( CURRENT_DS, addr );
1617 }
1618
1619
1620 /***********************************************************************
1621  *           LocalFlags16   (KERNEL.12)
1622  */
1623 UINT16 WINAPI LocalFlags16( HLOCAL16 handle )
1624 {
1625     return LOCAL_Flags( CURRENT_DS, handle );
1626 }
1627
1628
1629 /***********************************************************************
1630  *           LocalCompact16   (KERNEL.13)
1631  */
1632 UINT16 WINAPI LocalCompact16( UINT16 minfree )
1633 {
1634     TRACE("%04x\n", minfree );
1635     return LOCAL_Compact( CURRENT_DS, minfree, 0 );
1636 }
1637
1638
1639 /***********************************************************************
1640  *           LocalNotify   (KERNEL.14)
1641  *
1642  * Installs a callback function that is called for local memory events
1643  * Callback function prototype is
1644  * BOOL16 NotifyFunc(WORD wMsg, HLOCAL16 hMem, WORD wArg)
1645  * wMsg:
1646  * - LN_OUTOFMEM
1647  *   NotifyFunc seems to be responsible for allocating some memory,
1648  *   returns TRUE for success.
1649  *   wArg = number of bytes needed additionally
1650  * - LN_MOVE
1651  *   hMem = handle; wArg = old mem location
1652  * - LN_DISCARD
1653  *   NotifyFunc seems to be strongly encouraged to return TRUE,
1654  *   otherwise LogError() gets called.
1655  *   hMem = handle; wArg = flags
1656  */
1657 FARPROC16 WINAPI LocalNotify16( FARPROC16 func )
1658 {
1659     LOCALHEAPINFO *pInfo;
1660     FARPROC16 oldNotify;
1661     HANDLE16 ds = CURRENT_DS;
1662
1663     if (!(pInfo = LOCAL_GetHeap( ds )))
1664     {
1665         ERR("(%04x): Local heap not found\n", ds );
1666         LOCAL_PrintHeap( ds );
1667         return 0;
1668     }
1669     TRACE("(%04x): %08lx\n", ds, (DWORD)func );
1670     FIXME("Half implemented\n");
1671     oldNotify = pInfo->notify;
1672     pInfo->notify = func;
1673     return oldNotify;
1674 }
1675
1676
1677 /***********************************************************************
1678  *           LocalShrink16   (KERNEL.121)
1679  */
1680 UINT16 WINAPI LocalShrink16( HGLOBAL16 handle, UINT16 newsize )
1681 {
1682     TRACE("%04x %04x\n", handle, newsize );
1683     return 0;
1684 }
1685
1686
1687 /***********************************************************************
1688  *           GetHeapSpaces   (KERNEL.138)
1689  */
1690 DWORD WINAPI GetHeapSpaces16( HMODULE16 module )
1691 {
1692     NE_MODULE *pModule;
1693     WORD ds;
1694
1695     if (!(pModule = NE_GetPtr( module ))) return 0;
1696     ds =
1697     GlobalHandleToSel16((NE_SEG_TABLE( pModule ) + pModule->dgroup - 1)->hSeg);
1698     return MAKELONG( LOCAL_CountFree( ds ), LOCAL_HeapSize( ds ) );
1699 }
1700
1701
1702 /***********************************************************************
1703  *           LocalCountFree   (KERNEL.161)
1704  */
1705 WORD WINAPI LocalCountFree16(void)
1706 {
1707     return LOCAL_CountFree( CURRENT_DS );
1708 }
1709
1710
1711 /***********************************************************************
1712  *           LocalHeapSize   (KERNEL.162)
1713  */
1714 WORD WINAPI LocalHeapSize16(void)
1715 {
1716     TRACE("(void)\n" );
1717     return LOCAL_HeapSize( CURRENT_DS );
1718 }
1719
1720
1721 /***********************************************************************
1722  *           LocalHandleDelta   (KERNEL.310)
1723  */
1724 WORD WINAPI LocalHandleDelta16( WORD delta )
1725 {
1726     LOCALHEAPINFO *pInfo;
1727
1728     if (!(pInfo = LOCAL_GetHeap( CURRENT_DS )))
1729     {
1730         ERR("Local heap not found\n");
1731         LOCAL_PrintHeap( CURRENT_DS );
1732         return 0;
1733     }
1734     if (delta) pInfo->hdelta = delta;
1735     TRACE("returning %04x\n", pInfo->hdelta);
1736     return pInfo->hdelta;
1737 }
1738
1739
1740 /***********************************************************************
1741  *           LocalInfo   (TOOLHELP.56)
1742  */
1743 BOOL16 WINAPI LocalInfo16( LOCALINFO *pLocalInfo, HGLOBAL16 handle )
1744 {
1745     LOCALHEAPINFO *pInfo = LOCAL_GetHeap(SELECTOROF(WIN16_GlobalLock16(handle)));
1746     if (!pInfo) return FALSE;
1747     pLocalInfo->wcItems = pInfo->items;
1748     return TRUE;
1749 }
1750
1751
1752 /***********************************************************************
1753  *           LocalFirst   (TOOLHELP.57)
1754  */
1755 BOOL16 WINAPI LocalFirst16( LOCALENTRY *pLocalEntry, HGLOBAL16 handle )
1756 {
1757     WORD ds = GlobalHandleToSel16( handle );
1758     char *ptr = PTR_SEG_OFF_TO_LIN( ds, 0 );
1759     LOCALHEAPINFO *pInfo = LOCAL_GetHeap( ds );
1760     if (!pInfo) return FALSE;
1761
1762     pLocalEntry->hHandle   = pInfo->first + ARENA_HEADER_SIZE;
1763     pLocalEntry->wAddress  = pLocalEntry->hHandle;
1764     pLocalEntry->wFlags    = LF_FIXED;
1765     pLocalEntry->wcLock    = 0;
1766     pLocalEntry->wType     = LT_NORMAL;
1767     pLocalEntry->hHeap     = handle;
1768     pLocalEntry->wHeapType = NORMAL_HEAP;
1769     pLocalEntry->wNext     = ARENA_PTR(ptr,pInfo->first)->next;
1770     pLocalEntry->wSize     = pLocalEntry->wNext - pLocalEntry->hHandle;
1771     return TRUE;
1772 }
1773
1774
1775 /***********************************************************************
1776  *           LocalNext   (TOOLHELP.58)
1777  */
1778 BOOL16 WINAPI LocalNext16( LOCALENTRY *pLocalEntry )
1779 {
1780     WORD ds = GlobalHandleToSel16( pLocalEntry->hHeap );
1781     char *ptr = PTR_SEG_OFF_TO_LIN( ds, 0 );
1782     LOCALARENA *pArena;
1783
1784     if (!LOCAL_GetHeap( ds )) return FALSE;
1785     if (!pLocalEntry->wNext) return FALSE;
1786     pArena = ARENA_PTR( ptr, pLocalEntry->wNext );
1787
1788     pLocalEntry->hHandle   = pLocalEntry->wNext + ARENA_HEADER_SIZE;
1789     pLocalEntry->wAddress  = pLocalEntry->hHandle;
1790     pLocalEntry->wFlags    = (pArena->prev & 3) + 1;
1791     pLocalEntry->wcLock    = 0;
1792     pLocalEntry->wType     = LT_NORMAL;
1793     if (pArena->next != pLocalEntry->wNext)  /* last one? */
1794         pLocalEntry->wNext = pArena->next;
1795     else
1796         pLocalEntry->wNext = 0;
1797     pLocalEntry->wSize     = pLocalEntry->wNext - pLocalEntry->hHandle;
1798     return TRUE;
1799 }
1800
1801
1802 /***********************************************************************
1803  *           LocalAlloc   (KERNEL32.371)
1804  * RETURNS
1805  *      Handle: Success
1806  *      NULL: Failure
1807  */
1808 HLOCAL WINAPI LocalAlloc(
1809                 UINT flags, /* [in] Allocation attributes */
1810                 DWORD size    /* [in] Number of bytes to allocate */
1811 ) {
1812     return (HLOCAL)GlobalAlloc( flags, size );
1813 }
1814
1815
1816 /***********************************************************************
1817  *           LocalCompact   (KERNEL32.372)
1818  */
1819 UINT WINAPI LocalCompact( UINT minfree )
1820 {
1821     return 0;  /* LocalCompact does nothing in Win32 */
1822 }
1823
1824
1825 /***********************************************************************
1826  *           LocalFlags   (KERNEL32.374)
1827  * RETURNS
1828  *      Value specifying allocation flags and lock count.
1829  *      LMEM_INVALID_HANDLE: Failure
1830  */
1831 UINT WINAPI LocalFlags(
1832               HLOCAL handle /* [in] Handle of memory object */
1833 ) {
1834     return GlobalFlags( (HGLOBAL)handle );
1835 }
1836
1837
1838 /***********************************************************************
1839  *           LocalFree   (KERNEL32.375)
1840  * RETURNS
1841  *      NULL: Success
1842  *      Handle: Failure
1843  */
1844 HLOCAL WINAPI LocalFree(
1845                 HLOCAL handle /* [in] Handle of memory object */
1846 ) {
1847     return (HLOCAL)GlobalFree( (HGLOBAL)handle );
1848 }
1849
1850
1851 /***********************************************************************
1852  *           LocalHandle   (KERNEL32.376)
1853  * RETURNS
1854  *      Handle: Success
1855  *      NULL: Failure
1856  */
1857 HLOCAL WINAPI LocalHandle(
1858                 LPCVOID ptr /* [in] Address of local memory object */
1859 ) {
1860     return (HLOCAL)GlobalHandle( ptr );
1861 }
1862
1863
1864 /***********************************************************************
1865  *           LocalLock   (KERNEL32.377)
1866  * Locks a local memory object and returns pointer to the first byte
1867  * of the memory block.
1868  *
1869  * RETURNS
1870  *      Pointer: Success
1871  *      NULL: Failure
1872  */
1873 LPVOID WINAPI LocalLock(
1874               HLOCAL handle /* [in] Address of local memory object */
1875 ) {
1876     return GlobalLock( (HGLOBAL)handle );
1877 }
1878
1879
1880 /***********************************************************************
1881  *           LocalReAlloc   (KERNEL32.378)
1882  * RETURNS
1883  *      Handle: Success
1884  *      NULL: Failure
1885  */
1886 HLOCAL WINAPI LocalReAlloc(
1887                 HLOCAL handle, /* [in] Handle of memory object */
1888                 DWORD size,      /* [in] New size of block */
1889                 UINT flags     /* [in] How to reallocate object */
1890 ) {
1891     return (HLOCAL)GlobalReAlloc( (HGLOBAL)handle, size, flags );
1892 }
1893
1894
1895 /***********************************************************************
1896  *           LocalShrink   (KERNEL32.379)
1897  */
1898 UINT WINAPI LocalShrink( HGLOBAL handle, UINT newsize )
1899 {
1900     return 0;  /* LocalShrink does nothing in Win32 */
1901 }
1902
1903
1904 /***********************************************************************
1905  *           LocalSize   (KERNEL32.380)
1906  * RETURNS
1907  *      Size: Success
1908  *      0: Failure
1909  */
1910 UINT WINAPI LocalSize(
1911               HLOCAL handle /* [in] Handle of memory object */
1912 ) {
1913     return GlobalSize( (HGLOBAL)handle );
1914 }
1915
1916
1917 /***********************************************************************
1918  *           LocalUnlock   (KERNEL32.381)
1919  * RETURNS
1920  *      TRUE: Object is still locked
1921  *      FALSE: Object is unlocked
1922  */
1923 BOOL WINAPI LocalUnlock(
1924               HLOCAL handle /* [in] Handle of memory object */
1925 ) {
1926     return GlobalUnlock( (HGLOBAL)handle );
1927 }