/*********************************************************/

/*  ptycon: a pty-console bridge                         */

/*  Copyright (C) 2016  Z. Gilboa                        */

/*  Released under GPLv2 and GPLv3; see COPYING.PTYCON.  */

/*********************************************************/

#include <stddef.h>

#include <ntapi/ntapi.h>

#include "ptycon_memfn_impl.h"

#include "ptycon_driver_impl.h"

void * ptyc_calloc(size_t n, size_t size)

{

	struct ptyc_memory_block block;

	if (!n || (size > (size_t)(-1) / n))

		return 0;

	size *= n;

	size += 0xf;

	size &= ~(size_t)0xf;

	block.addr = 0;

	block.size = size + sizeof(block);

	if (ntapi->zw_allocate_virtual_memory(

			NT_CURRENT_PROCESS_HANDLE,

			&block.addr,

			0,

			&block.size,

			NT_MEM_COMMIT,

			NT_PAGE_READWRITE))

		return 0;

	block.used  = size;

	block.avail = block.size - block.used;

	return (char *)block.addr + offsetof(struct ptyc_memory_block,buffer);

}

void * ptyc_balloc(

	struct ptyc_memory_block * cache,

	struct ptyc_memory_block * block,

	size_t n, size_t size)

{

	char * baddr;

	void * addr = 0;

	if (!n || (size > (size_t)(-1) / n))

		return 0;

	if (!cache || !cache->addr)

		addr = ptyc_calloc(n,size);

	size *= n;

	size += 0xf;

	size &= ~(size_t)0xf;

	if (size < block->avail)

		addr = ptyc_calloc(n,size);

	/* newly allocated block? */

	if (addr) {

		baddr  = addr;

		baddr -= offsetof(struct ptyc_memory_block,buffer);

		ntapi->tt_aligned_block_memcpy(

			(uintptr_t *)block,

			(uintptr_t *)baddr,

			sizeof(*block));

		return addr;

	}

	/* cache */

	addr = &block->buffer[block->used / sizeof(size_t)];

	block->used  += size;

	block->avail -= size;

	return addr;

}

void ptyc_free(void * addr)

{

	struct ptyc_memory_block block;

	block.addr = addr;

	block.size = 0;

	ntapi->zw_free_virtual_memory(

		NT_CURRENT_PROCESS_HANDLE,

		&block.addr,

		&block.size,

		NT_MEM_RELEASE);

}