#include <vhex/display.h>
#include <vhex/defs/utils.h>
#include <vhex/defs/types.h>

/* Vhex vram */
extern uint16_t vhex_vram[];

/* dhline(): Optimized horizontal line */
void dhline(int x1, int x2, int y, int color)
{
	/* Order and bounds */
	if((uint)y >= 224) return;
	if(x1 > x2) swap(x1, x2);
	if(x1 >= 396 || x2 < 0) return;
	if(x1 < 0) x1 = 0;
	if(x2 >= 396) x2 = 395;

	int offset = 396 * y;

	/* Use longwords to do the copy, but first paint the endpoints to heed
	   for odd x1 and x2. Checking the parity may be a waste of time. */
	vhex_vram[offset + x1] = color;
	vhex_vram[offset + x2] = color;

	/* Now round to longword boundaries and copy everything in-between with
	   longwords */
	x1 = x1 + (x1 & 1);
	x2 = (x2 + 1) & ~1;

	uint32_t *start = (void *)(vhex_vram + offset + x1);
	uint32_t *end   = (void *)(vhex_vram + offset + x2);
	uint32_t op = (color << 16) | color;

	while(end > start) *--end = op;
}

/* dvline(): Optimized vertical line */
void dvline(int y1, int y2, int x, int color)
{
	/* Order and bounds */
	if((uint)x >= 396) return;
	if(y1 > y2) swap(y1, y2);
	if(y1 < 0) y1 = 0;
	if(y2 >= 224) y2 = 223;

	uint16_t *v = vhex_vram + 396 * y1 + x;
	int height = y2 - y1 + 1;

	while(height-- > 0) *v = color, v += 396;
}