PokittoLib - PokittoLib is the library needed for programming …

Users » spinal » Code » PokittoLib

PokittoLib is the library needed for programming the Pokitto DIY game console (www.pokitto.com)

POKITTO_CORE/PokittoDisplay.cpp@15:0bbe8f6fae32, 2017-10-18 (annotated)

Committer:: spinal
Date:: Wed Oct 18 14:47:54 2017 +0000
Revision:: 15:0bbe8f6fae32
Parent:: 7:72f87b7c7400

direct lcd stuff used by sensitive

Who changed what in which revision?

User	Revision	Line number	New contents of line
Pokitto	7:72f87b7c7400	1	/**************************************************************************/
Pokitto	7:72f87b7c7400	2	/*!
Pokitto	7:72f87b7c7400	3	@file PokittoDisplay.cpp
Pokitto	7:72f87b7c7400	4	@author Jonne Valola
Pokitto	7:72f87b7c7400	5
Pokitto	7:72f87b7c7400	6	@section LICENSE
Pokitto	7:72f87b7c7400	7
Pokitto	7:72f87b7c7400	8	Software License Agreement (BSD License)
Pokitto	7:72f87b7c7400	9
Pokitto	7:72f87b7c7400	10	Copyright (c) 2016, Jonne Valola
Pokitto	7:72f87b7c7400	11	All rights reserved.
Pokitto	7:72f87b7c7400	12
Pokitto	7:72f87b7c7400	13	Redistribution and use in source and binary forms, with or without
Pokitto	7:72f87b7c7400	14	modification, are permitted provided that the following conditions are met:
Pokitto	7:72f87b7c7400	15	1. Redistributions of source code must retain the above copyright
Pokitto	7:72f87b7c7400	16	notice, this list of conditions and the following disclaimer.
Pokitto	7:72f87b7c7400	17	2. Redistributions in binary form must reproduce the above copyright
Pokitto	7:72f87b7c7400	18	notice, this list of conditions and the following disclaimer in the
Pokitto	7:72f87b7c7400	19	documentation and/or other materials provided with the distribution.
Pokitto	7:72f87b7c7400	20	3. Neither the name of the copyright holders nor the
Pokitto	7:72f87b7c7400	21	names of its contributors may be used to endorse or promote products
Pokitto	7:72f87b7c7400	22	derived from this software without specific prior written permission.
Pokitto	7:72f87b7c7400	23
Pokitto	7:72f87b7c7400	24	THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS ''AS IS'' AND ANY
Pokitto	7:72f87b7c7400	25	EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
Pokitto	7:72f87b7c7400	26	WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
Pokitto	7:72f87b7c7400	27	DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER BE LIABLE FOR ANY
Pokitto	7:72f87b7c7400	28	DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
Pokitto	7:72f87b7c7400	29	(INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
Pokitto	7:72f87b7c7400	30	LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
Pokitto	7:72f87b7c7400	31	ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
Pokitto	7:72f87b7c7400	32	(INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
Pokitto	7:72f87b7c7400	33	SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
Pokitto	7:72f87b7c7400	34	*/
Pokitto	7:72f87b7c7400	35	/**************************************************************************/
Pokitto	7:72f87b7c7400	36
Pokitto	7:72f87b7c7400	37
Pokitto	7:72f87b7c7400	38	/* THE SEGMENT BELOW PERTAINS TO CIRCLE DRAWING FUNCTIONS ONLY
Pokitto	7:72f87b7c7400	39	*
Pokitto	7:72f87b7c7400	40	This is the core graphics library for all our displays, providing a common
Pokitto	7:72f87b7c7400	41	set of graphics primitives (points, lines, circles, etc.). It needs to be
Pokitto	7:72f87b7c7400	42	paired with a hardware-specific library for each display device we carry
Pokitto	7:72f87b7c7400	43	(to handle the lower-level functions).
Pokitto	7:72f87b7c7400	44	Adafruit invests time and resources providing this open source code, please
Pokitto	7:72f87b7c7400	45	support Adafruit & open-source hardware by purchasing products from Adafruit!
Pokitto	7:72f87b7c7400	46	Copyright (c) 2013 Adafruit Industries. All rights reserved.
Pokitto	7:72f87b7c7400	47	Redistribution and use in source and binary forms, with or without
Pokitto	7:72f87b7c7400	48	modification, are permitted provided that the following conditions are met:
Pokitto	7:72f87b7c7400	49	- Redistributions of source code must retain the above copyright notice,
Pokitto	7:72f87b7c7400	50	this list of conditions and the following disclaimer.
Pokitto	7:72f87b7c7400	51	- Redistributions in binary form must reproduce the above copyright notice,
Pokitto	7:72f87b7c7400	52	this list of conditions and the following disclaimer in the documentation
Pokitto	7:72f87b7c7400	53	and/or other materials provided with the distribution.
Pokitto	7:72f87b7c7400	54	THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
Pokitto	7:72f87b7c7400	55	AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
Pokitto	7:72f87b7c7400	56	IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
Pokitto	7:72f87b7c7400	57	ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
Pokitto	7:72f87b7c7400	58	LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
Pokitto	7:72f87b7c7400	59	CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
Pokitto	7:72f87b7c7400	60	SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
Pokitto	7:72f87b7c7400	61	INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
Pokitto	7:72f87b7c7400	62	CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
Pokitto	7:72f87b7c7400	63	ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
Pokitto	7:72f87b7c7400	64	POSSIBILITY OF SUCH DAMAGE.
Pokitto	7:72f87b7c7400	65	*/
Pokitto	7:72f87b7c7400	66
Pokitto	7:72f87b7c7400	67	#include "PokittoDisplay.h"
Pokitto	7:72f87b7c7400	68	#include "Pokitto_settings.h"
Pokitto	7:72f87b7c7400	69	#include "GBcompatibility.h"
Pokitto	7:72f87b7c7400	70	#include "PokittoCore.h"
Pokitto	7:72f87b7c7400	71	#include "PokittoSound.h"
Pokitto	7:72f87b7c7400	72	#include <stdio.h>
Pokitto	7:72f87b7c7400	73	#include <string.h>
Pokitto	7:72f87b7c7400	74
Pokitto	7:72f87b7c7400	75	#ifndef POK_SIM
Pokitto	7:72f87b7c7400	76	#include "HWLCD.h"
Pokitto	7:72f87b7c7400	77	#else
Pokitto	7:72f87b7c7400	78	#include "SimLCD.h"
Pokitto	7:72f87b7c7400	79	#endif
Pokitto	7:72f87b7c7400	80
Pokitto	7:72f87b7c7400	81	Pokitto::Core core;
Pokitto	7:72f87b7c7400	82	Pokitto::Sound sound;
Pokitto	7:72f87b7c7400	83
Pokitto	7:72f87b7c7400	84	using namespace Pokitto;
Pokitto	7:72f87b7c7400	85
Pokitto	7:72f87b7c7400	86
Pokitto	7:72f87b7c7400	87
Pokitto	7:72f87b7c7400	88	uint8_t* Display::m_scrbuf;
Pokitto	7:72f87b7c7400	89	uint8_t* Display::m_tileset;
Pokitto	7:72f87b7c7400	90	uint8_t* Display::m_tilebuf;
Pokitto	7:72f87b7c7400	91	uint8_t* Display::m_tilecolorbuf;
Pokitto	7:72f87b7c7400	92	uint8_t Display::m_mode, Display::m_colordepth;
Pokitto	7:72f87b7c7400	93	uint8_t Display::fontSize=1;
Pokitto	7:72f87b7c7400	94	int16_t Display::cursorX,Display::cursorY;
Pokitto	7:72f87b7c7400	95	uint16_t Display::m_w,Display::m_h;
Pokitto	7:72f87b7c7400	96	uint8_t Display::fontWidth, Display::fontHeight;
Pokitto	7:72f87b7c7400	97	bool Display::textWrap=true;
Pokitto	7:72f87b7c7400	98
Pokitto	7:72f87b7c7400	99	uint8_t Display::persistence = 0;
Pokitto	7:72f87b7c7400	100	uint16_t Display::color = 1;
Pokitto	7:72f87b7c7400	101	uint16_t Display::bgcolor = 0;
Pokitto	7:72f87b7c7400	102	uint16_t Display::invisiblecolor = 17;
Pokitto	7:72f87b7c7400	103	uint16_t Display::directcolor=0xFFFF;
Pokitto	7:72f87b7c7400	104	uint16_t Display::directbgcolor=0x0;
Pokitto	7:72f87b7c7400	105
Pokitto	7:72f87b7c7400	106	uint16_t* Display::paletteptr;
Pokitto	7:72f87b7c7400	107	uint16_t Display::palette[PALETTE_SIZE];
Pokitto	7:72f87b7c7400	108	const unsigned char* Display::font;
Pokitto	7:72f87b7c7400	109	int8_t Display::adjustCharStep = 1;
Pokitto	7:72f87b7c7400	110	int8_t Display::adjustLineStep = 1;
Pokitto	7:72f87b7c7400	111	bool Display::fixedWidthFont = false;
Pokitto	7:72f87b7c7400	112
Pokitto	7:72f87b7c7400	113	/ drawing canvas /
Pokitto	7:72f87b7c7400	114	//uint8_t* Display::canvas; // points to the active buffer. if null, draw direct to screen
Pokitto	7:72f87b7c7400	115
Pokitto	7:72f87b7c7400	116	/ screenbuffer /
Pokitto	7:72f87b7c7400	117	uint8_t Display::bpp = POK_COLORDEPTH;
Pokitto	7:72f87b7c7400	118	#ifndef POK_TILEDMODE
Pokitto	7:72f87b7c7400	119	#if (POK_SCREENMODE == MODE_HI_MONOCHROME)
Pokitto	7:72f87b7c7400	120	uint8_t Display::width = POK_LCD_W;
Pokitto	7:72f87b7c7400	121	uint8_t Display::height = POK_LCD_H;
Pokitto	7:72f87b7c7400	122	uint8_t Display::screenbuffer[((POK_LCD_H+1)POK_LCD_W)POK_COLORDEPTH/8]; // maximum resolution
Pokitto	7:72f87b7c7400	123	#elif (POK_SCREENMODE == MODE_HI_4COLOR)
Pokitto	7:72f87b7c7400	124	uint8_t Display::width = POK_LCD_W;
Pokitto	7:72f87b7c7400	125	uint8_t Display::height = POK_LCD_H;
Pokitto	7:72f87b7c7400	126	uint8_t __attribute__((section (".bss"))) Display::screenbuffer[((POK_LCD_H)*POK_LCD_W)/4]; // maximum resolution
Pokitto	7:72f87b7c7400	127	#elif (POK_SCREENMODE == MODE_FAST_16COLOR)
Pokitto	7:72f87b7c7400	128	uint8_t Display::width = POK_LCD_W/2;
Pokitto	7:72f87b7c7400	129	uint8_t Display::height = POK_LCD_H/2;
Pokitto	7:72f87b7c7400	130	uint8_t Display::screenbuffer[(((POK_LCD_H/2)+1)POK_LCD_W/2)POK_COLORDEPTH/8]; // half resolution
Pokitto	7:72f87b7c7400	131	#elif (POK_SCREENMODE == MODE_HI_16COLOR)
Pokitto	7:72f87b7c7400	132	uint8_t Display::width = POK_LCD_W;
Pokitto	7:72f87b7c7400	133	uint8_t Display::height = POK_LCD_H;
Pokitto	7:72f87b7c7400	134	uint8_t Display::screenbuffer[POK_LCD_H*POK_LCD_W/2]; // 4 bits per pixel
Pokitto	7:72f87b7c7400	135	#elif (POK_SCREENMODE == MODE_LAMENES)
Pokitto	7:72f87b7c7400	136	uint8_t Display::width = 128;
Pokitto	7:72f87b7c7400	137	uint8_t Display::height = 120;
Pokitto	7:72f87b7c7400	138	uint8_t Display::screenbuffer[((121)128)POK_COLORDEPTH/8]; // half resolution
Pokitto	7:72f87b7c7400	139	#elif (POK_SCREENMODE == MODE_GAMEBOY)
Pokitto	7:72f87b7c7400	140	uint8_t Display::width = 160;
Pokitto	7:72f87b7c7400	141	uint8_t Display::height = 144;
Pokitto	7:72f87b7c7400	142	uint8_t Display::screenbuffer[160*144/4];
Pokitto	7:72f87b7c7400	143	#else
Pokitto	7:72f87b7c7400	144	uint8_t Display::width = 84;
Pokitto	7:72f87b7c7400	145	uint8_t Display::height = 48;
Pokitto	7:72f87b7c7400	146	uint8_t Display::screenbuffer[128*64]; // not needed because Gamebuino and Arduboy have their own buffer
Pokitto	7:72f87b7c7400	147	#endif
Pokitto	7:72f87b7c7400	148	#else //Tiledmode
Pokitto	7:72f87b7c7400	149	#if (POK_SCREENMODE == MODE_TILED_1BIT)
Pokitto	7:72f87b7c7400	150	uint8_t Display::width = POK_LCD_W;
Pokitto	7:72f87b7c7400	151	uint8_t Display::height = POK_LCD_H;
Pokitto	7:72f87b7c7400	152	uint8_t Display::screenbuffer[0];
Pokitto	7:72f87b7c7400	153	#else
Pokitto	7:72f87b7c7400	154	uint8_t Display::width = POK_LCD_W;
Pokitto	7:72f87b7c7400	155	uint8_t Display::height = POK_LCD_H;
Pokitto	7:72f87b7c7400	156	uint8_t Display::screenbuffer[0];
Pokitto	7:72f87b7c7400	157	#endif
Pokitto	7:72f87b7c7400	158	#endif //tiledmode
Pokitto	7:72f87b7c7400	159
Pokitto	7:72f87b7c7400	160	// RLE decoding
Pokitto	7:72f87b7c7400	161	#define RLE_ESC_EOL 0
Pokitto	7:72f87b7c7400	162	#define RLE_ESC_EOB 1
Pokitto	7:72f87b7c7400	163	#define RLE_ESC_OFFSET 2
Pokitto	7:72f87b7c7400	164
Pokitto	7:72f87b7c7400	165	Display::Display() {
Pokitto	7:72f87b7c7400	166	m_scrbuf = screenbuffer;
Pokitto	7:72f87b7c7400	167	setDefaultPalette();
Pokitto	7:72f87b7c7400	168	m_mode = 1; // direct printing on by default
Pokitto	7:72f87b7c7400	169	m_w = POK_LCD_W;
Pokitto	7:72f87b7c7400	170	m_h = POK_LCD_H;
Pokitto	7:72f87b7c7400	171	setFont(DEFAULT_FONT);
Pokitto	7:72f87b7c7400	172	invisiblecolor=17;
Pokitto	7:72f87b7c7400	173	bgcolor=0;
Pokitto	7:72f87b7c7400	174	if (POK_COLORDEPTH) m_colordepth = POK_COLORDEPTH;
Pokitto	7:72f87b7c7400	175	else m_colordepth = 4;
Pokitto	7:72f87b7c7400	176	#if POK_GAMEBUINO_SUPPORT
Pokitto	7:72f87b7c7400	177	setColorDepth(1);
Pokitto	7:72f87b7c7400	178	#endif // POK_GAMEBUINO_SUPPORT
Pokitto	7:72f87b7c7400	179	}
Pokitto	7:72f87b7c7400	180
Pokitto	7:72f87b7c7400	181	uint16_t Display::getWidth() {
Pokitto	7:72f87b7c7400	182	return width;
Pokitto	7:72f87b7c7400	183	}
Pokitto	7:72f87b7c7400	184
Pokitto	7:72f87b7c7400	185	uint8_t Display::getNumberOfColors() {
Pokitto	7:72f87b7c7400	186	return 1<<POK_COLORDEPTH;
Pokitto	7:72f87b7c7400	187	}
Pokitto	7:72f87b7c7400	188
Pokitto	7:72f87b7c7400	189	uint16_t Display::getHeight() {
Pokitto	7:72f87b7c7400	190	return height;
Pokitto	7:72f87b7c7400	191	}
Pokitto	7:72f87b7c7400	192
Pokitto	7:72f87b7c7400	193	uint8_t Display::getColorDepth() {
Pokitto	7:72f87b7c7400	194	return m_colordepth;
Pokitto	7:72f87b7c7400	195	}
Pokitto	7:72f87b7c7400	196
Pokitto	7:72f87b7c7400	197	void Display::setColorDepth(uint8_t v) {
Pokitto	7:72f87b7c7400	198	if (v > POK_COLORDEPTH) v=POK_COLORDEPTH;
Pokitto	7:72f87b7c7400	199	m_colordepth = v;
Pokitto	7:72f87b7c7400	200	}
Pokitto	7:72f87b7c7400	201
Pokitto	7:72f87b7c7400	202	void Display::clearLCD() {
Pokitto	7:72f87b7c7400	203	lcdFillSurface(0);
Pokitto	7:72f87b7c7400	204	setCursor(0,0); // old basic computer style
Pokitto	7:72f87b7c7400	205	}
Pokitto	7:72f87b7c7400	206
Pokitto	7:72f87b7c7400	207	void Display::fillLCD(uint16_t c) {
Pokitto	7:72f87b7c7400	208	lcdFillSurface(c);
Pokitto	7:72f87b7c7400	209	}
Pokitto	7:72f87b7c7400	210
Pokitto	7:72f87b7c7400	211	void Display::directPixel(int16_t x, int16_t y, uint16_t color) {
Pokitto	7:72f87b7c7400	212	lcdPixel(x,y,color);
Pokitto	7:72f87b7c7400	213	}
Pokitto	7:72f87b7c7400	214
spinal	15:0bbe8f6fae32	215	void Display::directTile(int16_t x, int16_t y, int16_t x2, int16_t y2, uint16_t* gfx) {
spinal	15:0bbe8f6fae32	216	lcdTile(x,y,x2,y2,gfx);
spinal	15:0bbe8f6fae32	217	}
spinal	15:0bbe8f6fae32	218
Pokitto	7:72f87b7c7400	219	void Display::directRectangle(int16_t x, int16_t y,int16_t x2, int16_t y2, uint16_t color) {
Pokitto	7:72f87b7c7400	220	lcdRectangle(x,y,x2,y2,color);
Pokitto	7:72f87b7c7400	221	}
Pokitto	7:72f87b7c7400	222
Pokitto	7:72f87b7c7400	223	void Display::begin() {
Pokitto	7:72f87b7c7400	224	lcdInit();
Pokitto	7:72f87b7c7400	225	}
Pokitto	7:72f87b7c7400	226
Pokitto	7:72f87b7c7400	227	void Display::setCursor(int16_t x,int16_t y) {
Pokitto	7:72f87b7c7400	228	cursorX = x;
Pokitto	7:72f87b7c7400	229	cursorY = y;
Pokitto	7:72f87b7c7400	230	}
Pokitto	7:72f87b7c7400	231
Pokitto	7:72f87b7c7400	232	void Display::update() {
Pokitto	7:72f87b7c7400	233
Pokitto	7:72f87b7c7400	234	#if POK_SCREENMODE == MODE_GAMEBOY
Pokitto	7:72f87b7c7400	235	lcdRefreshModeGBC(m_scrbuf, paletteptr);
Pokitto	7:72f87b7c7400	236	#endif
Pokitto	7:72f87b7c7400	237
Pokitto	7:72f87b7c7400	238	#if POK_SCREENMODE == MODE_HI_4COLOR
Pokitto	7:72f87b7c7400	239	lcdRefreshMode1(m_scrbuf, paletteptr);
Pokitto	7:72f87b7c7400	240	#endif
Pokitto	7:72f87b7c7400	241
Pokitto	7:72f87b7c7400	242	#if POK_SCREENMODE == MODE_HI_16COLOR
Pokitto	7:72f87b7c7400	243	lcdRefreshMode3(m_scrbuf, paletteptr);
Pokitto	7:72f87b7c7400	244	#endif
Pokitto	7:72f87b7c7400	245
Pokitto	7:72f87b7c7400	246	#if POK_SCREENMODE == MODE_FAST_16COLOR
Pokitto	7:72f87b7c7400	247	lcdRefreshMode2(m_scrbuf, paletteptr);
Pokitto	7:72f87b7c7400	248	#endif
Pokitto	7:72f87b7c7400	249
Pokitto	7:72f87b7c7400	250	#if POK_SCREENMODE == MODE_GAMEBUINO_16COLOR
Pokitto	7:72f87b7c7400	251	lcdRefreshGB(m_scrbuf, paletteptr);
Pokitto	7:72f87b7c7400	252	#endif
Pokitto	7:72f87b7c7400	253
Pokitto	7:72f87b7c7400	254	#if POK_SCREENMODE == MODE_ARDUBOY_16COLOR
Pokitto	7:72f87b7c7400	255	lcdRefreshAB(m_scrbuf, paletteptr);
Pokitto	7:72f87b7c7400	256	#endif
Pokitto	7:72f87b7c7400	257
Pokitto	7:72f87b7c7400	258	#if POK_SCREENMODE == MODE_TILED_1BIT
Pokitto	7:72f87b7c7400	259	lcdRefreshT1(m_tilebuf, m_tilecolorbuf, m_tileset, paletteptr);
Pokitto	7:72f87b7c7400	260	#endif
Pokitto	7:72f87b7c7400	261
Pokitto	7:72f87b7c7400	262	if (!persistence) clear();
Pokitto	7:72f87b7c7400	263
Pokitto	7:72f87b7c7400	264	/ draw volume bar if visible /
Pokitto	7:72f87b7c7400	265	#if POK_SHOW_VOLUME > 0
Pokitto	7:72f87b7c7400	266	if (core.volbar_visible) {
Pokitto	7:72f87b7c7400	267	core.drawvolbar(4,20,sound.getVolume(),true);
Pokitto	7:72f87b7c7400	268	core.volbar_visible--;
Pokitto	7:72f87b7c7400	269	}
Pokitto	7:72f87b7c7400	270	#endif // POK_SHOW_VOLUME
Pokitto	7:72f87b7c7400	271
Pokitto	7:72f87b7c7400	272	}
Pokitto	7:72f87b7c7400	273
Pokitto	7:72f87b7c7400	274	void Display::directBitmap(int16_t x, int16_t y, const uint8_t *bitmap, uint8_t depth, uint8_t scale) {
Pokitto	7:72f87b7c7400	275	uint8_t w = *bitmap;
Pokitto	7:72f87b7c7400	276	uint8_t h = *(bitmap + 1);
Pokitto	7:72f87b7c7400	277	bitmap = bitmap + 2; //add an offset to the pointer to start after the width and height
Pokitto	7:72f87b7c7400	278	int16_t i, j;
Pokitto	7:72f87b7c7400	279	int8_t byteNum, bitNum, byteWidth = (w + 7) >> 3;
Pokitto	7:72f87b7c7400	280
Pokitto	7:72f87b7c7400	281	if (depth == 1) {
Pokitto	7:72f87b7c7400	282	for (i = 0; i < w; i++) {
Pokitto	7:72f87b7c7400	283	byteNum = i / 8;
Pokitto	7:72f87b7c7400	284	bitNum = i % 8;
Pokitto	7:72f87b7c7400	285	for (j = 0; j < h; j++) {
Pokitto	7:72f87b7c7400	286	if ((bitmap + j byteWidth + byteNum) & (0x80 >> bitNum)) { //0x80 = B10000000
Pokitto	7:72f87b7c7400	287	if (scale==1) directPixel(x + i, y + j,directcolor);
Pokitto	7:72f87b7c7400	288	else {
Pokitto	7:72f87b7c7400	289	directPixel(x + i + i, y + j + j,directcolor);
Pokitto	7:72f87b7c7400	290	directPixel(x + 1 + i + i, y + j + j,directcolor);
Pokitto	7:72f87b7c7400	291	directPixel(x + i + i, y + j + j + 1,directcolor);
Pokitto	7:72f87b7c7400	292	directPixel(x + i + i + 1 , y + j + j + 1,directcolor);
Pokitto	7:72f87b7c7400	293	}
Pokitto	7:72f87b7c7400	294	}
Pokitto	7:72f87b7c7400	295	}
Pokitto	7:72f87b7c7400	296	}
Pokitto	7:72f87b7c7400	297	} else if (depth == 4) {
Pokitto	7:72f87b7c7400	298	for (j = 0; j < h; j+=1) {
Pokitto	7:72f87b7c7400	299	for (i = 0; i < w; i+=2) {
Pokitto	7:72f87b7c7400	300	uint16_t col = paletteptr[*bitmap>>4]; //higher nibble
Pokitto	7:72f87b7c7400	301	if (scale==2) {
Pokitto	7:72f87b7c7400	302	directPixel(x + (i<<1), y + (j<<1),col);
Pokitto	7:72f87b7c7400	303	directPixel(x + (i<<1) + 1, y + (j<<1),col);
Pokitto	7:72f87b7c7400	304	directPixel(x + (i<<1) + 1, y + (j<<1) + 1,col);
Pokitto	7:72f87b7c7400	305	directPixel(x + (i<<1), y + (j<<1) + 1,col);
Pokitto	7:72f87b7c7400	306	} else directPixel(x + i, y + j,col);
Pokitto	7:72f87b7c7400	307	col = paletteptr[*bitmap&0xF]; // lower nibble
Pokitto	7:72f87b7c7400	308	if (scale==2) {
Pokitto	7:72f87b7c7400	309	directPixel(x + (i<<1) + 2, y + (j<<1),col);
Pokitto	7:72f87b7c7400	310	directPixel(x + (i<<1) + 1 + 2, y + (j<<1),col);
Pokitto	7:72f87b7c7400	311	directPixel(x + (i<<1) + 1 + 2, y + (j<<1) + 1,col);
Pokitto	7:72f87b7c7400	312	directPixel(x + (i<<1) + 2 , y + (j<<1) + 1,col);
Pokitto	7:72f87b7c7400	313	} else directPixel(x + i + 1, y + j,col);
Pokitto	7:72f87b7c7400	314	bitmap++;
Pokitto	7:72f87b7c7400	315	}
Pokitto	7:72f87b7c7400	316	}
Pokitto	7:72f87b7c7400	317	}
Pokitto	7:72f87b7c7400	318
Pokitto	7:72f87b7c7400	319	}
Pokitto	7:72f87b7c7400	320
Pokitto	7:72f87b7c7400	321	int Display::directChar(int16_t x, int16_t y, uint16_t index){
Pokitto	7:72f87b7c7400	322	const uint8_t* bitmap = font;
Pokitto	7:72f87b7c7400	323	uint8_t w = *bitmap;
Pokitto	7:72f87b7c7400	324	uint8_t h = *(bitmap + 1);
Pokitto	7:72f87b7c7400	325	uint8_t hbytes=0, xtra=1;
Pokitto	7:72f87b7c7400	326	if (h==8 \|\| h==16) xtra=0; //don't add if exactly on byte limit
Pokitto	7:72f87b7c7400	327	hbytes=(h>>3)+xtra; //GLCD fonts are arranged w+1 times h/8 bytes
Pokitto	7:72f87b7c7400	328	//bitmap = bitmap + 3 + index * h * ((w>>3)+xtra); //add an offset to the pointer (fonts !)
Pokitto	7:72f87b7c7400	329	bitmap = bitmap + 4 + index * (w * hbytes + 1); //add an offset to the pointer (fonts !)
Pokitto	7:72f87b7c7400	330	//int8_t i, j, byteNum, bitNum, byteWidth = (w + 7) >> 3;
Pokitto	7:72f87b7c7400	331	int8_t i, j, numBytes;
Pokitto	7:72f87b7c7400	332	numBytes = *bitmap++; //first byte of char is the width in bytes
Pokitto	7:72f87b7c7400	333	// GLCD fonts are arranged LSB = topmost pixel of char, so its easy to just shift through the column
Pokitto	7:72f87b7c7400	334	uint16_t bitcolumn; //16 bits for 2x8 bit high characters
Pokitto	7:72f87b7c7400	335
Pokitto	7:72f87b7c7400	336	for (i = 0; i < numBytes; i++) {
Pokitto	7:72f87b7c7400	337	bitcolumn = *bitmap++;
Pokitto	7:72f87b7c7400	338	if (hbytes == 2) bitcolumn \|= (*bitmap++)<<8; // add second byte for 16 bit high fonts
Pokitto	7:72f87b7c7400	339	for (j = 0; j < h; j++) {
Pokitto	7:72f87b7c7400	340	if (bitcolumn&0x1) {
Pokitto	7:72f87b7c7400	341	if (fontSize==2) {
Pokitto	7:72f87b7c7400	342	directPixel(x + (i<<1) , y + (j<<1),directcolor);
Pokitto	7:72f87b7c7400	343	directPixel(x + (i<<1)+1, y + (j<<1),directcolor);
Pokitto	7:72f87b7c7400	344	directPixel(x + (i<<1) , y + (j<<1)+1,directcolor);
Pokitto	7:72f87b7c7400	345	directPixel(x + (i<<1)+1, y + (j<<1)+1,directcolor);
Pokitto	7:72f87b7c7400	346	} else directPixel(x + i, y + j,directcolor);
Pokitto	7:72f87b7c7400	347	} else if (directbgcolor != invisiblecolor) {
Pokitto	7:72f87b7c7400	348	if (fontSize==2) {
Pokitto	7:72f87b7c7400	349	directPixel(x + (i<<1) , y + (j<<1),directbgcolor);
Pokitto	7:72f87b7c7400	350	directPixel(x + (i<<1)+1, y + (j<<1),directbgcolor);
Pokitto	7:72f87b7c7400	351	directPixel(x + (i<<1) , y + (j<<1)+1,directbgcolor);
Pokitto	7:72f87b7c7400	352	directPixel(x + (i<<1)+1, y + (j<<1)+1,directbgcolor);
Pokitto	7:72f87b7c7400	353	} else directPixel(x + i, y + j,directbgcolor);
Pokitto	7:72f87b7c7400	354	}
Pokitto	7:72f87b7c7400	355	bitcolumn>>=1;
Pokitto	7:72f87b7c7400	356	}
Pokitto	7:72f87b7c7400	357	}
Pokitto	7:72f87b7c7400	358	return (numBytes+adjustCharStep)*fontSize; // for character stepping
Pokitto	7:72f87b7c7400	359	}
Pokitto	7:72f87b7c7400	360
Pokitto	7:72f87b7c7400	361	int Display::bufferChar(int16_t x, int16_t y, uint16_t index){
Pokitto	7:72f87b7c7400	362	const uint8_t* bitmap = font;
Pokitto	7:72f87b7c7400	363	uint8_t w = *bitmap;
Pokitto	7:72f87b7c7400	364	uint8_t h = *(bitmap + 1);
Pokitto	7:72f87b7c7400	365	uint8_t hbytes=0, xtra=1;
Pokitto	7:72f87b7c7400	366	if (h==8 \|\| h==16) xtra=0; //don't add if exactly on byte limit
Pokitto	7:72f87b7c7400	367	hbytes=(h>>3)+xtra; //GLCD fonts are arranged w+1 times h/8 bytes
Pokitto	7:72f87b7c7400	368	//bitmap = bitmap + 3 + index * h * ((w>>3)+xtra); //add an offset to the pointer (fonts !)
Pokitto	7:72f87b7c7400	369	bitmap = bitmap + 4 + index * (w * hbytes + 1); //add an offset to the pointer (fonts !)
Pokitto	7:72f87b7c7400	370	//int8_t i, j, byteNum, bitNum, byteWidth = (w + 7) >> 3;
Pokitto	7:72f87b7c7400	371	int8_t i, j, numBytes;
Pokitto	7:72f87b7c7400	372	numBytes = *bitmap++; //first byte of char is the width in bytes
Pokitto	7:72f87b7c7400	373	// GLCD fonts are arranged LSB = topmost pixel of char, so its easy to just shift through the column
Pokitto	7:72f87b7c7400	374	uint16_t bitcolumn; //16 bits for 2x8 bit high characters
Pokitto	7:72f87b7c7400	375
Pokitto	7:72f87b7c7400	376	for (i = 0; i < numBytes; i++) {
Pokitto	7:72f87b7c7400	377	bitcolumn = *bitmap++;
Pokitto	7:72f87b7c7400	378	if (hbytes == 2) bitcolumn \|= (*bitmap++)<<8; // add second byte for 16 bit high fonts
Pokitto	7:72f87b7c7400	379	for (j = 0; j <= h; j++) { // was j<=h
Pokitto	7:72f87b7c7400	380	#if PROJ_ARDUBOY > 0
Pokitto	7:72f87b7c7400	381	if (bitcolumn&0x1) {
Pokitto	7:72f87b7c7400	382	drawPixel(x + i, y + 7 - j,color);
Pokitto	7:72f87b7c7400	383	} else drawPixel(x + i, y + 7 - j,bgcolor);
Pokitto	7:72f87b7c7400	384	bitcolumn>>=1;
Pokitto	7:72f87b7c7400	385	#else
Pokitto	7:72f87b7c7400	386	if (bitcolumn&0x1) {
Pokitto	7:72f87b7c7400	387	drawPixel(x + i, y + j,color);
Pokitto	7:72f87b7c7400	388	} else drawPixel(x + i, y + j,bgcolor);
Pokitto	7:72f87b7c7400	389	bitcolumn>>=1;
Pokitto	7:72f87b7c7400	390	#endif // PROJ_ARDUBOY
Pokitto	7:72f87b7c7400	391
Pokitto	7:72f87b7c7400	392	}
Pokitto	7:72f87b7c7400	393	}
Pokitto	7:72f87b7c7400	394
Pokitto	7:72f87b7c7400	395	return numBytes+adjustCharStep; // for character stepping
Pokitto	7:72f87b7c7400	396	}
Pokitto	7:72f87b7c7400	397
Pokitto	7:72f87b7c7400	398	void Display::clear() {
Pokitto	7:72f87b7c7400	399
Pokitto	7:72f87b7c7400	400	uint8_t c=0;
Pokitto	7:72f87b7c7400	401	c = bgcolor & (PALETTE_SIZE-1) ; //don't let palette go out of bounds
Pokitto	7:72f87b7c7400	402	if (bpp==1 && bgcolor) c=0xFF; // bgcolor !=0, set all pixels
Pokitto	7:72f87b7c7400	403	else if (bpp==2) {
Pokitto	7:72f87b7c7400	404	c = bgcolor & 0x3;
Pokitto	7:72f87b7c7400	405	c = c \| (c << 2);
Pokitto	7:72f87b7c7400	406	c = c \| (c << 4);
Pokitto	7:72f87b7c7400	407	} else {
Pokitto	7:72f87b7c7400	408	c = (c & 0x0F) \| (c << 4);
Pokitto	7:72f87b7c7400	409	}
Pokitto	7:72f87b7c7400	410	uint16_t j = sizeof(screenbuffer);
Pokitto	7:72f87b7c7400	411	memset((void*)m_scrbuf,c,j);
Pokitto	7:72f87b7c7400	412
Pokitto	7:72f87b7c7400	413	setCursor(0,0);
Pokitto	7:72f87b7c7400	414
Pokitto	7:72f87b7c7400	415	}
Pokitto	7:72f87b7c7400	416
Pokitto	7:72f87b7c7400	417	void Display::scroll(int16_t pixelrows) {
Pokitto	7:72f87b7c7400	418	uint16_t index = 0, index2,oc;
Pokitto	7:72f87b7c7400	419	if (pixelrows==0) return;
Pokitto	7:72f87b7c7400	420	if (pixelrows >= height) pixelrows=height-1;
Pokitto	7:72f87b7c7400	421	if (bpp == 4) index2 = pixelrows*width/2;
Pokitto	7:72f87b7c7400	422	else if (bpp == 2) index2 = pixelrows*width/4;
Pokitto	7:72f87b7c7400	423	else return;
Pokitto	7:72f87b7c7400	424	oc = color;
Pokitto	7:72f87b7c7400	425	color = bgcolor;
Pokitto	7:72f87b7c7400	426	if (pixelrows>0) {
Pokitto	7:72f87b7c7400	427	for (uint16_t y=0;y<height-pixelrows;y++) {
Pokitto	7:72f87b7c7400	428	for (uint16_t x=0;x<(width/8)*bpp;x++) screenbuffer[index++]=screenbuffer[index2++];
Pokitto	7:72f87b7c7400	429	}
Pokitto	7:72f87b7c7400	430	fillRect(0,cursorY,width,height);
Pokitto	7:72f87b7c7400	431	} else {
Pokitto	7:72f87b7c7400	432	for (uint16_t y=pixelrows;y<height;y++) {
Pokitto	7:72f87b7c7400	433	for (uint16_t x=0;x<(width*bpp)/8;x++) screenbuffer[index2++]=screenbuffer[index2];
Pokitto	7:72f87b7c7400	434	}
Pokitto	7:72f87b7c7400	435	fillRect(0,0,width,pixelrows);
Pokitto	7:72f87b7c7400	436	}
Pokitto	7:72f87b7c7400	437	color=oc;
Pokitto	7:72f87b7c7400	438	}
Pokitto	7:72f87b7c7400	439
Pokitto	7:72f87b7c7400	440	void Display::fillScreen(uint16_t c) {
Pokitto	7:72f87b7c7400	441	c = c & (PALETTE_SIZE-1) ; //don't let palette go out of bounds
Pokitto	7:72f87b7c7400	442	if (bpp==1 && c) c=0xFF; // set all pixels
Pokitto	7:72f87b7c7400	443	else if (bpp==2) {
Pokitto	7:72f87b7c7400	444	c = bgcolor & 0x3;
Pokitto	7:72f87b7c7400	445	c = c \| (c << 2);
Pokitto	7:72f87b7c7400	446	c = c \| (c << 4);
Pokitto	7:72f87b7c7400	447	} else {
Pokitto	7:72f87b7c7400	448	c = (c & 0x0F) \| (c << 4);
Pokitto	7:72f87b7c7400	449	}
Pokitto	7:72f87b7c7400	450	memset((void*)m_scrbuf,c,sizeof(screenbuffer));
Pokitto	7:72f87b7c7400	451	}
Pokitto	7:72f87b7c7400	452
Pokitto	7:72f87b7c7400	453	void Display::setDefaultPalette() {
Pokitto	7:72f87b7c7400	454	#if PICOPALETTE
Pokitto	7:72f87b7c7400	455	loadRGBPalette(palettePico);
Pokitto	7:72f87b7c7400	456	#else
Pokitto	7:72f87b7c7400	457	loadRGBPalette(POK_DEFAULT_PALETTE);
Pokitto	7:72f87b7c7400	458	#endif //PICOPALETTE
Pokitto	7:72f87b7c7400	459	}
Pokitto	7:72f87b7c7400	460
Pokitto	7:72f87b7c7400	461	void Display::setColor(uint8_t c) {
Pokitto	7:72f87b7c7400	462	color = c & ((1<<POK_COLORDEPTH)-1); // cut out colors that go above palette limit
Pokitto	7:72f87b7c7400	463	}
Pokitto	7:72f87b7c7400	464
Pokitto	7:72f87b7c7400	465	void Display::setColor(uint8_t c,uint8_t bgc){
Pokitto	7:72f87b7c7400	466	color = c & ((1<<POK_COLORDEPTH)-1); // cut out colors that go above palette limit
Pokitto	7:72f87b7c7400	467	bgcolor = bgc & ((1<<POK_COLORDEPTH)-1); // cut out colors that go above palette limit
Pokitto	7:72f87b7c7400	468	}
Pokitto	7:72f87b7c7400	469
Pokitto	7:72f87b7c7400	470	void Display::setInvisibleColor(uint16_t c){
Pokitto	7:72f87b7c7400	471	invisiblecolor = c; // invisible color can have values beyond 255 for identification purposes
Pokitto	7:72f87b7c7400	472	}
Pokitto	7:72f87b7c7400	473
Pokitto	7:72f87b7c7400	474	uint8_t Display::getColor() {
Pokitto	7:72f87b7c7400	475	return color;
Pokitto	7:72f87b7c7400	476	}
Pokitto	7:72f87b7c7400	477
Pokitto	7:72f87b7c7400	478	uint8_t Display::getBgColor() {
Pokitto	7:72f87b7c7400	479	return bgcolor;
Pokitto	7:72f87b7c7400	480	}
Pokitto	7:72f87b7c7400	481
Pokitto	7:72f87b7c7400	482	uint16_t Display::getInvisibleColor() {
Pokitto	7:72f87b7c7400	483	return invisiblecolor;
Pokitto	7:72f87b7c7400	484	}
Pokitto	7:72f87b7c7400	485
Pokitto	7:72f87b7c7400	486	void Display::drawPixel(int16_t x,int16_t y, uint8_t col) {
Pokitto	7:72f87b7c7400	487	if (col==invisiblecolor) return; // do not draw transparent pixels
Pokitto	7:72f87b7c7400	488	if ((uint16_t)x >= width \|\| (uint16_t)y >= height) return;
Pokitto	7:72f87b7c7400	489	col &= (PALETTE_SIZE-1);
Pokitto	7:72f87b7c7400	490	#if POK_GAMEBUINO_SUPPORT >0
Pokitto	7:72f87b7c7400	491
Pokitto	7:72f87b7c7400	492	uint8_t c = col;
Pokitto	7:72f87b7c7400	493	uint8_t ct = col;
Pokitto	7:72f87b7c7400	494
Pokitto	7:72f87b7c7400	495	uint16_t bitptr=0;
Pokitto	7:72f87b7c7400	496	for (uint8_t cbit=0;cbit<POK_COLORDEPTH;cbit++) {
Pokitto	7:72f87b7c7400	497	c = ct & 1; // take the lowest bit of the color index number
Pokitto	7:72f87b7c7400	498	if(c == 0){ //white - or actually "Clear bit"
Pokitto	7:72f87b7c7400	499	m_scrbuf[x + (y / 8) * LCDWIDTH + bitptr] &= ~_BV(y % 8);
Pokitto	7:72f87b7c7400	500	} else { //black - or actually "Set bit"
Pokitto	7:72f87b7c7400	501	m_scrbuf[x + (y / 8) * LCDWIDTH + bitptr] \|= _BV(y % 8);
Pokitto	7:72f87b7c7400	502	}
Pokitto	7:72f87b7c7400	503	ct >>=1; // shift to get next bit
Pokitto	7:72f87b7c7400	504	bitptr += POK_BITFRAME; // move one screen worth of buffer forward to get to the next color bit
Pokitto	7:72f87b7c7400	505	} // POK_COLOURDEPTH
Pokitto	7:72f87b7c7400	506
Pokitto	7:72f87b7c7400	507	#else
Pokitto	7:72f87b7c7400	508	#if POK_COLORDEPTH == 1
Pokitto	7:72f87b7c7400	509	if (col) {m_scrbuf[(y >> 3) * width + x] \|= (0x80 >> (y & 7)); return;}
Pokitto	7:72f87b7c7400	510	m_scrbuf[(y >> 3) * width + x] &= ~(0x80 >> (y & 7));
Pokitto	7:72f87b7c7400	511	#elif POK_COLORDEPTH == 2
Pokitto	7:72f87b7c7400	512	if (col) {
Pokitto	7:72f87b7c7400	513	col &= 3;
Pokitto	7:72f87b7c7400	514	}
Pokitto	7:72f87b7c7400	515	uint16_t i = y*(width>>2) + (x>>2);
Pokitto	7:72f87b7c7400	516	uint8_t pixel = m_scrbuf[i];
Pokitto	7:72f87b7c7400	517	uint8_t column = x&0x03;
Pokitto	7:72f87b7c7400	518	if (column==3) pixel = (pixel&0xFC)\|(col); // bits 0-1
Pokitto	7:72f87b7c7400	519	else if (column==2) pixel = (pixel&0xF3)\|(col<<2); // bits 2-3
Pokitto	7:72f87b7c7400	520	else if (column==1) pixel = (pixel&0xCF)\|(col<<4); // bits 4-5
Pokitto	7:72f87b7c7400	521	else pixel = (pixel&0x3F)\|(col<<6); // bits 6-7
Pokitto	7:72f87b7c7400	522	m_scrbuf[i] = pixel;
Pokitto	7:72f87b7c7400	523	#elif POK_COLORDEPTH == 3
Pokitto	7:72f87b7c7400	524	#elif POK_COLORDEPTH == 4
Pokitto	7:72f87b7c7400	525	uint16_t i = y*(width>>1) + (x>>1);
Pokitto	7:72f87b7c7400	526	uint8_t pixel = m_scrbuf[i];
Pokitto	7:72f87b7c7400	527	if (x&1) pixel = (pixel&0xF0)\|(col);
Pokitto	7:72f87b7c7400	528	else pixel = (pixel&0x0F) \| (col<<4);
Pokitto	7:72f87b7c7400	529	m_scrbuf[i] = pixel;
Pokitto	7:72f87b7c7400	530	#endif // POK_COLORDEPTH
Pokitto	7:72f87b7c7400	531	#endif // POK_GAMEBUINO_SUPPORT
Pokitto	7:72f87b7c7400	532	}
Pokitto	7:72f87b7c7400	533
Pokitto	7:72f87b7c7400	534	void Display::drawPixel(int16_t x,int16_t y) {
Pokitto	7:72f87b7c7400	535	if ((uint16_t)x >= width \|\| (uint16_t)y >= height) return;
Pokitto	7:72f87b7c7400	536
Pokitto	7:72f87b7c7400	537	#if POK_GAMEBUINO_SUPPORT > 0
Pokitto	7:72f87b7c7400	538
Pokitto	7:72f87b7c7400	539	uint8_t c = color;
Pokitto	7:72f87b7c7400	540	uint8_t ct = color;
Pokitto	7:72f87b7c7400	541	if(ct == INVERT){
Pokitto	7:72f87b7c7400	542	ct = !getPixel(x, y); //jonne - was c = !getP...
Pokitto	7:72f87b7c7400	543	}
Pokitto	7:72f87b7c7400	544
Pokitto	7:72f87b7c7400	545	uint16_t bitptr=0;
Pokitto	7:72f87b7c7400	546	for (uint8_t cbit=0;cbit<POK_COLORDEPTH;cbit++) {
Pokitto	7:72f87b7c7400	547	c = ct & 1; // take the lowest bit of the color index number
Pokitto	7:72f87b7c7400	548	if(c == 0){ //white - or actually "Clear bit"
Pokitto	7:72f87b7c7400	549	#if DISPLAY_ROT == NOROT
Pokitto	7:72f87b7c7400	550	m_scrbuf[x + (y / 8) * LCDWIDTH + bitptr] &= ~_BV(y % 8);
Pokitto	7:72f87b7c7400	551	#elif DISPLAY_ROT == ROTCCW
Pokitto	7:72f87b7c7400	552	m_scrbuf[LCDHEIGHT - y - 1 + (x / 8) * LCDWIDTH_NOROT + bitptr] &= ~_BV(x % 8);
Pokitto	7:72f87b7c7400	553	#elif DISPLAY_ROT == ROT180
Pokitto	7:72f87b7c7400	554	m_scrbuf[LCDWIDTH - x - 1 + ((LCDHEIGHT - y - 1) / 8) * LCDWIDTH_NOROT + bitptr] &= ~_BV((LCDHEIGHT - y - 1) % 8);
Pokitto	7:72f87b7c7400	555	#elif DISPLAY_ROT == ROTCW
Pokitto	7:72f87b7c7400	556	m_scrbuf[y + ((LCDWIDTH - x - 1) / 8) * LCDWIDTH_NOROT + bitbtr] &= ~_BV((LCDWIDTH - x - 1) % 8);
Pokitto	7:72f87b7c7400	557	#endif
Pokitto	7:72f87b7c7400	558	//return; //jonne
Pokitto	7:72f87b7c7400	559	} else { //black - or actually "Set bit"
Pokitto	7:72f87b7c7400	560	#if DISPLAY_ROT == NOROT
Pokitto	7:72f87b7c7400	561	m_scrbuf[x + (y / 8) * LCDWIDTH + bitptr] \|= _BV(y % 8);
Pokitto	7:72f87b7c7400	562	#elif DISPLAY_ROT == ROTCCW
Pokitto	7:72f87b7c7400	563	m_scrbuf[LCDHEIGHT - y - 1 + (x / 8) * LCDWIDTH_NOROT + bitptr] \|= _BV(x % 8);
Pokitto	7:72f87b7c7400	564	#elif DISPLAY_ROT == ROT180
Pokitto	7:72f87b7c7400	565	m_scrbuf[LCDWIDTH - x - 1 + ((LCDHEIGHT - y - 1) / 8) * LCDWIDTH_NOROT + bitptr] \|= _BV((LCDHEIGHT - y - 1) % 8);
Pokitto	7:72f87b7c7400	566	#elif DISPLAY_ROT == ROTCW
Pokitto	7:72f87b7c7400	567	m_scrbuf[y + ((LCDWIDTH - x - 1) / 8) * LCDWIDTH_NOROT + bitptr] \|= _BV((LCDWIDTH - x -1) % 8);
Pokitto	7:72f87b7c7400	568	#endif
Pokitto	7:72f87b7c7400	569	//return; //jonne
Pokitto	7:72f87b7c7400	570	}
Pokitto	7:72f87b7c7400	571	ct >>=1; // shift to get next bit
Pokitto	7:72f87b7c7400	572	bitptr += POK_BITFRAME; // move one screen worth of buffer forward to get to the next color bit
Pokitto	7:72f87b7c7400	573	} // POK_COLOURDEPTH
Pokitto	7:72f87b7c7400	574
Pokitto	7:72f87b7c7400	575	#else
Pokitto	7:72f87b7c7400	576
Pokitto	7:72f87b7c7400	577	/** NOT Gamebuino */
Pokitto	7:72f87b7c7400	578	#if POK_COLORDEPTH == 1
Pokitto	7:72f87b7c7400	579	if (color) {m_scrbuf[(y >> 3) * width + x] \|= (0x80 >> (y & 7)); return;}
Pokitto	7:72f87b7c7400	580	m_scrbuf[(y >> 3) * width + x] &= ~(0x80 >> (y & 7));
Pokitto	7:72f87b7c7400	581	#elif POK_COLORDEPTH == 2
Pokitto	7:72f87b7c7400	582	uint16_t i = y*(width>>2) + (x>>2);
Pokitto	7:72f87b7c7400	583	uint8_t pixel = m_scrbuf[i];
Pokitto	7:72f87b7c7400	584	uint8_t column = x&0x03;
Pokitto	7:72f87b7c7400	585	if (column==3) pixel = (pixel&0xFC)\|(color); // bits 0-1
Pokitto	7:72f87b7c7400	586	else if (column==2) pixel = (pixel&0xF3)\|(color<<2); // bits 2-3
Pokitto	7:72f87b7c7400	587	else if (column==1) pixel = (pixel&0xCF)\|(color<<4); // bits 4-5
Pokitto	7:72f87b7c7400	588	else pixel = (pixel&0x3F)\|(color<<6); // bits 6-7
Pokitto	7:72f87b7c7400	589	m_scrbuf[i] = pixel;
Pokitto	7:72f87b7c7400	590	#elif POK_COLORDEPTH == 3
Pokitto	7:72f87b7c7400	591	#elif POK_COLORDEPTH == 4
Pokitto	7:72f87b7c7400	592	uint16_t i = y*(width>>1) + (x>>1);
Pokitto	7:72f87b7c7400	593	uint8_t pixel = m_scrbuf[i];
Pokitto	7:72f87b7c7400	594	if (x&1) pixel = (pixel&0xF0)\|(color);
Pokitto	7:72f87b7c7400	595	else pixel = (pixel&0x0F) \| (color<<4);
Pokitto	7:72f87b7c7400	596	m_scrbuf[i] = pixel;
Pokitto	7:72f87b7c7400	597	#endif // POK_COLORDEPTH
Pokitto	7:72f87b7c7400	598	#endif // POK_GAMEBUINO_SUPPORT
Pokitto	7:72f87b7c7400	599	}
Pokitto	7:72f87b7c7400	600
Pokitto	7:72f87b7c7400	601	uint8_t Display::getPixel(int16_t x,int16_t y) {
Pokitto	7:72f87b7c7400	602	if ((uint16_t)x >= width \|\| (uint16_t)y >= height) return 0;
Pokitto	7:72f87b7c7400	603	#if POK_GAMEBUINO_SUPPORT
Pokitto	7:72f87b7c7400	604	uint8_t color=0; //jonne
Pokitto	7:72f87b7c7400	605	for (uint8_t cbit=0; cbit<POK_COLORDEPTH;cbit++) {
Pokitto	7:72f87b7c7400	606	color \|= (m_scrbuf[x + (y / 8) * LCDWIDTH+POK_BITFRAMEcbit] >> (y % 8)) & 0x1 ; //jonne - added +504cbit
Pokitto	7:72f87b7c7400	607	}
Pokitto	7:72f87b7c7400	608	return color;
Pokitto	7:72f87b7c7400	609	#else
Pokitto	7:72f87b7c7400	610	/** not gamebuino */
Pokitto	7:72f87b7c7400	611	#if POK_COLORDEPTH == 1
Pokitto	7:72f87b7c7400	612	return (m_scrbuf[(y >> 3) * width + x] & (0x80 >> (y & 7))) ? 1:0;
Pokitto	7:72f87b7c7400	613	#elif POK_COLORDEPTH == 2
Pokitto	7:72f87b7c7400	614	uint16_t i = y*(width>>2) + (x>>2);
Pokitto	7:72f87b7c7400	615	uint8_t pixel = m_scrbuf[i];
Pokitto	7:72f87b7c7400	616	uint8_t column = x&0x03;
Pokitto	7:72f87b7c7400	617	if (column==0) return pixel & 0x03; // bits 0-1
Pokitto	7:72f87b7c7400	618	else if (column==1) return (pixel & 0x0C)>>2; // bits 2-3
Pokitto	7:72f87b7c7400	619	else if (column==2) return (pixel & 0x30)>>4; // bits 4-5
Pokitto	7:72f87b7c7400	620	else return pixel>>6;; // bits 6-7
Pokitto	7:72f87b7c7400	621	#elif POK_COLORDEPTH == 3
Pokitto	7:72f87b7c7400	622	#elif POK_COLORDEPTH == 4
Pokitto	7:72f87b7c7400	623	uint16_t i = y*(width>>1) + (x>>1);
Pokitto	7:72f87b7c7400	624	uint8_t pixel = m_scrbuf[i];
Pokitto	7:72f87b7c7400	625	if (x&1) return pixel & 0x0F;
Pokitto	7:72f87b7c7400	626	else return pixel>>4;
Pokitto	7:72f87b7c7400	627	#endif // POK_COLORDEPTH
Pokitto	7:72f87b7c7400	628	#endif // POK_GAMEBUINO_SUPPORT
Pokitto	7:72f87b7c7400	629	}
Pokitto	7:72f87b7c7400	630
Pokitto	7:72f87b7c7400	631	void Display::drawLine(int16_t x0, int16_t y0, int16_t x1, int16_t y1) {
Pokitto	7:72f87b7c7400	632	if ((uint16_t)x0 >= width \|\| (uint16_t)y0 >= height \|\| (uint16_t)x1 >= width \|\| (uint16_t)y1 >= height ) {
Pokitto	7:72f87b7c7400	633	if (clipLine (&x0,&y0,&x1,&y1)==0) return; // line out of bounds
Pokitto	7:72f87b7c7400	634	}
Pokitto	7:72f87b7c7400	635	if (x0 == x1)
Pokitto	7:72f87b7c7400	636	drawColumn(x0,y0,y1);
Pokitto	7:72f87b7c7400	637	else if (y0 == y1)
Pokitto	7:72f87b7c7400	638	drawRow(x0,x1,y0);
Pokitto	7:72f87b7c7400	639	else {
Pokitto	7:72f87b7c7400	640	int e;
Pokitto	7:72f87b7c7400	641	signed int dx,dy,j, temp;
Pokitto	7:72f87b7c7400	642	signed char s1,s2, xchange;
Pokitto	7:72f87b7c7400	643	signed int x,y;
Pokitto	7:72f87b7c7400	644
Pokitto	7:72f87b7c7400	645	x = x0;
Pokitto	7:72f87b7c7400	646	y = y0;
Pokitto	7:72f87b7c7400	647
Pokitto	7:72f87b7c7400	648	//take absolute value
Pokitto	7:72f87b7c7400	649	if (x1 < x0) {
Pokitto	7:72f87b7c7400	650	dx = x0 - x1;
Pokitto	7:72f87b7c7400	651	s1 = -1;
Pokitto	7:72f87b7c7400	652	}
Pokitto	7:72f87b7c7400	653	else if (x1 == x0) {
Pokitto	7:72f87b7c7400	654	dx = 0;
Pokitto	7:72f87b7c7400	655	s1 = 0;
Pokitto	7:72f87b7c7400	656	}
Pokitto	7:72f87b7c7400	657	else {
Pokitto	7:72f87b7c7400	658	dx = x1 - x0;
Pokitto	7:72f87b7c7400	659	s1 = 1;
Pokitto	7:72f87b7c7400	660	}
Pokitto	7:72f87b7c7400	661
Pokitto	7:72f87b7c7400	662	if (y1 < y0) {
Pokitto	7:72f87b7c7400	663	dy = y0 - y1;
Pokitto	7:72f87b7c7400	664	s2 = -1;
Pokitto	7:72f87b7c7400	665	}
Pokitto	7:72f87b7c7400	666	else if (y1 == y0) {
Pokitto	7:72f87b7c7400	667	dy = 0;
Pokitto	7:72f87b7c7400	668	s2 = 0;
Pokitto	7:72f87b7c7400	669	}
Pokitto	7:72f87b7c7400	670	else {
Pokitto	7:72f87b7c7400	671	dy = y1 - y0;
Pokitto	7:72f87b7c7400	672	s2 = 1;
Pokitto	7:72f87b7c7400	673	}
Pokitto	7:72f87b7c7400	674
Pokitto	7:72f87b7c7400	675	xchange = 0;
Pokitto	7:72f87b7c7400	676
Pokitto	7:72f87b7c7400	677	if (dy>dx) {
Pokitto	7:72f87b7c7400	678	temp = dx;
Pokitto	7:72f87b7c7400	679	dx = dy;
Pokitto	7:72f87b7c7400	680	dy = temp;
Pokitto	7:72f87b7c7400	681	xchange = 1;
Pokitto	7:72f87b7c7400	682	}
Pokitto	7:72f87b7c7400	683
Pokitto	7:72f87b7c7400	684	e = ((int)dy<<1) - dx;
Pokitto	7:72f87b7c7400	685
Pokitto	7:72f87b7c7400	686	for (j=0; j<=dx; j++) {
Pokitto	7:72f87b7c7400	687	drawPixel(x,y);
Pokitto	7:72f87b7c7400	688
Pokitto	7:72f87b7c7400	689	if (e>=0) {
Pokitto	7:72f87b7c7400	690	if (xchange==1) x = x + s1;
Pokitto	7:72f87b7c7400	691	else y = y + s2;
Pokitto	7:72f87b7c7400	692	e = e - ((int)dx<<1);
Pokitto	7:72f87b7c7400	693	}
Pokitto	7:72f87b7c7400	694	if (xchange==1)
Pokitto	7:72f87b7c7400	695	y = y + s2;
Pokitto	7:72f87b7c7400	696	else
Pokitto	7:72f87b7c7400	697	x = x + s1;
Pokitto	7:72f87b7c7400	698	e = e + ((int)dy<<1);
Pokitto	7:72f87b7c7400	699	}
Pokitto	7:72f87b7c7400	700	}
Pokitto	7:72f87b7c7400	701	}
Pokitto	7:72f87b7c7400	702
Pokitto	7:72f87b7c7400	703	uint8_t Display::clipLine(int16_t x0, int16_t y0, int16_t x1, int16_t y1){
Pokitto	7:72f87b7c7400	704	// Check X bounds
Pokitto	7:72f87b7c7400	705	if (x1<x0) {
Pokitto	7:72f87b7c7400	706	//std::swap (x1,x0); // swap so that we dont have to check x1 also
Pokitto	7:72f87b7c7400	707	swapWT(int16_t*,x1,x0);
Pokitto	7:72f87b7c7400	708	//std::swap (y1,y0); // y needs to be swaaped also
Pokitto	7:72f87b7c7400	709	swapWT(int16_t*,y1,y0);
Pokitto	7:72f87b7c7400	710	}
Pokitto	7:72f87b7c7400	711
Pokitto	7:72f87b7c7400	712	if (*x0>=width) return 0; // whole line is out of bounds
Pokitto	7:72f87b7c7400	713
Pokitto	7:72f87b7c7400	714	// Clip against X0 = 0
Pokitto	7:72f87b7c7400	715	if (*x0 < 0) {
Pokitto	7:72f87b7c7400	716	if ( *x1 < 0) return 0; // nothing visible
Pokitto	7:72f87b7c7400	717	int16_t dx = (x1 - x0);
Pokitto	7:72f87b7c7400	718	int16_t dy = ((y1 - y0) << 8); // 8.8 fixed point calculation trick
Pokitto	7:72f87b7c7400	719	int16_t m = dy/dx;
Pokitto	7:72f87b7c7400	720	y0 = y0 + ((m-x0)>>8); // get y0 at boundary
Pokitto	7:72f87b7c7400	721	*x0 = 0;
Pokitto	7:72f87b7c7400	722	}
Pokitto	7:72f87b7c7400	723
Pokitto	7:72f87b7c7400	724	// Clip against x1 = 83
Pokitto	7:72f87b7c7400	725	if (*x1 >= width) {
Pokitto	7:72f87b7c7400	726	int16_t dx = (x1 - x0);
Pokitto	7:72f87b7c7400	727	int16_t dy = ((y1 - y0) << 8); // 8.8 fixed point calculation trick
Pokitto	7:72f87b7c7400	728	int16_t m = dy/dx;
Pokitto	7:72f87b7c7400	729	//y1 = y1 + ((m(x1-XMAX))>>8); // get y0 at boundary
Pokitto	7:72f87b7c7400	730	y1 = y1 + ((m(width-1-x1))>>8); // get y0 at boundary
Pokitto	7:72f87b7c7400	731	*x1 = width-1;
Pokitto	7:72f87b7c7400	732	}
Pokitto	7:72f87b7c7400	733
Pokitto	7:72f87b7c7400	734	// Check Y bounds
Pokitto	7:72f87b7c7400	735	if (y1<y0) {
Pokitto	7:72f87b7c7400	736	//std::swap (x1,x0); // swap so that we dont have to check x1 also
Pokitto	7:72f87b7c7400	737	swapWT(int16_t*,x1,x0);
Pokitto	7:72f87b7c7400	738	//std::swap (y1,y0); // y needs to be swaaped also
Pokitto	7:72f87b7c7400	739	swapWT(int16_t*,y1,y0);
Pokitto	7:72f87b7c7400	740	}
Pokitto	7:72f87b7c7400	741
Pokitto	7:72f87b7c7400	742	if (*y0>=height) return 0; // whole line is out of bounds
Pokitto	7:72f87b7c7400	743
Pokitto	7:72f87b7c7400	744	if (*y0 < 0) {
Pokitto	7:72f87b7c7400	745	if ( *y1 < 0) return 0; // nothing visible
Pokitto	7:72f87b7c7400	746	int16_t dx = (x1 - x0) << 8;
Pokitto	7:72f87b7c7400	747	int16_t dy = (y1 - y0); // 8.8 fixed point calculation trick
Pokitto	7:72f87b7c7400	748	int16_t m = dx/dy;
Pokitto	7:72f87b7c7400	749	x0 = x0 + ((m-y0)>>8); // get x0 at boundary
Pokitto	7:72f87b7c7400	750	*y0 = 0;
Pokitto	7:72f87b7c7400	751	}
Pokitto	7:72f87b7c7400	752
Pokitto	7:72f87b7c7400	753	// Clip against y1 = 47
Pokitto	7:72f87b7c7400	754	if (*y1 >= height) {
Pokitto	7:72f87b7c7400	755	int16_t dx = (x1 - x0) << 8;
Pokitto	7:72f87b7c7400	756	int16_t dy = (y1 - y0); // 8.8 fixed point calculation trick
Pokitto	7:72f87b7c7400	757	int16_t m = dx/dy;
Pokitto	7:72f87b7c7400	758	x1 = x1 + ((m(height-1-y1))>>8); // get y0 at boundary
Pokitto	7:72f87b7c7400	759	//x1 = x1 + ((m(y1-YMAX))>>8); // get y0 at boundary
Pokitto	7:72f87b7c7400	760	*y1 = height-1;
Pokitto	7:72f87b7c7400	761	}
Pokitto	7:72f87b7c7400	762	return 1; // clipped succesfully
Pokitto	7:72f87b7c7400	763	}
Pokitto	7:72f87b7c7400	764
Pokitto	7:72f87b7c7400	765	void Display::map1BitColumn(int16_t x, int16_t sy, int16_t ey, const uint8_t* bitmap, uint16_t column){
Pokitto	7:72f87b7c7400	766	if ((uint16_t)sy>=height && (uint16_t)ey>=height) return; //completely out of bounds
Pokitto	7:72f87b7c7400	767	if ((uint16_t)x>=width) return; //completely out of bounds
Pokitto	7:72f87b7c7400	768	if (sy>ey) {
Pokitto	7:72f87b7c7400	769	int y=sy;
Pokitto	7:72f87b7c7400	770	sy=ey;
Pokitto	7:72f87b7c7400	771	ey=y; // swap around so that x0 is less than x1
Pokitto	7:72f87b7c7400	772	}
Pokitto	7:72f87b7c7400	773	uint16_t bmw,bmh;
Pokitto	7:72f87b7c7400	774	float texelstep, texelindex;
Pokitto	7:72f87b7c7400	775	bmw = *(bitmap);
Pokitto	7:72f87b7c7400	776	bmh = *(bitmap+1);
Pokitto	7:72f87b7c7400	777	if (column>bmw-1) column=bmw-1;
Pokitto	7:72f87b7c7400	778	bitmap += 2;
Pokitto	7:72f87b7c7400	779	bitmap += column;
Pokitto	7:72f87b7c7400	780	texelstep = (float)bmh/((float)ey-(float)sy);
Pokitto	7:72f87b7c7400	781	texelindex = 0;
Pokitto	7:72f87b7c7400	782	for (int y=sy; y <= ey; y++, texelindex += texelstep) {
Pokitto	7:72f87b7c7400	783	uint8_t texel;
Pokitto	7:72f87b7c7400	784	uint8_t currbyte, bit;
Pokitto	7:72f87b7c7400	785	currbyte = texelindex / 8;
Pokitto	7:72f87b7c7400	786	bit = 7-((uint16_t) texelindex & 0x7);
Pokitto	7:72f87b7c7400	787	texel=(bitmap+currbytebmw);
Pokitto	7:72f87b7c7400	788	if (texel & (1<<bit)) drawPixel(x,y);
Pokitto	7:72f87b7c7400	789	else if (bgcolor != invisiblecolor) drawPixel(x,y,bgcolor);
Pokitto	7:72f87b7c7400	790	}
Pokitto	7:72f87b7c7400	791	};
Pokitto	7:72f87b7c7400	792
Pokitto	7:72f87b7c7400	793	void Display::drawColumn(int16_t x, int16_t sy, int16_t ey){
Pokitto	7:72f87b7c7400	794	if ((uint16_t)sy>=height && (uint16_t)ey>=height) return; //completely out of bounds
Pokitto	7:72f87b7c7400	795	if ((uint16_t)x>=width) return; //completely out of bounds
Pokitto	7:72f87b7c7400	796	if (sy>ey) {
Pokitto	7:72f87b7c7400	797	int y=sy;
Pokitto	7:72f87b7c7400	798	sy=ey;
Pokitto	7:72f87b7c7400	799	ey=y; // swap around so that x0 is less than x1
Pokitto	7:72f87b7c7400	800	}
Pokitto	7:72f87b7c7400	801	for (int y=sy; y <= ey; y++) {
Pokitto	7:72f87b7c7400	802	drawPixel(x,y);
Pokitto	7:72f87b7c7400	803	}
Pokitto	7:72f87b7c7400	804	}
Pokitto	7:72f87b7c7400	805
Pokitto	7:72f87b7c7400	806	void Display::drawRow(int16_t x0, int16_t x1, int16_t y){
Pokitto	7:72f87b7c7400	807	if ((uint16_t)x0>=width && (uint16_t)x1>=width) return; //completely out of bounds
Pokitto	7:72f87b7c7400	808	if ((uint16_t)y>=height) return; //completely out of bounds
Pokitto	7:72f87b7c7400	809
Pokitto	7:72f87b7c7400	810	if (x0>x1) {
Pokitto	7:72f87b7c7400	811	int x=x0;
Pokitto	7:72f87b7c7400	812	x0=x1;
Pokitto	7:72f87b7c7400	813	x1=x; // swap around so that x0 is less than x1
Pokitto	7:72f87b7c7400	814	}
Pokitto	7:72f87b7c7400	815	for (int x=x0; x <= x1; x++) {
Pokitto	7:72f87b7c7400	816	drawPixel(x,y);
Pokitto	7:72f87b7c7400	817	}
Pokitto	7:72f87b7c7400	818	}
Pokitto	7:72f87b7c7400	819
Pokitto	7:72f87b7c7400	820	void Display::drawFastVLine(int16_t x, int16_t y, int16_t h){
Pokitto	7:72f87b7c7400	821	if (h<0) {y += h; h = -h;}
Pokitto	7:72f87b7c7400	822	drawColumn(x,y,y+h);
Pokitto	7:72f87b7c7400	823	}
Pokitto	7:72f87b7c7400	824
Pokitto	7:72f87b7c7400	825	void Display::drawFastHLine(int16_t x, int16_t y, int16_t w){
Pokitto	7:72f87b7c7400	826	if (w<0) {x += w; w = -w;}
Pokitto	7:72f87b7c7400	827	drawRow(x,x+w-1,y);
Pokitto	7:72f87b7c7400	828	}
Pokitto	7:72f87b7c7400	829
Pokitto	7:72f87b7c7400	830	void Display::drawRectangle(int16_t x0, int16_t y0, int16_t w, int16_t h) {
Pokitto	7:72f87b7c7400	831	drawColumn(x0,y0,y0+h);
Pokitto	7:72f87b7c7400	832	drawColumn(x0+w,y0,y0+h);
Pokitto	7:72f87b7c7400	833	drawRow(x0,x0+w,y0);
Pokitto	7:72f87b7c7400	834	drawRow(x0,x0+w,y0+h);
Pokitto	7:72f87b7c7400	835	}
Pokitto	7:72f87b7c7400	836
Pokitto	7:72f87b7c7400	837	void Display::fillRectangle(int16_t x0,int16_t y0, int16_t w, int16_t h){
Pokitto	7:72f87b7c7400	838	int16_t x,y,x1,y1;
Pokitto	7:72f87b7c7400	839	x1=x0+w;y1=y0+h;
Pokitto	7:72f87b7c7400	840	if ((x0<0 && x1<0) \|\| (x0>=width && x1 >=width)) return; //completely out of bounds
Pokitto	7:72f87b7c7400	841	if ((y0<0 && y1<0) \|\| (y0>=height && y1 >=height)) return; //completely out of bounds
Pokitto	7:72f87b7c7400	842	if (x0>x1) {x=x1;x1=x0;}
Pokitto	7:72f87b7c7400	843	else x=x0;
Pokitto	7:72f87b7c7400	844	if (y0>y1) {y=y1;y1=y0;}
Pokitto	7:72f87b7c7400	845	else y=y0;
Pokitto	7:72f87b7c7400	846	if (x<0) x=0;
Pokitto	7:72f87b7c7400	847	if (y<0) y=0;
Pokitto	7:72f87b7c7400	848	for (;x<x1;x++) drawColumn(x,y,y1);
Pokitto	7:72f87b7c7400	849	}
Pokitto	7:72f87b7c7400	850
Pokitto	7:72f87b7c7400	851	void Display::fillRect(int16_t x, int16_t y, int16_t w, int16_t h) {
Pokitto	7:72f87b7c7400	852	fillRectangle(x,y,w,h);
Pokitto	7:72f87b7c7400	853	}
Pokitto	7:72f87b7c7400	854
Pokitto	7:72f87b7c7400	855	void Display::drawRect(int16_t x, int16_t y, int16_t w, int16_t h) {
Pokitto	7:72f87b7c7400	856	drawRectangle(x,y,w,h);
Pokitto	7:72f87b7c7400	857	}
Pokitto	7:72f87b7c7400	858
Pokitto	7:72f87b7c7400	859	void Display::drawCircle(int16_t x0, int16_t y0, int16_t r) {
Pokitto	7:72f87b7c7400	860	int16_t f = 1 - r;
Pokitto	7:72f87b7c7400	861	int16_t ddF_x = 1;
Pokitto	7:72f87b7c7400	862	int16_t ddF_y = -2 * r;
Pokitto	7:72f87b7c7400	863	int16_t x = 0;
Pokitto	7:72f87b7c7400	864	int16_t y = r;
Pokitto	7:72f87b7c7400	865
Pokitto	7:72f87b7c7400	866	drawPixel(x0, y0 + r);
Pokitto	7:72f87b7c7400	867	drawPixel(x0, y0 - r);
Pokitto	7:72f87b7c7400	868	drawPixel(x0 + r, y0);
Pokitto	7:72f87b7c7400	869	drawPixel(x0 - r, y0);
Pokitto	7:72f87b7c7400	870
Pokitto	7:72f87b7c7400	871	while (x < y) {
Pokitto	7:72f87b7c7400	872	if (f >= 0) {
Pokitto	7:72f87b7c7400	873
Pokitto	7:72f87b7c7400	874	y--;
Pokitto	7:72f87b7c7400	875	ddF_y += 2;
Pokitto	7:72f87b7c7400	876	f += ddF_y;
Pokitto	7:72f87b7c7400	877	}
Pokitto	7:72f87b7c7400	878	x++;
Pokitto	7:72f87b7c7400	879	ddF_x += 2;
Pokitto	7:72f87b7c7400	880	f += ddF_x;
Pokitto	7:72f87b7c7400	881
Pokitto	7:72f87b7c7400	882	drawPixel(x0 + x, y0 + y);
Pokitto	7:72f87b7c7400	883	drawPixel(x0 - x, y0 + y);
Pokitto	7:72f87b7c7400	884	drawPixel(x0 + x, y0 - y);
Pokitto	7:72f87b7c7400	885	drawPixel(x0 - x, y0 - y);
Pokitto	7:72f87b7c7400	886	drawPixel(x0 + y, y0 + x);
Pokitto	7:72f87b7c7400	887	drawPixel(x0 - y, y0 + x);
Pokitto	7:72f87b7c7400	888	drawPixel(x0 + y, y0 - x);
Pokitto	7:72f87b7c7400	889	drawPixel(x0 - y, y0 - x);
Pokitto	7:72f87b7c7400	890
Pokitto	7:72f87b7c7400	891	}
Pokitto	7:72f87b7c7400	892	}
Pokitto	7:72f87b7c7400	893
Pokitto	7:72f87b7c7400	894	void Display::drawCircleHelper(int16_t x0, int16_t y0, int16_t r, uint16_t cornername) {
Pokitto	7:72f87b7c7400	895	int16_t f = 1 - r;
Pokitto	7:72f87b7c7400	896	int16_t ddF_x = 1;
Pokitto	7:72f87b7c7400	897	int16_t ddF_y = -2 * r;
Pokitto	7:72f87b7c7400	898	int16_t x = 0;
Pokitto	7:72f87b7c7400	899	int16_t y = r;
Pokitto	7:72f87b7c7400	900
Pokitto	7:72f87b7c7400	901	while (x < y) {
Pokitto	7:72f87b7c7400	902	if (f >= 0) {
Pokitto	7:72f87b7c7400	903	y--;
Pokitto	7:72f87b7c7400	904	ddF_y += 2;
Pokitto	7:72f87b7c7400	905	f += ddF_y;
Pokitto	7:72f87b7c7400	906	}
Pokitto	7:72f87b7c7400	907	x++;
Pokitto	7:72f87b7c7400	908	ddF_x += 2;
Pokitto	7:72f87b7c7400	909	f += ddF_x;
Pokitto	7:72f87b7c7400	910	if (cornername & 0x4) {
Pokitto	7:72f87b7c7400	911	drawPixel(x0 + x, y0 + y);
Pokitto	7:72f87b7c7400	912	drawPixel(x0 + y, y0 + x);
Pokitto	7:72f87b7c7400	913	}
Pokitto	7:72f87b7c7400	914	if (cornername & 0x2) {
Pokitto	7:72f87b7c7400	915	drawPixel(x0 + x, y0 - y);
Pokitto	7:72f87b7c7400	916	drawPixel(x0 + y, y0 - x);
Pokitto	7:72f87b7c7400	917	}
Pokitto	7:72f87b7c7400	918	if (cornername & 0x8) {
Pokitto	7:72f87b7c7400	919	drawPixel(x0 - y, y0 + x);
Pokitto	7:72f87b7c7400	920	drawPixel(x0 - x, y0 + y);
Pokitto	7:72f87b7c7400	921	}
Pokitto	7:72f87b7c7400	922	if (cornername & 0x1) {
Pokitto	7:72f87b7c7400	923
Pokitto	7:72f87b7c7400	924	drawPixel(x0 - y, y0 - x);
Pokitto	7:72f87b7c7400	925	drawPixel(x0 - x, y0 - y);
Pokitto	7:72f87b7c7400	926	}
Pokitto	7:72f87b7c7400	927	}
Pokitto	7:72f87b7c7400	928	}
Pokitto	7:72f87b7c7400	929
Pokitto	7:72f87b7c7400	930	void Display::fillCircle(int16_t x0, int16_t y0, int16_t r) {
Pokitto	7:72f87b7c7400	931	drawFastVLine(x0, y0 - r, 2 * r );
Pokitto	7:72f87b7c7400	932	fillCircleHelper(x0, y0, r, 3, 0);
Pokitto	7:72f87b7c7400	933	}
Pokitto	7:72f87b7c7400	934
Pokitto	7:72f87b7c7400	935	void Display::fillCircleHelper(int16_t x0, int16_t y0, int16_t r, uint16_t cornername, int16_t delta) {
Pokitto	7:72f87b7c7400	936	int16_t f = 1 - r;
Pokitto	7:72f87b7c7400	937	int16_t ddF_x = 1;
Pokitto	7:72f87b7c7400	938	int16_t ddF_y = -2 * r;
Pokitto	7:72f87b7c7400	939	int16_t x = 0;
Pokitto	7:72f87b7c7400	940	int16_t y = r;
Pokitto	7:72f87b7c7400	941
Pokitto	7:72f87b7c7400	942	while (x < y) {
Pokitto	7:72f87b7c7400	943	if (f >= 0) {
Pokitto	7:72f87b7c7400	944	y--;
Pokitto	7:72f87b7c7400	945	ddF_y += 2;
Pokitto	7:72f87b7c7400	946	f += ddF_y;
Pokitto	7:72f87b7c7400	947	}
Pokitto	7:72f87b7c7400	948	x++;
Pokitto	7:72f87b7c7400	949	ddF_x += 2;
Pokitto	7:72f87b7c7400	950	f += ddF_x;
Pokitto	7:72f87b7c7400	951
Pokitto	7:72f87b7c7400	952	if (cornername & 0x1) {
Pokitto	7:72f87b7c7400	953	drawFastVLine(x0 + x, y0 - y, 2 * y + 1 + delta-1); //added -1 here, jonne
Pokitto	7:72f87b7c7400	954	drawFastVLine(x0 + y, y0 - x, 2 * x + 1 + delta-1); //added -1 here, jonne
Pokitto	7:72f87b7c7400	955	}
Pokitto	7:72f87b7c7400	956	if (cornername & 0x2) {
Pokitto	7:72f87b7c7400	957
Pokitto	7:72f87b7c7400	958	drawFastVLine(x0 - x, y0 - y, 2 * y + 1 + delta-1); //added -1 here, jonne
Pokitto	7:72f87b7c7400	959	drawFastVLine(x0 - y, y0 - x, 2 * x + 1 + delta-1); //added -1 here, jonne
Pokitto	7:72f87b7c7400	960	}
Pokitto	7:72f87b7c7400	961	}
Pokitto	7:72f87b7c7400	962	}
Pokitto	7:72f87b7c7400	963
Pokitto	7:72f87b7c7400	964	void Display::drawRoundRect(int16_t x, int16_t y, int16_t w,int16_t h, int16_t r) {
Pokitto	7:72f87b7c7400	965	if (r<2) {drawRectangle(x,y,w,h);return;}
Pokitto	7:72f87b7c7400	966	// smarter version
Pokitto	7:72f87b7c7400	967	drawFastHLine(x + r, y, w - 2 * r); // Top
Pokitto	7:72f87b7c7400	968	drawFastHLine(x + r, y + h - 1, w - 2 * r); // Bottom
Pokitto	7:72f87b7c7400	969	drawFastVLine(x, y + r, h - 2 * r); // Left
Pokitto	7:72f87b7c7400	970	drawFastVLine(x + w - 1, y + r, h - 2 * r); // Right
Pokitto	7:72f87b7c7400	971	// draw four corners
Pokitto	7:72f87b7c7400	972	drawCircleHelper(x + r, y + r, r, 1);
Pokitto	7:72f87b7c7400	973	drawCircleHelper(x + w - r - 1, y + r, r, 2);
Pokitto	7:72f87b7c7400	974	drawCircleHelper(x + w - r - 1, y + h - r - 1, r, 4);
Pokitto	7:72f87b7c7400	975	drawCircleHelper(x + r, y + h - r - 1, r, 8);
Pokitto	7:72f87b7c7400	976	}
Pokitto	7:72f87b7c7400	977
Pokitto	7:72f87b7c7400	978	void Display::fillRoundRect(int16_t x, int16_t y, int16_t w,int16_t h, int16_t r) {
Pokitto	7:72f87b7c7400	979	if (r<2) {fillRectangle(x,y,w,h);return;}
Pokitto	7:72f87b7c7400	980	fillRectangle(x + r, y, w - 2 * r, h-1);
Pokitto	7:72f87b7c7400	981	// draw four corners
Pokitto	7:72f87b7c7400	982	fillCircleHelper(x + w - r - 1, y + r, r, 1, h - 2 * r - 1);
Pokitto	7:72f87b7c7400	983	fillCircleHelper(x + r, y + r, r, 2, h - 2 * r - 1);
Pokitto	7:72f87b7c7400	984	}
Pokitto	7:72f87b7c7400	985
Pokitto	7:72f87b7c7400	986	void Display::drawTriangle(int16_t x0, int16_t y0,
Pokitto	7:72f87b7c7400	987	int16_t x1, int16_t y1,
Pokitto	7:72f87b7c7400	988	int16_t x2, int16_t y2) {
Pokitto	7:72f87b7c7400	989	drawLine(x0, y0, x1, y1);
Pokitto	7:72f87b7c7400	990	drawLine(x1, y1, x2, y2);
Pokitto	7:72f87b7c7400	991	drawLine(x2, y2, x0, y0);
Pokitto	7:72f87b7c7400	992	}
Pokitto	7:72f87b7c7400	993
Pokitto	7:72f87b7c7400	994	void Display::fillTriangle(int16_t x0, int16_t y0,
Pokitto	7:72f87b7c7400	995	int16_t x1, int16_t y1,
Pokitto	7:72f87b7c7400	996	int16_t x2, int16_t y2) {
Pokitto	7:72f87b7c7400	997	int16_t a, b, y, last;
Pokitto	7:72f87b7c7400	998
Pokitto	7:72f87b7c7400	999	// Sort coordinates by Y order (y2 >= y1 >= y0)
Pokitto	7:72f87b7c7400	1000	if (y0 > y1) {
Pokitto	7:72f87b7c7400	1001	swapWT(int16_t,y0, y1);
Pokitto	7:72f87b7c7400	1002	swapWT(int16_t,x0, x1);
Pokitto	7:72f87b7c7400	1003	}
Pokitto	7:72f87b7c7400	1004	if (y1 > y2) {
Pokitto	7:72f87b7c7400	1005	swapWT(int16_t,y2, y1);
Pokitto	7:72f87b7c7400	1006	swapWT(int16_t,x2, x1);
Pokitto	7:72f87b7c7400	1007	}
Pokitto	7:72f87b7c7400	1008	if (y0 > y1) {
Pokitto	7:72f87b7c7400	1009	swapWT(int16_t,y0, y1);
Pokitto	7:72f87b7c7400	1010	swapWT(int16_t,x0, x1);
Pokitto	7:72f87b7c7400	1011	}
Pokitto	7:72f87b7c7400	1012
Pokitto	7:72f87b7c7400	1013	if (y0 == y2) { // Handle awkward all-on-same-line case as its own thing
Pokitto	7:72f87b7c7400	1014	a = b = x0;
Pokitto	7:72f87b7c7400	1015	if (x1 < a) a = x1;
Pokitto	7:72f87b7c7400	1016	else if (x1 > b) b = x1;
Pokitto	7:72f87b7c7400	1017	if (x2 < a) a = x2;
Pokitto	7:72f87b7c7400	1018	else if (x2 > b) b = x2;
Pokitto	7:72f87b7c7400	1019	drawFastHLine(a, y0, b - a + 1);
Pokitto	7:72f87b7c7400	1020	return;
Pokitto	7:72f87b7c7400	1021	}
Pokitto	7:72f87b7c7400	1022
Pokitto	7:72f87b7c7400	1023	int16_t
Pokitto	7:72f87b7c7400	1024	dx01 = x1 - x0,
Pokitto	7:72f87b7c7400	1025	dy01 = y1 - y0,
Pokitto	7:72f87b7c7400	1026	dx02 = x2 - x0,
Pokitto	7:72f87b7c7400	1027	dy02 = y2 - y0,
Pokitto	7:72f87b7c7400	1028	dx12 = x2 - x1,
Pokitto	7:72f87b7c7400	1029	dy12 = y2 - y1,
Pokitto	7:72f87b7c7400	1030	sa = 0,
Pokitto	7:72f87b7c7400	1031	sb = 0;
Pokitto	7:72f87b7c7400	1032
Pokitto	7:72f87b7c7400	1033	// For upper part of triangle, find scanline crossings for segments
Pokitto	7:72f87b7c7400	1034	// 0-1 and 0-2. If y1=y2 (flat-bottomed triangle), the scanline y1
Pokitto	7:72f87b7c7400	1035	// is included here (and second loop will be skipped, avoiding a /0
Pokitto	7:72f87b7c7400	1036	// error there), otherwise scanline y1 is skipped here and handled
Pokitto	7:72f87b7c7400	1037	// in the second loop...which also avoids a /0 error here if y0=y1
Pokitto	7:72f87b7c7400	1038	// (flat-topped triangle).
Pokitto	7:72f87b7c7400	1039	if (y1 == y2) last = y1; // Include y1 scanline
Pokitto	7:72f87b7c7400	1040	else last = y1 - 1; // Skip it
Pokitto	7:72f87b7c7400	1041
Pokitto	7:72f87b7c7400	1042	for (y = y0; y <= last; y++) {
Pokitto	7:72f87b7c7400	1043	a = x0 + sa / dy01;
Pokitto	7:72f87b7c7400	1044	b = x0 + sb / dy02;
Pokitto	7:72f87b7c7400	1045	sa += dx01;
Pokitto	7:72f87b7c7400	1046	sb += dx02;
Pokitto	7:72f87b7c7400	1047	/* longhand:
Pokitto	7:72f87b7c7400	1048	a = x0 + (x1 - x0) * (y - y0) / (y1 - y0);
Pokitto	7:72f87b7c7400	1049	b = x0 + (x2 - x0) * (y - y0) / (y2 - y0);
Pokitto	7:72f87b7c7400	1050	*/
Pokitto	7:72f87b7c7400	1051	if (a > b) swapWT(int16_t,a, b);
Pokitto	7:72f87b7c7400	1052	drawFastHLine(a, y, b - a + 1);
Pokitto	7:72f87b7c7400	1053	}
Pokitto	7:72f87b7c7400	1054
Pokitto	7:72f87b7c7400	1055	// For lower part of triangle, find scanline crossings for segments
Pokitto	7:72f87b7c7400	1056	// 0-2 and 1-2. This loop is skipped if y1=y2.
Pokitto	7:72f87b7c7400	1057	sa = dx12 * (y - y1);
Pokitto	7:72f87b7c7400	1058	sb = dx02 * (y - y0);
Pokitto	7:72f87b7c7400	1059	for (; y <= y2; y++) {
Pokitto	7:72f87b7c7400	1060	a = x1 + sa / dy12;
Pokitto	7:72f87b7c7400	1061	b = x0 + sb / dy02;
Pokitto	7:72f87b7c7400	1062	sa += dx12;
Pokitto	7:72f87b7c7400	1063	sb += dx02;
Pokitto	7:72f87b7c7400	1064
Pokitto	7:72f87b7c7400	1065	if (a > b) swapWT(int16_t,a, b);
Pokitto	7:72f87b7c7400	1066	drawFastHLine(a, y, b - a + 1);
Pokitto	7:72f87b7c7400	1067	}
Pokitto	7:72f87b7c7400	1068	}
Pokitto	7:72f87b7c7400	1069
Pokitto	7:72f87b7c7400	1070	void Display::setFont(const unsigned char * f) {
Pokitto	7:72f87b7c7400	1071	font = f;
Pokitto	7:72f87b7c7400	1072	fontWidth = *(font)+1;
Pokitto	7:72f87b7c7400	1073	fontHeight = *(font + 1)+1;
Pokitto	7:72f87b7c7400	1074	}
Pokitto	7:72f87b7c7400	1075
Pokitto	7:72f87b7c7400	1076	void Display::drawMonoBitmap(int16_t x, int16_t y, const uint8_t* bitmap, uint8_t index) {
Pokitto	7:72f87b7c7400	1077	uint8_t w = *bitmap;
Pokitto	7:72f87b7c7400	1078	uint8_t h = *(bitmap + 1);
Pokitto	7:72f87b7c7400	1079	uint8_t xtra=0;
Pokitto	7:72f87b7c7400	1080	if (w&0x7) xtra=1;
Pokitto	7:72f87b7c7400	1081	bitmap = bitmap + 3 + index * h * ((w>>3)+xtra); //add an offset to the pointer (fonts !)
Pokitto	7:72f87b7c7400	1082	#if POK_GAMEBUINO_SUPPORT > 0
Pokitto	7:72f87b7c7400	1083	int8_t i, j, byteNum, bitNum, byteWidth = (w + 7) >> 3;
Pokitto	7:72f87b7c7400	1084	for (i = 0; i < w; i++) {
Pokitto	7:72f87b7c7400	1085	byteNum = i / 8;
Pokitto	7:72f87b7c7400	1086	bitNum = i % 8;
Pokitto	7:72f87b7c7400	1087	for (j = 0; j < h; j++) {
Pokitto	7:72f87b7c7400	1088	uint8_t source = (bitmap + j byteWidth + byteNum);
Pokitto	7:72f87b7c7400	1089	if (source & (0x80 >> bitNum)) {
Pokitto	7:72f87b7c7400	1090	drawPixel(x + i, y + j);
Pokitto	7:72f87b7c7400	1091	}
Pokitto	7:72f87b7c7400	1092	}
Pokitto	7:72f87b7c7400	1093	}
Pokitto	7:72f87b7c7400	1094	#else
Pokitto	7:72f87b7c7400	1095	/** not gamebuino */
Pokitto	7:72f87b7c7400	1096	int8_t scrx,scry;
Pokitto	7:72f87b7c7400	1097	uint8_t* scrptr = m_scrbuf + (y*(width>>1) + (x>>1));
Pokitto	7:72f87b7c7400	1098	int8_t bitptr;
Pokitto	7:72f87b7c7400	1099	for (scry = y; scry < y+h; scry+=1) {
Pokitto	7:72f87b7c7400	1100	if ((x&1)==0) { / EVEN pixel starting line/
Pokitto	7:72f87b7c7400	1101	for (scrx = x, bitptr=7; scrx < w+x; scrx+=2) {
Pokitto	7:72f87b7c7400	1102	uint8_t targetpixel = *scrptr;
Pokitto	7:72f87b7c7400	1103	if (*bitmap & (1<<bitptr)) targetpixel = (targetpixel & 0xF) \| color<<4; // upper nibble
Pokitto	7:72f87b7c7400	1104	else if (bgcolor != invisiblecolor) targetpixel = (targetpixel & 0xF) \| bgcolor<<4; // upper nibble
Pokitto	7:72f87b7c7400	1105	bitptr--;
Pokitto	7:72f87b7c7400	1106	if (*bitmap & (1<<bitptr)) targetpixel = (targetpixel & 0xF0) \| color; // lower nibble
Pokitto	7:72f87b7c7400	1107	else if (bgcolor != invisiblecolor) targetpixel = (targetpixel & 0xF0) \| bgcolor; // lower nibble
Pokitto	7:72f87b7c7400	1108	bitptr--;
Pokitto	7:72f87b7c7400	1109	if (bitptr<0) { bitptr = 7; bitmap++; }
Pokitto	7:72f87b7c7400	1110	*scrptr = targetpixel;
Pokitto	7:72f87b7c7400	1111	scrptr++;
Pokitto	7:72f87b7c7400	1112	}
Pokitto	7:72f87b7c7400	1113	} else { / ODD pixel starting line /
Pokitto	7:72f87b7c7400	1114	for (scrx = x, bitptr=7; scrx < w+x; scrx+=2) {
Pokitto	7:72f87b7c7400	1115	uint8_t targetpixel = *scrptr;
Pokitto	7:72f87b7c7400	1116	// store higher nibble of source pixel in lower nibble of target
Pokitto	7:72f87b7c7400	1117	if (*bitmap & (1<<bitptr)) targetpixel = (targetpixel & 0xF0) \| color; // lower nibble
Pokitto	7:72f87b7c7400	1118	else if (bgcolor != invisiblecolor) targetpixel = (targetpixel & 0xF0) \| bgcolor; // lower nibble
Pokitto	7:72f87b7c7400	1119	*scrptr = targetpixel; // store
Pokitto	7:72f87b7c7400	1120	bitptr--;scrptr++;targetpixel = *scrptr;
Pokitto	7:72f87b7c7400	1121	// store lower nibble of source pixel in higher nibble of target
Pokitto	7:72f87b7c7400	1122	if (*bitmap & (1<<bitptr)) targetpixel = (targetpixel & 0xF) \| color<<4; // higher nibble
Pokitto	7:72f87b7c7400	1123	else if (bgcolor != invisiblecolor) targetpixel = (targetpixel & 0xF) \| bgcolor<<4; // higher nibble
Pokitto	7:72f87b7c7400	1124	*scrptr = targetpixel; // store
Pokitto	7:72f87b7c7400	1125	bitptr--; // do not increment scrptr here !
Pokitto	7:72f87b7c7400	1126	}
Pokitto	7:72f87b7c7400	1127	}
Pokitto	7:72f87b7c7400	1128	if (bitptr!=7) bitmap++; // force skip to next line
Pokitto	7:72f87b7c7400	1129	// increment the y jump in the scrptr
Pokitto	7:72f87b7c7400	1130	scrptr = scrptr + ((width - w)>>1);
Pokitto	7:72f87b7c7400	1131	}
Pokitto	7:72f87b7c7400	1132	#endif // POK_GAMEBUINO_SUPPORT
Pokitto	7:72f87b7c7400	1133	}
Pokitto	7:72f87b7c7400	1134
Pokitto	7:72f87b7c7400	1135
Pokitto	7:72f87b7c7400	1136	void Display::drawBitmap(int16_t x, int16_t y, const uint8_t* bitmap, uint8_t frame)
Pokitto	7:72f87b7c7400	1137	{
Pokitto	7:72f87b7c7400	1138	int16_t w = *bitmap;
Pokitto	7:72f87b7c7400	1139	int16_t h = *(bitmap + 1);
Pokitto	7:72f87b7c7400	1140	uint8_t framew = *(bitmap+2);
Pokitto	7:72f87b7c7400	1141	bitmap = bitmap + 3; //add an offset to the pointer to start after the width and height
Pokitto	7:72f87b7c7400	1142	/** visibility check */
Pokitto	7:72f87b7c7400	1143	if (y<-h \|\| y>height) return; //invisible
Pokitto	7:72f87b7c7400	1144	if (x<-framew \|\| x>width) return; //invisible
Pokitto	7:72f87b7c7400	1145	/** 1 bpp mode */
Pokitto	7:72f87b7c7400	1146	if (m_colordepth<2) {
Pokitto	7:72f87b7c7400	1147	int16_t i, j, byteNum, bitNum, byteWidth = (w + 7) >> 3;
Pokitto	7:72f87b7c7400	1148	for (i = 0; i < w; i++) {
Pokitto	7:72f87b7c7400	1149	byteNum = i / 8;
Pokitto	7:72f87b7c7400	1150	bitNum = i % 8;
Pokitto	7:72f87b7c7400	1151	for (j = 0; j < h; j++) {
Pokitto	7:72f87b7c7400	1152	uint8_t source = (bitmap + j byteWidth + byteNum);
Pokitto	7:72f87b7c7400	1153	if (source & (0x80 >> bitNum)) {
Pokitto	7:72f87b7c7400	1154	drawPixel(x + i, y + j);
Pokitto	7:72f87b7c7400	1155	}
Pokitto	7:72f87b7c7400	1156	}
Pokitto	7:72f87b7c7400	1157	}
Pokitto	7:72f87b7c7400	1158
Pokitto	7:72f87b7c7400	1159	return;
Pokitto	7:72f87b7c7400	1160	}
Pokitto	7:72f87b7c7400	1161	/** 2 bpp mode */
Pokitto	7:72f87b7c7400	1162	if (m_colordepth<4) {
Pokitto	7:72f87b7c7400	1163	int16_t i, j, byteNum, bitNum, byteWidth = w >> 2;
Pokitto	7:72f87b7c7400	1164	for (i = 0; i < w; i++) {
Pokitto	7:72f87b7c7400	1165	byteNum = i / 4;
Pokitto	7:72f87b7c7400	1166	bitNum = (i % 4)<<1;
Pokitto	7:72f87b7c7400	1167	for (j = 0; j < h; j++) {
Pokitto	7:72f87b7c7400	1168	uint8_t source = (bitmap + j byteWidth + byteNum);
Pokitto	7:72f87b7c7400	1169	uint8_t output = (source & (0xC0 >> bitNum));
Pokitto	7:72f87b7c7400	1170	output >>= (6-bitNum);
Pokitto	7:72f87b7c7400	1171	if (output != invisiblecolor) {
Pokitto	7:72f87b7c7400	1172	setColor(output);
Pokitto	7:72f87b7c7400	1173	drawPixel(x + i, y + j);
Pokitto	7:72f87b7c7400	1174	}
Pokitto	7:72f87b7c7400	1175	}
Pokitto	7:72f87b7c7400	1176	}
Pokitto	7:72f87b7c7400	1177
Pokitto	7:72f87b7c7400	1178	return;
Pokitto	7:72f87b7c7400	1179	}
Pokitto	7:72f87b7c7400	1180	/** 4bpp fast version */
Pokitto	7:72f87b7c7400	1181	int16_t scrx,scry,xclip,xjump,scrxjump;
Pokitto	7:72f87b7c7400	1182	xclip=xjump=scrxjump=0;
Pokitto	7:72f87b7c7400	1183	bitmap += (framew*frame)>>1;
Pokitto	7:72f87b7c7400	1184	/** y clipping */
Pokitto	7:72f87b7c7400	1185	if (y<0) { h+=y; bitmap -= y*(w>>1); y=0;}
Pokitto	7:72f87b7c7400	1186	else if (y+h>height) { h -=(y-height);}
Pokitto	7:72f87b7c7400	1187	/** x clipping */
Pokitto	7:72f87b7c7400	1188	xjump = (w-framew)>>1;
Pokitto	7:72f87b7c7400	1189	if (x<0) { xclip=(x&1)<<1; framew+=x; xjump = ((-x)>>1); bitmap += xjump; x=0;}
Pokitto	7:72f87b7c7400	1190	else if (x+framew>width) {
Pokitto	7:72f87b7c7400	1191	xclip = (x&1)<<1;
Pokitto	7:72f87b7c7400	1192	scrxjump = x&1;
Pokitto	7:72f87b7c7400	1193	xjump=((x+framew-width)>>1)+scrxjump;
Pokitto	7:72f87b7c7400	1194	framew = width-x;}
Pokitto	7:72f87b7c7400	1195
Pokitto	7:72f87b7c7400	1196	uint8_t* scrptr = m_scrbuf + (y*(width>>1) + (x>>1));
Pokitto	7:72f87b7c7400	1197	/ ONLY 4-bit mode for time being /
Pokitto	7:72f87b7c7400	1198	for (scry = y; scry < y+h; scry+=1) {
Pokitto	7:72f87b7c7400	1199	if (scry>=height) return;
Pokitto	7:72f87b7c7400	1200	if ((x&1)==0) { / EVEN pixel starting line, very simple, just copypaste /
Pokitto	7:72f87b7c7400	1201	for (scrx = x; scrx < framew+x-xclip; scrx+=2) {
Pokitto	7:72f87b7c7400	1202	uint8_t sourcepixel = *bitmap;
Pokitto	7:72f87b7c7400	1203	if (xclip) {
Pokitto	7:72f87b7c7400	1204	sourcepixel <<=4;
Pokitto	7:72f87b7c7400	1205	sourcepixel \|= ((*(bitmap+1))>>4);
Pokitto	7:72f87b7c7400	1206	}
Pokitto	7:72f87b7c7400	1207	uint8_t targetpixel = *scrptr;
Pokitto	7:72f87b7c7400	1208	if ((sourcepixel>>4) != invisiblecolor ) targetpixel = (targetpixel&0x0F) \| (sourcepixel & 0xF0);
Pokitto	7:72f87b7c7400	1209	if ((sourcepixel&0x0F) != invisiblecolor) targetpixel = (targetpixel & 0xF0) \| (sourcepixel & 0x0F);
Pokitto	7:72f87b7c7400	1210	*scrptr = targetpixel;
Pokitto	7:72f87b7c7400	1211	bitmap++;
Pokitto	7:72f87b7c7400	1212	scrptr++;
Pokitto	7:72f87b7c7400	1213	}
Pokitto	7:72f87b7c7400	1214	if (xclip){
Pokitto	7:72f87b7c7400	1215	if (framew&1) {
Pokitto	7:72f87b7c7400	1216	/*last pixel is odd pixel due to clipping & odd width/
Pokitto	7:72f87b7c7400	1217	uint8_t sourcepixel = *bitmap;
Pokitto	7:72f87b7c7400	1218	if ((sourcepixel&0x0F) != invisiblecolor) {
Pokitto	7:72f87b7c7400	1219	sourcepixel <<=4;
Pokitto	7:72f87b7c7400	1220	uint8_t targetpixel = *scrptr;// & 0x0F;
Pokitto	7:72f87b7c7400	1221	targetpixel \|= sourcepixel;
Pokitto	7:72f87b7c7400	1222	*scrptr = targetpixel;
Pokitto	7:72f87b7c7400	1223	}
Pokitto	7:72f87b7c7400	1224	//scrptr++;
Pokitto	7:72f87b7c7400	1225	}
Pokitto	7:72f87b7c7400	1226	bitmap++;
Pokitto	7:72f87b7c7400	1227	scrptr++;
Pokitto	7:72f87b7c7400	1228	}
Pokitto	7:72f87b7c7400	1229	bitmap += xjump; // needed if x<0 clipping occurs
Pokitto	7:72f87b7c7400	1230	} else { / ODD pixel starting line /
Pokitto	7:72f87b7c7400	1231	for (scrx = x; scrx < framew+x-xclip; scrx+=2) {
Pokitto	7:72f87b7c7400	1232	uint8_t sourcepixel = *bitmap;
Pokitto	7:72f87b7c7400	1233	uint8_t targetpixel = *scrptr;
Pokitto	7:72f87b7c7400	1234	// store higher nibble of source pixel in lower nibble of target
Pokitto	7:72f87b7c7400	1235	if((sourcepixel>>4)!=invisiblecolor) targetpixel = (targetpixel & 0xF0) \| (sourcepixel >> 4 );
Pokitto	7:72f87b7c7400	1236	*scrptr = targetpixel;
Pokitto	7:72f87b7c7400	1237	scrptr++;
Pokitto	7:72f87b7c7400	1238	targetpixel = *scrptr;
Pokitto	7:72f87b7c7400	1239	// store lower nibble of source pixel in higher nibble of target
Pokitto	7:72f87b7c7400	1240	if((sourcepixel&0x0F)!=invisiblecolor) targetpixel = (targetpixel & 0x0F) \| (sourcepixel << 4);
Pokitto	7:72f87b7c7400	1241	*scrptr = targetpixel;
Pokitto	7:72f87b7c7400	1242	bitmap++;
Pokitto	7:72f87b7c7400	1243	}
Pokitto	7:72f87b7c7400	1244	bitmap+=xjump;
Pokitto	7:72f87b7c7400	1245	}
Pokitto	7:72f87b7c7400	1246	// increment the y jump in the scrptr
Pokitto	7:72f87b7c7400	1247	scrptr = scrptr + ((width - framew)>>1)+scrxjump;
Pokitto	7:72f87b7c7400	1248	}
Pokitto	7:72f87b7c7400	1249	}
Pokitto	7:72f87b7c7400	1250
Pokitto	7:72f87b7c7400	1251
Pokitto	7:72f87b7c7400	1252	void Display::drawBitmap(int16_t x, int16_t y, const uint8_t* bitmap)
Pokitto	7:72f87b7c7400	1253	{
Pokitto	7:72f87b7c7400	1254	int16_t w = *bitmap;
Pokitto	7:72f87b7c7400	1255	int16_t h = *(bitmap + 1);
Pokitto	7:72f87b7c7400	1256	bitmap = bitmap + 2; //add an offset to the pointer to start after the width and height
Pokitto	7:72f87b7c7400	1257	/** visibility check */
Pokitto	7:72f87b7c7400	1258	if (y<-h \|\| y>height) return; //invisible
Pokitto	7:72f87b7c7400	1259	if (x<-w \|\| x>width) return; //invisible
Pokitto	7:72f87b7c7400	1260	/** 1 bpp mode */
Pokitto	7:72f87b7c7400	1261	if (m_colordepth<2) {
Pokitto	7:72f87b7c7400	1262	int16_t i, j, byteNum, bitNum, byteWidth = (w + 7) >> 3;
Pokitto	7:72f87b7c7400	1263	for (i = 0; i < w; i++) {
Pokitto	7:72f87b7c7400	1264	byteNum = i / 8;
Pokitto	7:72f87b7c7400	1265	bitNum = i % 8;
Pokitto	7:72f87b7c7400	1266	for (j = 0; j < h; j++) {
Pokitto	7:72f87b7c7400	1267	uint8_t source = (bitmap + j byteWidth + byteNum);
Pokitto	7:72f87b7c7400	1268	if (source & (0x80 >> bitNum)) {
Pokitto	7:72f87b7c7400	1269	drawPixel(x + i, y + j);
Pokitto	7:72f87b7c7400	1270	}
Pokitto	7:72f87b7c7400	1271	}
Pokitto	7:72f87b7c7400	1272	}
Pokitto	7:72f87b7c7400	1273
Pokitto	7:72f87b7c7400	1274	return;
Pokitto	7:72f87b7c7400	1275	}
Pokitto	7:72f87b7c7400	1276	/** 2 bpp mode */
Pokitto	7:72f87b7c7400	1277	if (m_colordepth<4) {
Pokitto	7:72f87b7c7400	1278	int16_t i, j, byteNum, bitNum, byteWidth = w >> 2;
Pokitto	7:72f87b7c7400	1279	for (i = 0; i < w; i++) {
Pokitto	7:72f87b7c7400	1280	byteNum = i / 4;
Pokitto	7:72f87b7c7400	1281	bitNum = (i % 4)<<1;
Pokitto	7:72f87b7c7400	1282	for (j = 0; j < h; j++) {
Pokitto	7:72f87b7c7400	1283	uint8_t source = (bitmap + j byteWidth + byteNum);
Pokitto	7:72f87b7c7400	1284	uint8_t output = (source & (0xC0 >> bitNum));
Pokitto	7:72f87b7c7400	1285	output >>= (6-bitNum);
Pokitto	7:72f87b7c7400	1286	if (output != invisiblecolor) {
Pokitto	7:72f87b7c7400	1287	setColor(output);
Pokitto	7:72f87b7c7400	1288	drawPixel(x + i, y + j);
Pokitto	7:72f87b7c7400	1289	}
Pokitto	7:72f87b7c7400	1290	}
Pokitto	7:72f87b7c7400	1291	}
Pokitto	7:72f87b7c7400	1292
Pokitto	7:72f87b7c7400	1293	return;
Pokitto	7:72f87b7c7400	1294	}
Pokitto	7:72f87b7c7400	1295	/** 4bpp fast version */
Pokitto	7:72f87b7c7400	1296	int16_t scrx,scry,xclip,xjump,scrxjump;
Pokitto	7:72f87b7c7400	1297	xclip=xjump=scrxjump=0;
Pokitto	7:72f87b7c7400	1298	/** y clipping */
Pokitto	7:72f87b7c7400	1299	if (y<0) { h+=y; bitmap -= y*(w>>1); y=0;}
Pokitto	7:72f87b7c7400	1300	else if (y+h>height) { h -=(y-height);}
Pokitto	7:72f87b7c7400	1301	/** x clipping */
Pokitto	7:72f87b7c7400	1302	if (x<0) { xclip=(x&1)<<1; w+=x; xjump = ((-x)>>1); bitmap += xjump; x=0;}
Pokitto	7:72f87b7c7400	1303	else if (x+w>width) {
Pokitto	7:72f87b7c7400	1304	xclip = (x&1)<<1;
Pokitto	7:72f87b7c7400	1305	scrxjump = x&1;
Pokitto	7:72f87b7c7400	1306	xjump=((x+w-width)>>1)+scrxjump;
Pokitto	7:72f87b7c7400	1307	w = width-x;}
Pokitto	7:72f87b7c7400	1308
Pokitto	7:72f87b7c7400	1309	uint8_t* scrptr = m_scrbuf + (y*(width>>1) + (x>>1));
Pokitto	7:72f87b7c7400	1310	/ ONLY 4-bit mode for time being /
Pokitto	7:72f87b7c7400	1311	for (scry = y; scry < y+h; scry+=1) {
Pokitto	7:72f87b7c7400	1312	if (scry>=height) return;
Pokitto	7:72f87b7c7400	1313	if ((x&1)==0) { / EVEN pixel starting line, very simple, just copypaste /
Pokitto	7:72f87b7c7400	1314	for (scrx = x; scrx < w+x-xclip; scrx+=2) {
Pokitto	7:72f87b7c7400	1315	uint8_t sourcepixel = *bitmap;
Pokitto	7:72f87b7c7400	1316	if (xclip) {
Pokitto	7:72f87b7c7400	1317	sourcepixel <<=4;
Pokitto	7:72f87b7c7400	1318	sourcepixel \|= ((*(bitmap+1))>>4);
Pokitto	7:72f87b7c7400	1319	}
Pokitto	7:72f87b7c7400	1320	uint8_t targetpixel = *scrptr;
Pokitto	7:72f87b7c7400	1321	if ((sourcepixel>>4) != invisiblecolor ) targetpixel = (targetpixel&0x0F) \| (sourcepixel & 0xF0);
Pokitto	7:72f87b7c7400	1322	if ((sourcepixel&0x0F) != invisiblecolor) targetpixel = (targetpixel & 0xF0) \| (sourcepixel & 0x0F);
Pokitto	7:72f87b7c7400	1323	*scrptr = targetpixel;
Pokitto	7:72f87b7c7400	1324	bitmap++;
Pokitto	7:72f87b7c7400	1325	scrptr++;
Pokitto	7:72f87b7c7400	1326	}
Pokitto	7:72f87b7c7400	1327	if (xclip){
Pokitto	7:72f87b7c7400	1328	if (w&1) {
Pokitto	7:72f87b7c7400	1329	/*last pixel is odd pixel due to clipping & odd width/
Pokitto	7:72f87b7c7400	1330	uint8_t sourcepixel = *bitmap;
Pokitto	7:72f87b7c7400	1331	if ((sourcepixel&0x0F) != invisiblecolor) {
Pokitto	7:72f87b7c7400	1332	sourcepixel <<=4;
Pokitto	7:72f87b7c7400	1333	uint8_t targetpixel = *scrptr;// & 0x0F;
Pokitto	7:72f87b7c7400	1334	targetpixel \|= sourcepixel;
Pokitto	7:72f87b7c7400	1335	*scrptr = targetpixel;
Pokitto	7:72f87b7c7400	1336	}
Pokitto	7:72f87b7c7400	1337	//scrptr++;
Pokitto	7:72f87b7c7400	1338	}
Pokitto	7:72f87b7c7400	1339	bitmap++;
Pokitto	7:72f87b7c7400	1340	scrptr++;
Pokitto	7:72f87b7c7400	1341	}
Pokitto	7:72f87b7c7400	1342	bitmap += xjump; // needed if x<0 clipping occurs
Pokitto	7:72f87b7c7400	1343	} else { / ODD pixel starting line /
Pokitto	7:72f87b7c7400	1344	for (scrx = x; scrx < w+x-xclip; scrx+=2) {
Pokitto	7:72f87b7c7400	1345	uint8_t sourcepixel = *bitmap;
Pokitto	7:72f87b7c7400	1346	uint8_t targetpixel = *scrptr;
Pokitto	7:72f87b7c7400	1347	// store higher nibble of source pixel in lower nibble of target
Pokitto	7:72f87b7c7400	1348	if((sourcepixel>>4)!=invisiblecolor) targetpixel = (targetpixel & 0xF0) \| (sourcepixel >> 4 );
Pokitto	7:72f87b7c7400	1349	*scrptr = targetpixel;
Pokitto	7:72f87b7c7400	1350	scrptr++;
Pokitto	7:72f87b7c7400	1351	targetpixel = *scrptr;
Pokitto	7:72f87b7c7400	1352	// store lower nibble of source pixel in higher nibble of target
Pokitto	7:72f87b7c7400	1353	if((sourcepixel&0x0F)!=invisiblecolor) targetpixel = (targetpixel & 0x0F) \| (sourcepixel << 4);
Pokitto	7:72f87b7c7400	1354	*scrptr = targetpixel;
Pokitto	7:72f87b7c7400	1355	bitmap++;
Pokitto	7:72f87b7c7400	1356	}
Pokitto	7:72f87b7c7400	1357	bitmap+=xjump;
Pokitto	7:72f87b7c7400	1358	}
Pokitto	7:72f87b7c7400	1359	// increment the y jump in the scrptr
Pokitto	7:72f87b7c7400	1360	scrptr = scrptr + ((width - w)>>1)+scrxjump;
Pokitto	7:72f87b7c7400	1361	}
Pokitto	7:72f87b7c7400	1362	}
Pokitto	7:72f87b7c7400	1363
Pokitto	7:72f87b7c7400	1364	void Display::drawRleBitmap(int16_t x, int16_t y, const uint8_t* rlebitmap)
Pokitto	7:72f87b7c7400	1365	{
Pokitto	7:72f87b7c7400	1366	// ONLY can copy 4-bit bitmap to 4-bit screen mode for time being
Pokitto	7:72f87b7c7400	1367	#if (POK_SCREENMODE != MODE_FAST_16COLOR)
Pokitto	7:72f87b7c7400	1368	return;
Pokitto	7:72f87b7c7400	1369	#endif
Pokitto	7:72f87b7c7400	1370
Pokitto	7:72f87b7c7400	1371	int16_t w = *rlebitmap;
Pokitto	7:72f87b7c7400	1372	int16_t h = *(rlebitmap + 1);
Pokitto	7:72f87b7c7400	1373	rlebitmap = rlebitmap + 2; //add an offset to the pointer to start after the width and height
Pokitto	7:72f87b7c7400	1374
Pokitto	7:72f87b7c7400	1375	// visibility check
Pokitto	7:72f87b7c7400	1376	if (y<-h \|\| y>height) return; //invisible
Pokitto	7:72f87b7c7400	1377	if (x<-w \|\| x>width) return; //invisible
Pokitto	7:72f87b7c7400	1378
Pokitto	7:72f87b7c7400	1379	// Clipping is not supported
Pokitto	7:72f87b7c7400	1380	if ((x < 0) \|\| (x+w > width) \|\| (y < 0) \|\| (y+h > height)) return;
Pokitto	7:72f87b7c7400	1381
Pokitto	7:72f87b7c7400	1382	// Currently only support RLE bitmaps in 16 color mode.
Pokitto	7:72f87b7c7400	1383	if (m_colordepth != 4) //
Pokitto	7:72f87b7c7400	1384	return;
Pokitto	7:72f87b7c7400	1385
Pokitto	7:72f87b7c7400	1386	// Go through each line.
Pokitto	7:72f87b7c7400	1387	uint8_t* scrptr = m_scrbuf + (y*(width>>1) + (x>>1));
Pokitto	7:72f87b7c7400	1388	bool is_endofbitmap = false;
Pokitto	7:72f87b7c7400	1389	for (int16_t scry = y; scry < y+h && !is_endofbitmap;) {
Pokitto	7:72f87b7c7400	1390
Pokitto	7:72f87b7c7400	1391	// Process one line. Go through each pixel run and escape command in RLE data.
Pokitto	7:72f87b7c7400	1392	for (int16_t scrx = x;;) {
Pokitto	7:72f87b7c7400	1393	uint8_t rle_count = *rlebitmap++;
Pokitto	7:72f87b7c7400	1394
Pokitto	7:72f87b7c7400	1395	if (rle_count == 0) {
Pokitto	7:72f87b7c7400	1396
Pokitto	7:72f87b7c7400	1397	/** Escape or absolute mode */
Pokitto	7:72f87b7c7400	1398
Pokitto	7:72f87b7c7400	1399	uint8_t rle_escape_or_runsize = *rlebitmap++;
Pokitto	7:72f87b7c7400	1400	if ( rle_escape_or_runsize == RLE_ESC_EOL) {
Pokitto	7:72f87b7c7400	1401	// End of line.
Pokitto	7:72f87b7c7400	1402	break;
Pokitto	7:72f87b7c7400	1403	}
Pokitto	7:72f87b7c7400	1404	else if ( rle_escape_or_runsize == RLE_ESC_EOB) {
Pokitto	7:72f87b7c7400	1405	// End of bitmap.
Pokitto	7:72f87b7c7400	1406	is_endofbitmap = true;
Pokitto	7:72f87b7c7400	1407	break;
Pokitto	7:72f87b7c7400	1408	}
Pokitto	7:72f87b7c7400	1409	else if ( rle_escape_or_runsize == RLE_ESC_OFFSET) {
Pokitto	7:72f87b7c7400	1410	// Move position in target.
Pokitto	7:72f87b7c7400	1411	// TODO: not tested yet.
Pokitto	7:72f87b7c7400	1412	uint8_t xoffset = *rlebitmap++;
Pokitto	7:72f87b7c7400	1413	uint8_t yoffset = *rlebitmap++;
Pokitto	7:72f87b7c7400	1414	scrptr += (xoffset>1);
Pokitto	7:72f87b7c7400	1415	scrx += xoffset;
Pokitto	7:72f87b7c7400	1416	scrptr += yoffset*width;
Pokitto	7:72f87b7c7400	1417	scry += yoffset;
Pokitto	7:72f87b7c7400	1418	}
Pokitto	7:72f87b7c7400	1419	else {
Pokitto	7:72f87b7c7400	1420
Pokitto	7:72f87b7c7400	1421	/** Absolute mode. Copy pixels from the source bitmap to the target screen. */
Pokitto	7:72f87b7c7400	1422
Pokitto	7:72f87b7c7400	1423	int16_t runsize = rle_escape_or_runsize;
Pokitto	7:72f87b7c7400	1424	uint8_t targetpixel = *scrptr; // initial value
Pokitto	7:72f87b7c7400	1425	uint8_t sourcepixel = *rlebitmap; // initial value
Pokitto	7:72f87b7c7400	1426	for( int16_t runx = 0; runx < runsize; ) {
Pokitto	7:72f87b7c7400	1427	if (scrx&0x1) { // screen pixel is in the low nibble
Pokitto	7:72f87b7c7400	1428	if (runx&0x1) { // bitmap pixel is in the low nibble
Pokitto	7:72f87b7c7400	1429	if ((sourcepixel&0x0F) != invisiblecolor)
Pokitto	7:72f87b7c7400	1430	targetpixel = (targetpixel&0xF0) \| (sourcepixel&0x0F); // Copy low to low nibble.
Pokitto	7:72f87b7c7400	1431	rlebitmap++;
Pokitto	7:72f87b7c7400	1432	}
Pokitto	7:72f87b7c7400	1433	else // bitmap pixel is in the high nibble
Pokitto	7:72f87b7c7400	1434	if ((sourcepixel>>4) != invisiblecolor)
Pokitto	7:72f87b7c7400	1435	targetpixel = (targetpixel&0xF0) \| (sourcepixel>>4); // Copy high to low nibble.
Pokitto	7:72f87b7c7400	1436
Pokitto	7:72f87b7c7400	1437	// Copy the byte to the target.
Pokitto	7:72f87b7c7400	1438	*scrptr = targetpixel;
Pokitto	7:72f87b7c7400	1439	scrptr++;
Pokitto	7:72f87b7c7400	1440	}
Pokitto	7:72f87b7c7400	1441	else { // screen pixel is in the high nibble
Pokitto	7:72f87b7c7400	1442	targetpixel = *scrptr;
Pokitto	7:72f87b7c7400	1443	sourcepixel = *rlebitmap;
Pokitto	7:72f87b7c7400	1444	if (runx&0x1) { // bitmap pixel is sourcepixel = *rlebitmapin the low nibble
Pokitto	7:72f87b7c7400	1445	if ((sourcepixel&0x0F) != invisiblecolor )
Pokitto	7:72f87b7c7400	1446	targetpixel = (targetpixel&0x0F) \| ((sourcepixel<<4)&0xF0); // Copy low to high nibble.
Pokitto	7:72f87b7c7400	1447	rlebitmap++; // read the new source byte
Pokitto	7:72f87b7c7400	1448	}
Pokitto	7:72f87b7c7400	1449	else // bitmap pixel is in the high nibble
Pokitto	7:72f87b7c7400	1450	if ((sourcepixel>>4) != invisiblecolor )
Pokitto	7:72f87b7c7400	1451	targetpixel = (targetpixel&0x0F) \| (sourcepixel&0xF0); // Copy high to high nibble.
Pokitto	7:72f87b7c7400	1452	}
Pokitto	7:72f87b7c7400	1453	runx++;
Pokitto	7:72f87b7c7400	1454	scrx++;
Pokitto	7:72f87b7c7400	1455	} // end for
Pokitto	7:72f87b7c7400	1456
Pokitto	7:72f87b7c7400	1457	// If this is odd target index, copy the byte to the target.
Pokitto	7:72f87b7c7400	1458	if (scrx&0x1) {
Pokitto	7:72f87b7c7400	1459	*scrptr = targetpixel;
Pokitto	7:72f87b7c7400	1460	scrptr++;
Pokitto	7:72f87b7c7400	1461	}
Pokitto	7:72f87b7c7400	1462
Pokitto	7:72f87b7c7400	1463	// In absolute mode the source size is always padded to the word boundary.
Pokitto	7:72f87b7c7400	1464	if (runsize%4) {
Pokitto	7:72f87b7c7400	1465	int16_t padpixcount = 4 - (runsize%4);
Pokitto	7:72f87b7c7400	1466	rlebitmap += padpixcount>>1; // skip n padding bytes
Pokitto	7:72f87b7c7400	1467	}
Pokitto	7:72f87b7c7400	1468	}
Pokitto	7:72f87b7c7400	1469	}
Pokitto	7:72f87b7c7400	1470	else {
Pokitto	7:72f87b7c7400	1471
Pokitto	7:72f87b7c7400	1472	/** Encoded mode. Duplicate one pixel pair to the all required pixels on the target screen */
Pokitto	7:72f87b7c7400	1473
Pokitto	7:72f87b7c7400	1474	int16_t runsize = rle_count;
Pokitto	7:72f87b7c7400	1475	uint8_t clonepixelpair = *rlebitmap++;
Pokitto	7:72f87b7c7400	1476	uint8_t targetpixel = *scrptr; // initial value
Pokitto	7:72f87b7c7400	1477	for( int16_t runx = 0; runx < runsize; ) {
Pokitto	7:72f87b7c7400	1478	if (scrx&0x1) { // screen pixel is in the low nibble
Pokitto	7:72f87b7c7400	1479	if (runx&0x1) { // bitmap pixel is in the low nibble
Pokitto	7:72f87b7c7400	1480	if ((clonepixelpair&0x0F) != invisiblecolor)
Pokitto	7:72f87b7c7400	1481	targetpixel = (targetpixel&0xF0) \| (clonepixelpair&0x0F); // Copy low to low nibble.
Pokitto	7:72f87b7c7400	1482	}
Pokitto	7:72f87b7c7400	1483	else // bitmap pixel is in the high nibble
Pokitto	7:72f87b7c7400	1484	if ((clonepixelpair>>4) != invisiblecolor)
Pokitto	7:72f87b7c7400	1485	targetpixel = (targetpixel&0xF0) \| (clonepixelpair>>4); // Copy high to low nibble.
Pokitto	7:72f87b7c7400	1486
Pokitto	7:72f87b7c7400	1487	// Copy the byte to the target.
Pokitto	7:72f87b7c7400	1488	*scrptr = targetpixel;
Pokitto	7:72f87b7c7400	1489	scrptr++;
Pokitto	7:72f87b7c7400	1490	}
Pokitto	7:72f87b7c7400	1491	else { // screen pixel is in the high nibble
Pokitto	7:72f87b7c7400	1492	targetpixel = *scrptr;
Pokitto	7:72f87b7c7400	1493	if (runx&0x1) {// bitmap pixel is in the low nibble
Pokitto	7:72f87b7c7400	1494	if ((clonepixelpair&0x0F) != invisiblecolor )
Pokitto	7:72f87b7c7400	1495	targetpixel = (targetpixel&0x0F) \| ((clonepixelpair<<4)&0xF0); // Copy low to high nibble.
Pokitto	7:72f87b7c7400	1496	}
Pokitto	7:72f87b7c7400	1497	else // bitmap pixel is in the high nibble
Pokitto	7:72f87b7c7400	1498	if ((clonepixelpair>>4) != invisiblecolor )
Pokitto	7:72f87b7c7400	1499	targetpixel = (targetpixel&0x0F) \| (clonepixelpair&0xF0); // Copy high to high nibble.
Pokitto	7:72f87b7c7400	1500	}
Pokitto	7:72f87b7c7400	1501	runx++;
Pokitto	7:72f87b7c7400	1502	scrx++;
Pokitto	7:72f87b7c7400	1503
Pokitto	7:72f87b7c7400	1504	} // end for
Pokitto	7:72f87b7c7400	1505
Pokitto	7:72f87b7c7400	1506	// If this is odd target index, copy the byte to the target.
Pokitto	7:72f87b7c7400	1507	if (scrx&0x1) {
Pokitto	7:72f87b7c7400	1508	*scrptr = targetpixel;
Pokitto	7:72f87b7c7400	1509	scrptr++;
Pokitto	7:72f87b7c7400	1510	}
Pokitto	7:72f87b7c7400	1511	} // end if
Pokitto	7:72f87b7c7400	1512	} // end while
Pokitto	7:72f87b7c7400	1513
Pokitto	7:72f87b7c7400	1514	// Increment the target screen pointer and index.
Pokitto	7:72f87b7c7400	1515	scrptr = scrptr + ((width - w)>>1);
Pokitto	7:72f87b7c7400	1516	scry++;
Pokitto	7:72f87b7c7400	1517	} // end for scry
Pokitto	7:72f87b7c7400	1518	}
Pokitto	7:72f87b7c7400	1519
Pokitto	7:72f87b7c7400	1520	void Display::drawBitmapXFlipped(int16_t x, int16_t y, const uint8_t* bitmap)
Pokitto	7:72f87b7c7400	1521	{
Pokitto	7:72f87b7c7400	1522	int16_t w = *bitmap;
Pokitto	7:72f87b7c7400	1523	int16_t h = *(bitmap + 1);
Pokitto	7:72f87b7c7400	1524	bitmap = bitmap + 2; //add an offset to the pointer to start after the width and height
Pokitto	7:72f87b7c7400	1525	/** visibility check */
Pokitto	7:72f87b7c7400	1526	if (y<-h \|\| y>height) return; //invisible
Pokitto	7:72f87b7c7400	1527	if (x<-w \|\| x>width) return; //invisible
Pokitto	7:72f87b7c7400	1528	/** 1 bpp mode */
Pokitto	7:72f87b7c7400	1529	if (m_colordepth<2) {
Pokitto	7:72f87b7c7400	1530	int16_t i, j, byteNum, bitNum, byteWidth = (w + 7) >> 3;
Pokitto	7:72f87b7c7400	1531	for (i = 0; i < w; i++) {
Pokitto	7:72f87b7c7400	1532	byteNum = i / 8;
Pokitto	7:72f87b7c7400	1533	bitNum = i % 8;
Pokitto	7:72f87b7c7400	1534	for (j = 0; j < h; j++) {
Pokitto	7:72f87b7c7400	1535	uint8_t source = (bitmap + j byteWidth + byteNum);
Pokitto	7:72f87b7c7400	1536	if (source & (0x80 >> bitNum)) {
Pokitto	7:72f87b7c7400	1537	drawPixel(x + w - i, y + j);
Pokitto	7:72f87b7c7400	1538	}
Pokitto	7:72f87b7c7400	1539	}
Pokitto	7:72f87b7c7400	1540	}
Pokitto	7:72f87b7c7400	1541
Pokitto	7:72f87b7c7400	1542	return;
Pokitto	7:72f87b7c7400	1543	}
Pokitto	7:72f87b7c7400	1544	/** 2 bpp mode */
Pokitto	7:72f87b7c7400	1545	if (m_colordepth<4) {
Pokitto	7:72f87b7c7400	1546	int16_t i, j, byteNum, bitNum, byteWidth = w >> 2;
Pokitto	7:72f87b7c7400	1547	for (i = 0; i < w; i++) {
Pokitto	7:72f87b7c7400	1548	byteNum = i / 4;
Pokitto	7:72f87b7c7400	1549	bitNum = (i % 4)<<1;
Pokitto	7:72f87b7c7400	1550	for (j = 0; j < h; j++) {
Pokitto	7:72f87b7c7400	1551	uint8_t source = (bitmap + j byteWidth + byteNum);
Pokitto	7:72f87b7c7400	1552	uint8_t output = (source & (0xC0 >> bitNum));
Pokitto	7:72f87b7c7400	1553	output >>= (6-bitNum);
Pokitto	7:72f87b7c7400	1554	if (output != invisiblecolor) {
Pokitto	7:72f87b7c7400	1555	setColor(output);
Pokitto	7:72f87b7c7400	1556	drawPixel(x + i, y + j);
Pokitto	7:72f87b7c7400	1557	}
Pokitto	7:72f87b7c7400	1558	}
Pokitto	7:72f87b7c7400	1559	}
Pokitto	7:72f87b7c7400	1560
Pokitto	7:72f87b7c7400	1561	return;
Pokitto	7:72f87b7c7400	1562	}
Pokitto	7:72f87b7c7400	1563	/** 4bpp fast version */
Pokitto	7:72f87b7c7400	1564	int16_t scrx,scry,xclip,xjump,scrxjump;
Pokitto	7:72f87b7c7400	1565	xclip=xjump=scrxjump=0;
Pokitto	7:72f87b7c7400	1566	/** y clipping */
Pokitto	7:72f87b7c7400	1567	if (y<0) { h+=y; bitmap -= y*(w>>1); y=0;}
Pokitto	7:72f87b7c7400	1568	else if (y+h>height) { h -=(y-height);}
Pokitto	7:72f87b7c7400	1569	/** x clipping */
Pokitto	7:72f87b7c7400	1570	bitmap += ((w>>1)-1); //inverted!
Pokitto	7:72f87b7c7400	1571	if (x<0) {
Pokitto	7:72f87b7c7400	1572	xclip=(x&1)<<1;
Pokitto	7:72f87b7c7400	1573	w+=x;
Pokitto	7:72f87b7c7400	1574	xjump = ((-x)>>1);
Pokitto	7:72f87b7c7400	1575	//bitmap += xjump; // do not clip left edge of source, as bitmap is inverted !
Pokitto	7:72f87b7c7400	1576	x=0;
Pokitto	7:72f87b7c7400	1577	}
Pokitto	7:72f87b7c7400	1578	else if (x+w>width) {
Pokitto	7:72f87b7c7400	1579	xclip = (x&1)<<1;
Pokitto	7:72f87b7c7400	1580	scrxjump = x&1;
Pokitto	7:72f87b7c7400	1581	xjump=((x+w-width)>>1)+scrxjump;
Pokitto	7:72f87b7c7400	1582	w = width-x;}
Pokitto	7:72f87b7c7400	1583
Pokitto	7:72f87b7c7400	1584	//uint8_t* scrptr = m_scrbuf + (y*(width>>1) + ((x+width)>>1));
Pokitto	7:72f87b7c7400	1585	uint8_t* scrptr = m_scrbuf + (y*(width>>1) + (x>>1));
Pokitto	7:72f87b7c7400	1586	/ ONLY 4-bit mode for time being /
Pokitto	7:72f87b7c7400	1587	for (scry = y; scry < y+h; scry+=1) {
Pokitto	7:72f87b7c7400	1588	// for (scry = y; scry < y+2; scry+=1) {
Pokitto	7:72f87b7c7400	1589	if (scry>=height) return;
Pokitto	7:72f87b7c7400	1590	if ((x&1)==0) { / EVEN pixel starting line, very simple, just copypaste /
Pokitto	7:72f87b7c7400	1591	//for (scrx = w+x-xclip-1; scrx >= x; scrx-=2) {
Pokitto	7:72f87b7c7400	1592	for (scrx = x; scrx < w+x-xclip; scrx+=2) {
Pokitto	7:72f87b7c7400	1593	uint8_t sourcepixel = *(bitmap);
Pokitto	7:72f87b7c7400	1594	if (xclip) {
Pokitto	7:72f87b7c7400	1595	sourcepixel <<=4;
Pokitto	7:72f87b7c7400	1596	sourcepixel \|= ((*(bitmap-1))>>4);//inverted!
Pokitto	7:72f87b7c7400	1597	}
Pokitto	7:72f87b7c7400	1598	uint8_t targetpixel = *scrptr;
Pokitto	7:72f87b7c7400	1599	// NIBBLES ARE INVERTED BECAUSE PICTURE IS FLIPPED !!!
Pokitto	7:72f87b7c7400	1600	if ((sourcepixel>>4) != invisiblecolor ) targetpixel = (targetpixel&0xF0) \| (sourcepixel>>4);
Pokitto	7:72f87b7c7400	1601	if ((sourcepixel&0x0F) != invisiblecolor) targetpixel = (targetpixel & 0x0F) \| (sourcepixel<<4);
Pokitto	7:72f87b7c7400	1602	*scrptr = targetpixel;
Pokitto	7:72f87b7c7400	1603	bitmap--;
Pokitto	7:72f87b7c7400	1604	scrptr++;
Pokitto	7:72f87b7c7400	1605	}
Pokitto	7:72f87b7c7400	1606	bitmap += w; // w*2 >> 1 because inverted and because 2 pixels per byte!!
Pokitto	7:72f87b7c7400	1607	if (xclip){
Pokitto	7:72f87b7c7400	1608	if (w&1) {
Pokitto	7:72f87b7c7400	1609	/*last pixel is odd pixel due to clipping & odd width/
Pokitto	7:72f87b7c7400	1610	uint8_t sourcepixel = *bitmap;
Pokitto	7:72f87b7c7400	1611	if ((sourcepixel&0x0F) != invisiblecolor) {
Pokitto	7:72f87b7c7400	1612	sourcepixel <<=4;
Pokitto	7:72f87b7c7400	1613	uint8_t targetpixel = *scrptr;// & 0x0F;
Pokitto	7:72f87b7c7400	1614	targetpixel \|= sourcepixel;
Pokitto	7:72f87b7c7400	1615	*scrptr = targetpixel;
Pokitto	7:72f87b7c7400	1616	}
Pokitto	7:72f87b7c7400	1617	//scrptr++;
Pokitto	7:72f87b7c7400	1618	}
Pokitto	7:72f87b7c7400	1619	bitmap++;
Pokitto	7:72f87b7c7400	1620	scrptr++;
Pokitto	7:72f87b7c7400	1621	}
Pokitto	7:72f87b7c7400	1622	bitmap += xjump; // needed if x<0 clipping occurs
Pokitto	7:72f87b7c7400	1623	} else { / ODD pixel starting line /
Pokitto	7:72f87b7c7400	1624	for (scrx = x; scrx < w+x-xclip; scrx+=2 ) {
Pokitto	7:72f87b7c7400	1625	uint8_t sourcepixel = *bitmap;
Pokitto	7:72f87b7c7400	1626	uint8_t targetpixel = *scrptr;
Pokitto	7:72f87b7c7400	1627	// inverted !!! store lower nibble of source pixel in lower nibble of target
Pokitto	7:72f87b7c7400	1628	if((sourcepixel&0x0F)!=invisiblecolor) targetpixel = (targetpixel & 0xF0) \| (sourcepixel & 0x0F );
Pokitto	7:72f87b7c7400	1629	*scrptr = targetpixel;
Pokitto	7:72f87b7c7400	1630	scrptr++;
Pokitto	7:72f87b7c7400	1631	targetpixel = *scrptr;
Pokitto	7:72f87b7c7400	1632	// inverted ! store higher nibble of source pixel in higher nibble of target
Pokitto	7:72f87b7c7400	1633	if((sourcepixel>>4)!=invisiblecolor) targetpixel = (targetpixel & 0x0F) \| (sourcepixel & 0xF0);
Pokitto	7:72f87b7c7400	1634	*scrptr = targetpixel;
Pokitto	7:72f87b7c7400	1635	bitmap--;
Pokitto	7:72f87b7c7400	1636	}
Pokitto	7:72f87b7c7400	1637	bitmap += w; // w*2 >> 1 because inverted and because 2 pixels per byte!!
Pokitto	7:72f87b7c7400	1638	bitmap+=xjump;
Pokitto	7:72f87b7c7400	1639	}
Pokitto	7:72f87b7c7400	1640	// increment the y jump in the scrptr
Pokitto	7:72f87b7c7400	1641	scrptr = scrptr + ((width - w)>>1)+scrxjump;
Pokitto	7:72f87b7c7400	1642	}
Pokitto	7:72f87b7c7400	1643	}
Pokitto	7:72f87b7c7400	1644
Pokitto	7:72f87b7c7400	1645	void Display::drawBitmap(int16_t x, int16_t y, const uint8_t *bitmap, uint8_t rotation, uint8_t flip) {
Pokitto	7:72f87b7c7400	1646	#if PROJ_GAMEBUINO == 0
Pokitto	7:72f87b7c7400	1647	if (!flip) drawBitmap(x,y,bitmap);
Pokitto	7:72f87b7c7400	1648	else drawBitmapXFlipped(x,y,bitmap);
Pokitto	7:72f87b7c7400	1649	#else
Pokitto	7:72f87b7c7400	1650	if((rotation == NOROT) && (flip == NOFLIP)){
Pokitto	7:72f87b7c7400	1651	drawBitmap(x,y,bitmap); //use the faster algorithm
Pokitto	7:72f87b7c7400	1652	return;
Pokitto	7:72f87b7c7400	1653	}
Pokitto	7:72f87b7c7400	1654	uint8_t w = bitmap[0];
Pokitto	7:72f87b7c7400	1655	uint8_t h = bitmap[1];
Pokitto	7:72f87b7c7400	1656	bitmap = bitmap + 2; //add an offset to the pointer to start after the width and height
Pokitto	7:72f87b7c7400	1657	int8_t i, j, //coordinates in the raw bitmap
Pokitto	7:72f87b7c7400	1658	k, l, //coordinates in the rotated/flipped bitmap
Pokitto	7:72f87b7c7400	1659	byteNum, bitNum, byteWidth = (w + 7) >> 3;
Pokitto	7:72f87b7c7400	1660
Pokitto	7:72f87b7c7400	1661	rotation %= 4;
Pokitto	7:72f87b7c7400	1662
Pokitto	7:72f87b7c7400	1663	for (i = 0; i < w; i++) {
Pokitto	7:72f87b7c7400	1664	byteNum = i / 8;
Pokitto	7:72f87b7c7400	1665	bitNum = i % 8;
Pokitto	7:72f87b7c7400	1666	for (j = 0; j < h; j++) {
Pokitto	7:72f87b7c7400	1667	if (bitmap[j * byteWidth + byteNum] & (B10000000 >> bitNum)) {
Pokitto	7:72f87b7c7400	1668	switch (rotation) {
Pokitto	7:72f87b7c7400	1669	case NOROT: //no rotation
Pokitto	7:72f87b7c7400	1670	k = i;
Pokitto	7:72f87b7c7400	1671	l = j;
Pokitto	7:72f87b7c7400	1672	break;
Pokitto	7:72f87b7c7400	1673	case ROTCCW: //90� counter-clockwise
Pokitto	7:72f87b7c7400	1674	k = j;
Pokitto	7:72f87b7c7400	1675	l = w - i - 1;
Pokitto	7:72f87b7c7400	1676	break;
Pokitto	7:72f87b7c7400	1677	case ROT180: //180�
Pokitto	7:72f87b7c7400	1678	k = w - i - 1;
Pokitto	7:72f87b7c7400	1679	l = h - j - 1;
Pokitto	7:72f87b7c7400	1680	break;
Pokitto	7:72f87b7c7400	1681	case ROTCW: //90� clockwise
Pokitto	7:72f87b7c7400	1682	k = h - j - 1;
Pokitto	7:72f87b7c7400	1683	l = i;
Pokitto	7:72f87b7c7400	1684	break;
Pokitto	7:72f87b7c7400	1685	}
Pokitto	7:72f87b7c7400	1686	if (flip) {
Pokitto	7:72f87b7c7400	1687	flip %= 4;
Pokitto	7:72f87b7c7400	1688	if (flip & B00000001) { //horizontal flip
Pokitto	7:72f87b7c7400	1689	k = w - k;
Pokitto	7:72f87b7c7400	1690	}
Pokitto	7:72f87b7c7400	1691	if (flip & B00000010) { //vertical flip
Pokitto	7:72f87b7c7400	1692	l = h - l;
Pokitto	7:72f87b7c7400	1693	}
Pokitto	7:72f87b7c7400	1694	}
Pokitto	7:72f87b7c7400	1695	k += x; //place the bitmap on the screen
Pokitto	7:72f87b7c7400	1696	l += y;
Pokitto	7:72f87b7c7400	1697	drawPixel(k, l);
Pokitto	7:72f87b7c7400	1698	}
Pokitto	7:72f87b7c7400	1699	}
Pokitto	7:72f87b7c7400	1700	}
Pokitto	7:72f87b7c7400	1701	#endif //PROJ_GAMEBUINO
Pokitto	7:72f87b7c7400	1702
Pokitto	7:72f87b7c7400	1703	}
Pokitto	7:72f87b7c7400	1704
Pokitto	7:72f87b7c7400	1705	uint8_t* Display::getBuffer() {
Pokitto	7:72f87b7c7400	1706	return m_scrbuf;
Pokitto	7:72f87b7c7400	1707	}
Pokitto	7:72f87b7c7400	1708
Pokitto	7:72f87b7c7400	1709	uint8_t Display::getBitmapPixel(const uint8_t* bitmap, uint16_t x, uint16_t y) {
Pokitto	7:72f87b7c7400	1710	uint16_t w = *bitmap;
Pokitto	7:72f87b7c7400	1711	uint8_t sourcebyte = bitmap[2+(y * ((w+7)>>3))+ (x>>3)];
Pokitto	7:72f87b7c7400	1712	return sourcebyte & (0x80>>(x&7));
Pokitto	7:72f87b7c7400	1713	}
Pokitto	7:72f87b7c7400	1714
Pokitto	7:72f87b7c7400	1715	int Display::print_char(uint8_t x, uint8_t y, unsigned char c) {
Pokitto	7:72f87b7c7400	1716	c -= font[2];
Pokitto	7:72f87b7c7400	1717	if (m_mode) return directChar(x,y,c);
Pokitto	7:72f87b7c7400	1718	return bufferChar(x,y,c);
Pokitto	7:72f87b7c7400	1719	}
Pokitto	7:72f87b7c7400	1720
Pokitto	7:72f87b7c7400	1721	void Display::drawChar(int8_t x, int8_t y, unsigned char c, uint8_t size) {
Pokitto	7:72f87b7c7400	1722	print_char(x,y,c);
Pokitto	7:72f87b7c7400	1723	return;
Pokitto	7:72f87b7c7400	1724	}
Pokitto	7:72f87b7c7400	1725
Pokitto	7:72f87b7c7400	1726
Pokitto	7:72f87b7c7400	1727	bool Display::isDirectPrintingEnabled() {
Pokitto	7:72f87b7c7400	1728	return m_mode;
Pokitto	7:72f87b7c7400	1729	}
Pokitto	7:72f87b7c7400	1730
Pokitto	7:72f87b7c7400	1731	void Display::enableDirectPrinting(uint8_t m) {
Pokitto	7:72f87b7c7400	1732	if (m) {
Pokitto	7:72f87b7c7400	1733	m_mode=true;
Pokitto	7:72f87b7c7400	1734	m_w = POK_LCD_W;
Pokitto	7:72f87b7c7400	1735	m_h = POK_LCD_H;
Pokitto	7:72f87b7c7400	1736	} else {
Pokitto	7:72f87b7c7400	1737	m_mode=false;
Pokitto	7:72f87b7c7400	1738	m_w = getWidth();
Pokitto	7:72f87b7c7400	1739	m_h = getHeight();
Pokitto	7:72f87b7c7400	1740	}
Pokitto	7:72f87b7c7400	1741	}
Pokitto	7:72f87b7c7400	1742
Pokitto	7:72f87b7c7400	1743	void Display::write(uint8_t c) {
Pokitto	7:72f87b7c7400	1744	int charstep=0;
Pokitto	7:72f87b7c7400	1745	if(font[3]) {
Pokitto	7:72f87b7c7400	1746	// only caps in this font
Pokitto	7:72f87b7c7400	1747	if (c>=97) c-=32;
Pokitto	7:72f87b7c7400	1748	}
Pokitto	7:72f87b7c7400	1749	switch(c) {
Pokitto	7:72f87b7c7400	1750	case '\0': //null
Pokitto	7:72f87b7c7400	1751	break;
Pokitto	7:72f87b7c7400	1752	case '\n': //line feed
Pokitto	7:72f87b7c7400	1753	cursorX = 0;
Pokitto	7:72f87b7c7400	1754	inc_txtline();
Pokitto	7:72f87b7c7400	1755	break;
Pokitto	7:72f87b7c7400	1756	case 8: //backspace
Pokitto	7:72f87b7c7400	1757	cursorX -= font[0];
Pokitto	7:72f87b7c7400	1758	charstep=print_char(cursorX,cursorY,' ');
Pokitto	7:72f87b7c7400	1759	break;
Pokitto	7:72f87b7c7400	1760	case 13: //carriage return
Pokitto	7:72f87b7c7400	1761	cursorX = 0;
Pokitto	7:72f87b7c7400	1762	break;
Pokitto	7:72f87b7c7400	1763	case 14: //form feed new page(clear screen)
Pokitto	7:72f87b7c7400	1764	//clear_screen();
Pokitto	7:72f87b7c7400	1765	break;
Pokitto	7:72f87b7c7400	1766	default:
Pokitto	7:72f87b7c7400	1767	if (cursorX >= (m_w - font[0])) {
Pokitto	7:72f87b7c7400	1768	cursorX = 0;
Pokitto	7:72f87b7c7400	1769	if (textWrap) inc_txtline();
Pokitto	7:72f87b7c7400	1770	else return; // stop outputting text
Pokitto	7:72f87b7c7400	1771	charstep=print_char(cursorX,cursorY,c);
Pokitto	7:72f87b7c7400	1772	}
Pokitto	7:72f87b7c7400	1773	else
Pokitto	7:72f87b7c7400	1774	charstep=print_char(cursorX,cursorY,c);
Pokitto	7:72f87b7c7400	1775	if (c==' ' && adjustCharStep) charstep=(charstep>>1)+1;
Pokitto	7:72f87b7c7400	1776	cursorX += charstep;
Pokitto	7:72f87b7c7400	1777	}
Pokitto	7:72f87b7c7400	1778	}
Pokitto	7:72f87b7c7400	1779
Pokitto	7:72f87b7c7400	1780	void Display::inc_txtline() {
Pokitto	7:72f87b7c7400	1781	if (cursorY > m_h - 2*font[1]) //= (height - (font[1]+1)))
Pokitto	7:72f87b7c7400	1782	#if SCROLL_TEXT > 0
Pokitto	7:72f87b7c7400	1783	scroll(font[1] + adjustLineStep);
Pokitto	7:72f87b7c7400	1784	#else
Pokitto	7:72f87b7c7400	1785	cursorY = 0;
Pokitto	7:72f87b7c7400	1786	#endif
Pokitto	7:72f87b7c7400	1787	else
Pokitto	7:72f87b7c7400	1788	cursorY += font[1] + adjustLineStep;
Pokitto	7:72f87b7c7400	1789	}
Pokitto	7:72f87b7c7400	1790
Pokitto	7:72f87b7c7400	1791	/* default implementation: may be overridden */
Pokitto	7:72f87b7c7400	1792	void Display::write(const char *str)
Pokitto	7:72f87b7c7400	1793	{
Pokitto	7:72f87b7c7400	1794	while (*str)
Pokitto	7:72f87b7c7400	1795	write(*str++);
Pokitto	7:72f87b7c7400	1796	}
Pokitto	7:72f87b7c7400	1797
Pokitto	7:72f87b7c7400	1798	/* default implementation: may be overridden */
Pokitto	7:72f87b7c7400	1799	void Display::write(const uint8_t *buffer, uint8_t size)
Pokitto	7:72f87b7c7400	1800	{
Pokitto	7:72f87b7c7400	1801	while (size--)
Pokitto	7:72f87b7c7400	1802	write(*buffer++);
Pokitto	7:72f87b7c7400	1803	}
Pokitto	7:72f87b7c7400	1804
Pokitto	7:72f87b7c7400	1805	void Display::print(const char str[])
Pokitto	7:72f87b7c7400	1806	{
Pokitto	7:72f87b7c7400	1807	write(str);
Pokitto	7:72f87b7c7400	1808	}
Pokitto	7:72f87b7c7400	1809
Pokitto	7:72f87b7c7400	1810	void Display::print(char c, int base)
Pokitto	7:72f87b7c7400	1811	{
Pokitto	7:72f87b7c7400	1812	print((long) c, base);
Pokitto	7:72f87b7c7400	1813	}
Pokitto	7:72f87b7c7400	1814
Pokitto	7:72f87b7c7400	1815	void Display::print(unsigned char b, int base)
Pokitto	7:72f87b7c7400	1816	{
Pokitto	7:72f87b7c7400	1817	print((unsigned long) b, base);
Pokitto	7:72f87b7c7400	1818	}
Pokitto	7:72f87b7c7400	1819
Pokitto	7:72f87b7c7400	1820	void Display::print(int n, int base)
Pokitto	7:72f87b7c7400	1821	{
Pokitto	7:72f87b7c7400	1822	print((long) n, base);
Pokitto	7:72f87b7c7400	1823	}
Pokitto	7:72f87b7c7400	1824
Pokitto	7:72f87b7c7400	1825	void Display::print(unsigned int n, int base)
Pokitto	7:72f87b7c7400	1826	{
Pokitto	7:72f87b7c7400	1827	print((unsigned long) n, base);
Pokitto	7:72f87b7c7400	1828	}
Pokitto	7:72f87b7c7400	1829
Pokitto	7:72f87b7c7400	1830	void Display::print(long n, int base)
Pokitto	7:72f87b7c7400	1831	{
Pokitto	7:72f87b7c7400	1832	if (base == 0) {
Pokitto	7:72f87b7c7400	1833	write(n);
Pokitto	7:72f87b7c7400	1834	} else if (base == 10) {
Pokitto	7:72f87b7c7400	1835	if (n < 0) {
Pokitto	7:72f87b7c7400	1836	print('-');
Pokitto	7:72f87b7c7400	1837	n = -n;
Pokitto	7:72f87b7c7400	1838	}
Pokitto	7:72f87b7c7400	1839	printNumber(n, 10);
Pokitto	7:72f87b7c7400	1840	} else {
Pokitto	7:72f87b7c7400	1841	printNumber(n, base);
Pokitto	7:72f87b7c7400	1842	}
Pokitto	7:72f87b7c7400	1843	}
Pokitto	7:72f87b7c7400	1844
Pokitto	7:72f87b7c7400	1845	void Display::print(unsigned long n, int base)
Pokitto	7:72f87b7c7400	1846	{
Pokitto	7:72f87b7c7400	1847	if (base == 0) write(n);
Pokitto	7:72f87b7c7400	1848	else printNumber(n, base);
Pokitto	7:72f87b7c7400	1849	}
Pokitto	7:72f87b7c7400	1850
Pokitto	7:72f87b7c7400	1851	void Display::print(double n, int digits)
Pokitto	7:72f87b7c7400	1852	{
Pokitto	7:72f87b7c7400	1853	printFloat(n, digits);
Pokitto	7:72f87b7c7400	1854	}
Pokitto	7:72f87b7c7400	1855
Pokitto	7:72f87b7c7400	1856	void Display::println(void)
Pokitto	7:72f87b7c7400	1857	{
Pokitto	7:72f87b7c7400	1858	print('\r');
Pokitto	7:72f87b7c7400	1859	print('\n');
Pokitto	7:72f87b7c7400	1860	}
Pokitto	7:72f87b7c7400	1861
Pokitto	7:72f87b7c7400	1862	void Display::println(const char c[])
Pokitto	7:72f87b7c7400	1863	{
Pokitto	7:72f87b7c7400	1864	print(c);
Pokitto	7:72f87b7c7400	1865	println();
Pokitto	7:72f87b7c7400	1866	}
Pokitto	7:72f87b7c7400	1867
Pokitto	7:72f87b7c7400	1868	void Display::println(char c, int base)
Pokitto	7:72f87b7c7400	1869	{
Pokitto	7:72f87b7c7400	1870	print(c, base);
Pokitto	7:72f87b7c7400	1871	println();
Pokitto	7:72f87b7c7400	1872	}
Pokitto	7:72f87b7c7400	1873
Pokitto	7:72f87b7c7400	1874	void Display::println(unsigned char b, int base)
Pokitto	7:72f87b7c7400	1875	{
Pokitto	7:72f87b7c7400	1876	print(b, base);
Pokitto	7:72f87b7c7400	1877	println();
Pokitto	7:72f87b7c7400	1878	}
Pokitto	7:72f87b7c7400	1879
Pokitto	7:72f87b7c7400	1880	void Display::println(int n, int base)
Pokitto	7:72f87b7c7400	1881	{
Pokitto	7:72f87b7c7400	1882	print(n, base);
Pokitto	7:72f87b7c7400	1883	println();
Pokitto	7:72f87b7c7400	1884	}
Pokitto	7:72f87b7c7400	1885
Pokitto	7:72f87b7c7400	1886	void Display::println(unsigned int n, int base)
Pokitto	7:72f87b7c7400	1887	{
Pokitto	7:72f87b7c7400	1888	print(n, base);
Pokitto	7:72f87b7c7400	1889	println();
Pokitto	7:72f87b7c7400	1890	}
Pokitto	7:72f87b7c7400	1891
Pokitto	7:72f87b7c7400	1892	void Display::println(long n, int base)
Pokitto	7:72f87b7c7400	1893	{
Pokitto	7:72f87b7c7400	1894	print(n, base);
Pokitto	7:72f87b7c7400	1895	println();
Pokitto	7:72f87b7c7400	1896	}
Pokitto	7:72f87b7c7400	1897
Pokitto	7:72f87b7c7400	1898	void Display::println(unsigned long n, int base)
Pokitto	7:72f87b7c7400	1899	{
Pokitto	7:72f87b7c7400	1900	print(n, base);
Pokitto	7:72f87b7c7400	1901	println();
Pokitto	7:72f87b7c7400	1902	}
Pokitto	7:72f87b7c7400	1903
Pokitto	7:72f87b7c7400	1904	void Display::println(double n, int digits)
Pokitto	7:72f87b7c7400	1905	{
Pokitto	7:72f87b7c7400	1906	print(n, digits);
Pokitto	7:72f87b7c7400	1907	println();
Pokitto	7:72f87b7c7400	1908	}
Pokitto	7:72f87b7c7400	1909
Pokitto	7:72f87b7c7400	1910	void Display::set_cursor(uint8_t x, uint8_t y) {
Pokitto	7:72f87b7c7400	1911	cursorX = x;
Pokitto	7:72f87b7c7400	1912	cursorY = y;
Pokitto	7:72f87b7c7400	1913	}
Pokitto	7:72f87b7c7400	1914
Pokitto	7:72f87b7c7400	1915	void Display::print(uint8_t x, uint8_t y, const char str[]) {
Pokitto	7:72f87b7c7400	1916	cursorX = x;
Pokitto	7:72f87b7c7400	1917	cursorY = y;
Pokitto	7:72f87b7c7400	1918	write(str);
Pokitto	7:72f87b7c7400	1919
Pokitto	7:72f87b7c7400	1920	}
Pokitto	7:72f87b7c7400	1921	void Display::print(uint8_t x, uint8_t y, char c, int base) {
Pokitto	7:72f87b7c7400	1922	cursorX = x;
Pokitto	7:72f87b7c7400	1923	cursorY = y;
Pokitto	7:72f87b7c7400	1924	print((long) c, base);
Pokitto	7:72f87b7c7400	1925	}
Pokitto	7:72f87b7c7400	1926	void Display::print(uint8_t x, uint8_t y, unsigned char b, int base) {
Pokitto	7:72f87b7c7400	1927	cursorX = x;
Pokitto	7:72f87b7c7400	1928	cursorY = y;
Pokitto	7:72f87b7c7400	1929	print((unsigned long) b, base);
Pokitto	7:72f87b7c7400	1930	}
Pokitto	7:72f87b7c7400	1931	void Display::print(uint8_t x, uint8_t y, int n, int base) {
Pokitto	7:72f87b7c7400	1932	cursorX = x;
Pokitto	7:72f87b7c7400	1933	cursorY = y;
Pokitto	7:72f87b7c7400	1934	print((long) n, base);
Pokitto	7:72f87b7c7400	1935	}
Pokitto	7:72f87b7c7400	1936	void Display::print(uint8_t x, uint8_t y, unsigned int n, int base) {
Pokitto	7:72f87b7c7400	1937	cursorX = x;
Pokitto	7:72f87b7c7400	1938	cursorY = y;
Pokitto	7:72f87b7c7400	1939	print((unsigned long) n, base);
Pokitto	7:72f87b7c7400	1940	}
Pokitto	7:72f87b7c7400	1941	void Display::print(uint8_t x, uint8_t y, long n, int base) {
Pokitto	7:72f87b7c7400	1942	cursorX = x;
Pokitto	7:72f87b7c7400	1943	cursorY = y;
Pokitto	7:72f87b7c7400	1944	print(n,base);
Pokitto	7:72f87b7c7400	1945	}
Pokitto	7:72f87b7c7400	1946	void Display::print(uint8_t x, uint8_t y, unsigned long n, int base) {
Pokitto	7:72f87b7c7400	1947	cursorX = x;
Pokitto	7:72f87b7c7400	1948	cursorY = y;
Pokitto	7:72f87b7c7400	1949	print(n,base);
Pokitto	7:72f87b7c7400	1950	}
Pokitto	7:72f87b7c7400	1951	void Display::print(uint8_t x, uint8_t y, double n, int digits) {
Pokitto	7:72f87b7c7400	1952	cursorX = x;
Pokitto	7:72f87b7c7400	1953	cursorY = y;
Pokitto	7:72f87b7c7400	1954	print(n,digits);
Pokitto	7:72f87b7c7400	1955	}
Pokitto	7:72f87b7c7400	1956
Pokitto	7:72f87b7c7400	1957	void Display::println(uint8_t x, uint8_t y, const char c[])
Pokitto	7:72f87b7c7400	1958	{
Pokitto	7:72f87b7c7400	1959	cursorX = x;
Pokitto	7:72f87b7c7400	1960	cursorY = y;
Pokitto	7:72f87b7c7400	1961	print(c);
Pokitto	7:72f87b7c7400	1962	println();
Pokitto	7:72f87b7c7400	1963	}
Pokitto	7:72f87b7c7400	1964
Pokitto	7:72f87b7c7400	1965	void Display::println(uint8_t x, uint8_t y, char c, int base)
Pokitto	7:72f87b7c7400	1966	{
Pokitto	7:72f87b7c7400	1967	cursorX = x;
Pokitto	7:72f87b7c7400	1968	cursorY = y;
Pokitto	7:72f87b7c7400	1969	print(c, base);
Pokitto	7:72f87b7c7400	1970	println();
Pokitto	7:72f87b7c7400	1971	}
Pokitto	7:72f87b7c7400	1972
Pokitto	7:72f87b7c7400	1973	void Display::println(uint8_t x, uint8_t y, unsigned char b, int base)
Pokitto	7:72f87b7c7400	1974	{
Pokitto	7:72f87b7c7400	1975	cursorX = x;
Pokitto	7:72f87b7c7400	1976	cursorY = y;
Pokitto	7:72f87b7c7400	1977	print(b, base);
Pokitto	7:72f87b7c7400	1978	println();
Pokitto	7:72f87b7c7400	1979	}
Pokitto	7:72f87b7c7400	1980
Pokitto	7:72f87b7c7400	1981	void Display::println(uint8_t x, uint8_t y, int n, int base)
Pokitto	7:72f87b7c7400	1982	{
Pokitto	7:72f87b7c7400	1983	cursorX = x;
Pokitto	7:72f87b7c7400	1984	cursorY = y;
Pokitto	7:72f87b7c7400	1985	print(n, base);
Pokitto	7:72f87b7c7400	1986	println();
Pokitto	7:72f87b7c7400	1987	}
Pokitto	7:72f87b7c7400	1988
Pokitto	7:72f87b7c7400	1989	void Display::println(uint8_t x, uint8_t y, unsigned int n, int base)
Pokitto	7:72f87b7c7400	1990	{
Pokitto	7:72f87b7c7400	1991	cursorX = x;
Pokitto	7:72f87b7c7400	1992	cursorY = y;
Pokitto	7:72f87b7c7400	1993	print(n, base);
Pokitto	7:72f87b7c7400	1994	println();
Pokitto	7:72f87b7c7400	1995	}
Pokitto	7:72f87b7c7400	1996
Pokitto	7:72f87b7c7400	1997	void Display::println(uint8_t x, uint8_t y, long n, int base)
Pokitto	7:72f87b7c7400	1998	{
Pokitto	7:72f87b7c7400	1999	cursorX = x;
Pokitto	7:72f87b7c7400	2000	cursorY = y;
Pokitto	7:72f87b7c7400	2001	print(n, base);
Pokitto	7:72f87b7c7400	2002	println();
Pokitto	7:72f87b7c7400	2003	}
Pokitto	7:72f87b7c7400	2004
Pokitto	7:72f87b7c7400	2005	void Display::println(uint8_t x, uint8_t y, unsigned long n, int base)
Pokitto	7:72f87b7c7400	2006	{
Pokitto	7:72f87b7c7400	2007	cursorX = x;
Pokitto	7:72f87b7c7400	2008	cursorY = y;
Pokitto	7:72f87b7c7400	2009	print(n, base);
Pokitto	7:72f87b7c7400	2010	println();
Pokitto	7:72f87b7c7400	2011	}
Pokitto	7:72f87b7c7400	2012
Pokitto	7:72f87b7c7400	2013	void Display::println(uint8_t x, uint8_t y, double n, int digits)
Pokitto	7:72f87b7c7400	2014	{
Pokitto	7:72f87b7c7400	2015	cursorX = x;
Pokitto	7:72f87b7c7400	2016	cursorY = y;
Pokitto	7:72f87b7c7400	2017	print(n, digits);
Pokitto	7:72f87b7c7400	2018	println();
Pokitto	7:72f87b7c7400	2019	}
Pokitto	7:72f87b7c7400	2020
Pokitto	7:72f87b7c7400	2021	void Display::printNumber(unsigned long n, uint8_t base)
Pokitto	7:72f87b7c7400	2022	{
Pokitto	7:72f87b7c7400	2023	unsigned char buf[8 * sizeof(long)]; // Assumes 8-bit chars.
Pokitto	7:72f87b7c7400	2024	unsigned long i = 0;
Pokitto	7:72f87b7c7400	2025
Pokitto	7:72f87b7c7400	2026	if (n == 0) {
Pokitto	7:72f87b7c7400	2027	print('0');
Pokitto	7:72f87b7c7400	2028	return;
Pokitto	7:72f87b7c7400	2029	}
Pokitto	7:72f87b7c7400	2030
Pokitto	7:72f87b7c7400	2031	while (n > 0) {
Pokitto	7:72f87b7c7400	2032	buf[i++] = n % base;
Pokitto	7:72f87b7c7400	2033	n /= base;
Pokitto	7:72f87b7c7400	2034	}
Pokitto	7:72f87b7c7400	2035
Pokitto	7:72f87b7c7400	2036	for (; i > 0; i--)
Pokitto	7:72f87b7c7400	2037	print((char) (buf[i - 1] < 10 ?
Pokitto	7:72f87b7c7400	2038	'0' + buf[i - 1] :
Pokitto	7:72f87b7c7400	2039	'A' + buf[i - 1] - 10));
Pokitto	7:72f87b7c7400	2040	}
Pokitto	7:72f87b7c7400	2041
Pokitto	7:72f87b7c7400	2042	void Display::printFloat(double number, uint8_t digits)
Pokitto	7:72f87b7c7400	2043	{
Pokitto	7:72f87b7c7400	2044	// Handle negative numbers
Pokitto	7:72f87b7c7400	2045	if (number < 0.0)
Pokitto	7:72f87b7c7400	2046	{
Pokitto	7:72f87b7c7400	2047	print('-');
Pokitto	7:72f87b7c7400	2048	number = -number;
Pokitto	7:72f87b7c7400	2049	}
Pokitto	7:72f87b7c7400	2050
Pokitto	7:72f87b7c7400	2051	// Round correctly so that print(1.999, 2) prints as "2.00"
Pokitto	7:72f87b7c7400	2052	double rounding = 0.5;
Pokitto	7:72f87b7c7400	2053	for (uint8_t i=0; i<digits; ++i)
Pokitto	7:72f87b7c7400	2054	rounding /= 10.0;
Pokitto	7:72f87b7c7400	2055
Pokitto	7:72f87b7c7400	2056	number += rounding;
Pokitto	7:72f87b7c7400	2057
Pokitto	7:72f87b7c7400	2058	// Extract the integer part of the number and print it
Pokitto	7:72f87b7c7400	2059	unsigned long int_part = (unsigned long)number;
Pokitto	7:72f87b7c7400	2060	double remainder = number - (double)int_part;
Pokitto	7:72f87b7c7400	2061	print(int_part);
Pokitto	7:72f87b7c7400	2062
Pokitto	7:72f87b7c7400	2063	// Print the decimal point, but only if there are digits beyond
Pokitto	7:72f87b7c7400	2064	if (digits > 0)
Pokitto	7:72f87b7c7400	2065	print(".");
Pokitto	7:72f87b7c7400	2066
Pokitto	7:72f87b7c7400	2067	// Extract digits from the remainder one at a time
Pokitto	7:72f87b7c7400	2068	while (digits-- > 0)
Pokitto	7:72f87b7c7400	2069	{
Pokitto	7:72f87b7c7400	2070	remainder *= 10.0;
Pokitto	7:72f87b7c7400	2071	int toPrint = int(remainder);
Pokitto	7:72f87b7c7400	2072	print(toPrint);
Pokitto	7:72f87b7c7400	2073	remainder -= toPrint;
Pokitto	7:72f87b7c7400	2074	}
Pokitto	7:72f87b7c7400	2075	}
Pokitto	7:72f87b7c7400	2076
Pokitto	7:72f87b7c7400	2077	void Display::draw4BitColumn(int16_t x, int16_t y, uint8_t h, uint8_t* bitmap)
Pokitto	7:72f87b7c7400	2078	{
Pokitto	7:72f87b7c7400	2079	int8_t scry;
Pokitto	7:72f87b7c7400	2080	uint8_t* scrptr = m_scrbuf + (y*(width>>1) + (x>>1));
Pokitto	7:72f87b7c7400	2081
Pokitto	7:72f87b7c7400	2082	/ ONLY 4-bit mode for time being /
Pokitto	7:72f87b7c7400	2083
Pokitto	7:72f87b7c7400	2084	if ((x&1)==0) { / EVEN pixel starting line, very simple, just copypaste /
Pokitto	7:72f87b7c7400	2085	for (scry = y; scry < h+y; scry++) {
Pokitto	7:72f87b7c7400	2086	uint8_t sourcepixel = *bitmap;
Pokitto	7:72f87b7c7400	2087	uint8_t targetpixel = *scrptr;
Pokitto	7:72f87b7c7400	2088	targetpixel = (targetpixel&0x0F) \| (sourcepixel << 4);
Pokitto	7:72f87b7c7400	2089	*scrptr = targetpixel;
Pokitto	7:72f87b7c7400	2090	bitmap++;
Pokitto	7:72f87b7c7400	2091	scrptr+=55;
Pokitto	7:72f87b7c7400	2092	}
Pokitto	7:72f87b7c7400	2093	} else { / ODD pixel starting line /
Pokitto	7:72f87b7c7400	2094	for (scry = y; scry < h+y; scry++) {
Pokitto	7:72f87b7c7400	2095	uint8_t sourcepixel = *bitmap;
Pokitto	7:72f87b7c7400	2096	uint8_t targetpixel = *scrptr;
Pokitto	7:72f87b7c7400	2097	// store source pixel in lower nibble of target
Pokitto	7:72f87b7c7400	2098	targetpixel = (targetpixel & 0xF0) \| (sourcepixel);
Pokitto	7:72f87b7c7400	2099	*scrptr = targetpixel;
Pokitto	7:72f87b7c7400	2100	scrptr+=55;
Pokitto	7:72f87b7c7400	2101	bitmap++;
Pokitto	7:72f87b7c7400	2102	}
Pokitto	7:72f87b7c7400	2103	}
Pokitto	7:72f87b7c7400	2104	}
Pokitto	7:72f87b7c7400	2105
Pokitto	7:72f87b7c7400	2106	void Display::lcdRefresh(unsigned char* scr) {
Pokitto	7:72f87b7c7400	2107
Pokitto	7:72f87b7c7400	2108	#if POK_SCREENMODE == MODE_GAMEBOY
Pokitto	7:72f87b7c7400	2109	lcdRefreshModeGBC(scr, paletteptr);
Pokitto	7:72f87b7c7400	2110	#endif
Pokitto	7:72f87b7c7400	2111
Pokitto	7:72f87b7c7400	2112	#if POK_SCREENMODE == MODE_HI_4COLOR
Pokitto	7:72f87b7c7400	2113	lcdRefreshMode1(scr, paletteptr);
Pokitto	7:72f87b7c7400	2114	#endif
Pokitto	7:72f87b7c7400	2115
Pokitto	7:72f87b7c7400	2116	#if POK_SCREENMODE == MODE_FAST_16COLOR
Pokitto	7:72f87b7c7400	2117	lcdRefreshMode2(scr, paletteptr);
Pokitto	7:72f87b7c7400	2118	#endif
Pokitto	7:72f87b7c7400	2119
Pokitto	7:72f87b7c7400	2120	#if POK_SCREENMODE == MODE_GAMEBUINO_16COLOR
Pokitto	7:72f87b7c7400	2121	lcdRefreshGB(scr, paletteptr);
Pokitto	7:72f87b7c7400	2122	#endif
Pokitto	7:72f87b7c7400	2123
Pokitto	7:72f87b7c7400	2124	#if POK_SCREENMODE == MODE_ARDUBOY_16COLOR
Pokitto	7:72f87b7c7400	2125	lcdRefreshAB(scr, paletteptr);
Pokitto	7:72f87b7c7400	2126	#endif
Pokitto	7:72f87b7c7400	2127
Pokitto	7:72f87b7c7400	2128	}
Pokitto	7:72f87b7c7400	2129
Pokitto	7:72f87b7c7400	2130	void Display::setFrameBufferTo(uint8_t* sb) {
Pokitto	7:72f87b7c7400	2131	m_scrbuf = sb;
Pokitto	7:72f87b7c7400	2132	};
Pokitto	7:72f87b7c7400	2133
Pokitto	7:72f87b7c7400	2134	void Display::setTileBufferTo(uint8_t* tb) {
Pokitto	7:72f87b7c7400	2135	m_tilebuf = tb;
Pokitto	7:72f87b7c7400	2136	};
Pokitto	7:72f87b7c7400	2137
Pokitto	7:72f87b7c7400	2138	void Display::loadTileset(const uint8_t* ts) {
Pokitto	7:72f87b7c7400	2139	m_tileset = (uint8_t*) ts;
Pokitto	7:72f87b7c7400	2140	};
Pokitto	7:72f87b7c7400	2141
Pokitto	7:72f87b7c7400	2142	void Display::setTile(uint16_t i, uint8_t t) {
Pokitto	7:72f87b7c7400	2143	if (!m_tilebuf) return;
Pokitto	7:72f87b7c7400	2144	m_tilebuf[i]=t;
Pokitto	7:72f87b7c7400	2145	};
Pokitto	7:72f87b7c7400	2146
Pokitto	7:72f87b7c7400	2147
Pokitto	7:72f87b7c7400	2148	/** Eof */
Pokitto	7:72f87b7c7400	2149
Pokitto	7:72f87b7c7400	2150
Pokitto	7:72f87b7c7400	2151

Repository toolbox

Export to desktop IDE

Repository details

Type:	Library
Created:	18 Oct 2017
Imports:	4
Forks:	0
Commits:	16
Dependents:	1
Dependencies:	0
Followers:	1

POKITTO_CORE/PokittoDisplay.cpp@15:0bbe8f6fae32, 2017-10-18 (annotated)

Who changed what in which revision?

Repository toolbox

Repository details

Important Information for this Arm website

Access Warning