1 files changed, 153 insertions, 0 deletions
diff --git a/drivers/tdisp/HD44780/tdisp_lld.c b/drivers/tdisp/HD44780/tdisp_lld.c
new file mode 100644
index 00000000..d0f4af0d
--- /dev/null
+++ b/drivers/tdisp/HD44780/tdisp_lld.c
@@ -0,0 +1,153 @@
+/*
+    ChibiOS/GFX - Copyright (C) 2012
+                 Joel Bodenmann aka Tectu <joel@unormal.org>
+
+    This file is part of ChibiOS/GFX.
+
+    ChibiOS/GFX is free software; you can redistribute it and/or modify
+    it under the terms of the GNU General Public License as published by
+    the Free Software Foundation; either version 3 of the License, or
+    (at your option) any later version.
+
+    ChibiOS/GFX is distributed in the hope that it will be useful,
+    but WITHOUT ANY WARRANTY; without even the implied warranty of
+    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+    GNU General Public License for more details.
+
+    You should have received a copy of the GNU General Public License
+    along with this program.  If not, see <http://www.gnu.org/licenses/>.
+*/
+
+/**
+ * @file    drivers/tdisp/HD44780/tdisp_lld.c
+ * @brief   TDISP driver subsystem low level driver source for the HD44780 display
+ *
+ * @addtogroup TDISP
+ * @{
+ */
+
+#include "ch.h"
+#include "hal.h"
+#include "gfx.h"
+
+#if GFX_USE_TDISP /*|| defined(__DOXYGEN__)*/
+
+#include "tdisp_lld_board_example.h"
+
+static void _writeData(uint8_t data) {
+	write_bus(data);
+	
+	setpin_e(TRUE);
+	chThdSleepMicroseconds(1);
+	setpin_e(FALSE);
+	chThdSleepMicroseconds(5);
+}
+
+void tdisp_lld_write_cmd(uint8_t data) {
+	setpin_rs(FALSE);
+	setpin_rw(FALSE);
+
+	#if TDISP_NEED_4BIT_MODE
+	_writeData(data>>4);
+	#endif
+	_writeData(data);
+}
+
+void tdisp_lld_write_data(uint8_t data) {
+	setpin_rs(TRUE);
+	setpin_rw(FALSE);
+
+	#if TDISP_NEED_4BIT_MODE
+	_writeData(data>>4);
+	#endif
+	_writeData(data);
+}
+
+bool_t tdisp_lld_init(void) { 
+	/* initialise MCU hardware */
+	init_board();
+
+	/* wait some time */
+	chThdSleepMilliseconds(50);
+
+	tdisp_lld_write_cmd(0x38);
+	chThdSleepMilliseconds(64);
+
+	tdisp_lld_write_cmd(0x0f);	
+	chThdSleepMicroseconds(50);
+
+	tdisp_lld_write_cmd(0x01);
+	chThdSleepMilliseconds(5);
+
+	tdisp_lld_write_cmd(0x06);
+	chThdSleepMicroseconds(50);
+
+	return TRUE;
+}
+
+void tdisp_lld_set_cursor(coord_t col, coord_t row) {
+	uint8_t row_offsets[] = { 0x00, 0x40, 0x14, 0x54 };
+
+	if(row >= TDISP_ROWS)
+		row = TDISP_ROWS - 1;
+
+	tdisp_lld_write_cmd(0x80 | (col + row_offsets[row]));
+}
+
+void tdisp_lld_create_char(uint8_t address, char *charmap) {
+	uint8_t i;
+
+	/* make sure we don't write somewhere we're not supposed to */
+	address &= TDISP_MAX_CUSTOM_CHARS;
+
+	tdisp_lld_write_cmd(0x40 | (address << 3));
+
+	for(i = 0; i < 8; i++) {
+		tdisp_lld_write_data(charmap[i]);
+	}
+}
+
+void tdisp_lld_clear(void) {
+	tdisp_lld_write_cmd(0x01);
+}
+
+void tdisp_lld_home(void) {
+	tdisp_lld_write_cmd(0x02);
+}
+
+void tdisp_lld_control(uint16_t what, void *value) {
+	(void)what;
+	(void)value;
+/*
+	switch(attributes) {
+		case TDISP_ON:
+			_displaycontrol |= 0x04;
+			tdisp_lld_write_cmd(0x08 | _displaycontrol);
+			break;
+		case TDISP_OFF:
+			_displaycontrol &=~ 0x04;
+			tdisp_lld_write_cmd(0x08 | _displaycontrol);
+			break;
+		case TDISP_CURSOR_ON:
+			_displaycontrol |= 0x02;
+			tdisp_lld_write_cmd(0x08 | _displaycontrol);
+			break;
+		case TDISP_CURSOR_OFF:
+			_displaycontrol &=~ 0x02;
+			tdisp_lld_write_cmd(0x08 | _displaycontrol);
+			break;
+		case TDISP_CURSOR_BLINK_ON:
+			_displaycontrol |= 0x00;
+			tdisp_lld_write_cmd(0x08 | _displaycontrol);
+			break;
+		case TDISP_CURSOR_BLINK_OFF:
+			_displaycontrol &=~ 0x00;
+			tdisp_lld_write_cmd(0x08 | _displaycontrol);
+			break;
+	}
+*/
+}
+
+#endif /* GFX_USE_TDISP */
+/** @} */
+