Clock_Using_Mbed_Timers_with_LCD16X2_in_4bit_mode - The code implement timers to make a clock. The lc…

Users » EDISON_NGUNJIRI » Code » Clock_Using_Mbed_Timers_with_LCD16X2_in_4bit_mode

EDISON GACHOMO / Clock_Using_Mbed_Timers_with_LCD16X2_in_4bit_mode

The code implement timers to make a clock. The lcd16x2 is used to display the Hour, min and seconds. It also provide alarm capabilities

TextLCD.cpp@0:0898e006947b, 2022-05-16 (annotated)

Committer:: EDISON_NGUNJIRI
Date:: Mon May 16 06:06:11 2022 +0000
Revision:: 0:0898e006947b

LCD16X2 in 4bit mode clock

Who changed what in which revision?

User	Revision	Line number	New contents of line
EDISON_NGUNJIRI	0:0898e006947b	1	/* mbed TextLCD Library, for LCDs based on HD44780 controllers
EDISON_NGUNJIRI	0:0898e006947b	2	* Copyright (c) 2007-2010, sford, http://mbed.org
EDISON_NGUNJIRI	0:0898e006947b	3	* 2013, v01: WH, Added LCD types, fixed LCD address issues, added Cursor and UDCs
EDISON_NGUNJIRI	0:0898e006947b	4	* 2013, v02: WH, Added I2C and SPI bus interfaces
EDISON_NGUNJIRI	0:0898e006947b	5	* 2013, v03: WH, Added support for LCD40x4 which uses 2 controllers
EDISON_NGUNJIRI	0:0898e006947b	6	* 2013, v04: WH, Added support for Display On/Off, improved 4bit bootprocess
EDISON_NGUNJIRI	0:0898e006947b	7	* 2013, v05: WH, Added support for 8x2B, added some UDCs
EDISON_NGUNJIRI	0:0898e006947b	8	* 2013, v06: WH, Added support for devices that use internal DC/DC converters
EDISON_NGUNJIRI	0:0898e006947b	9	* 2013, v07: WH, Added support for backlight and include portdefinitions for LCD2004 Module from DFROBOT
EDISON_NGUNJIRI	0:0898e006947b	10	* 2014, v08: WH, Refactored in Base and Derived Classes to deal with mbed lib change regarding 'NC' defined pins
EDISON_NGUNJIRI	0:0898e006947b	11	* 2014, v09: WH/EO, Added Class for Native SPI controllers such as ST7032
EDISON_NGUNJIRI	0:0898e006947b	12	* 2014, v10: WH, Added Class for Native I2C controllers such as ST7032i, Added support for MCP23008 I2C portexpander, Added support for Adafruit module
EDISON_NGUNJIRI	0:0898e006947b	13	* 2014, v11: WH, Added support for native I2C controllers such as PCF21XX, Improved the _initCtrl() method to deal with differences between all supported controllers
EDISON_NGUNJIRI	0:0898e006947b	14	* 2014, v12: WH, Added support for native I2C controller PCF2119 and native I2C/SPI controllers SSD1803, ST7036, added setContrast method (by JH1PJL) for supported devices (eg ST7032i)
EDISON_NGUNJIRI	0:0898e006947b	15	* 2014, v13: WH, Added support for controllers US2066/SSD1311 (OLED), added setUDCBlink() method for supported devices (eg SSD1803), fixed issue in setPower()
EDISON_NGUNJIRI	0:0898e006947b	16	* 2014, v14: WH, Added support for PT6314 (VFD), added setOrient() method for supported devices (eg SSD1803, US2066), added Double Height lines for supported devices,
EDISON_NGUNJIRI	0:0898e006947b	17	* added 16 UDCs for supported devices (eg PCF2103), moved UDC defines to TextLCD_UDC file, added TextLCD_Config.h for feature and footprint settings.
EDISON_NGUNJIRI	0:0898e006947b	18	* 2014, v15: WH, Added AC780 support, added I2C expander modules, fixed setBacklight() for inverted logic modules. Fixed bug in LCD_SPI_N define
EDISON_NGUNJIRI	0:0898e006947b	19	* 2014, v16: WH, Added ST7070 and KS0073 support, added setIcon(), clrIcon() and setInvert() method for supported devices
EDISON_NGUNJIRI	0:0898e006947b	20	* 2015, v17: WH, Clean up low-level _writeCommand() and _writeData(), Added support for alternative fonttables (eg PCF21XX), Added ST7066_ACM controller for ACM1602 module
EDISON_NGUNJIRI	0:0898e006947b	21	* 2015, v18: WH, Performance improvement I2C portexpander
EDISON_NGUNJIRI	0:0898e006947b	22	* 2015, v19: WH, Fixed Adafruit I2C/SPI portexpander pinmappings, fixed SYDZ Backlight
EDISON_NGUNJIRI	0:0898e006947b	23	* 2015, v20: WH, Fixed occasional Init fail caused by insufficient wait time after ReturnHome command (0x02), Added defines to reduce memory footprint (eg LCD_ICON),
EDISON_NGUNJIRI	0:0898e006947b	24	* Fixed and Added more fonttable support for PCF2119R_3V3, Added HD66712 controller.
EDISON_NGUNJIRI	0:0898e006947b	25	* 2015, v21: WH, Added LCD32x2 defines and code, Fixed KS0073 DL=1 init for SPI, Added defines to reduce memory footprint (LCD_TWO_CTRL, LCD_CONTRAST, LCD_UTF8_FONT)
EDISON_NGUNJIRI	0:0898e006947b	26	* Added SPLC792A controller, Added UTF8_2_LCD decode for Cyrilic font (By Andriy Ribalko). Added setFont()
EDISON_NGUNJIRI	0:0898e006947b	27	*
EDISON_NGUNJIRI	0:0898e006947b	28	* Permission is hereby granted, free of charge, to any person obtaining a copy
EDISON_NGUNJIRI	0:0898e006947b	29	* of this software and associated documentation files (the "Software"), to deal
EDISON_NGUNJIRI	0:0898e006947b	30	* in the Software without restriction, including without limitation the rights
EDISON_NGUNJIRI	0:0898e006947b	31	* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
EDISON_NGUNJIRI	0:0898e006947b	32	* copies of the Software, and to permit persons to whom the Software is
EDISON_NGUNJIRI	0:0898e006947b	33	* furnished to do so, subject to the following conditions:
EDISON_NGUNJIRI	0:0898e006947b	34	*
EDISON_NGUNJIRI	0:0898e006947b	35	* The above copyright notice and this permission notice shall be included in
EDISON_NGUNJIRI	0:0898e006947b	36	* all copies or substantial portions of the Software.
EDISON_NGUNJIRI	0:0898e006947b	37	*
EDISON_NGUNJIRI	0:0898e006947b	38	* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
EDISON_NGUNJIRI	0:0898e006947b	39	* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
EDISON_NGUNJIRI	0:0898e006947b	40	* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
EDISON_NGUNJIRI	0:0898e006947b	41	* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
EDISON_NGUNJIRI	0:0898e006947b	42	* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
EDISON_NGUNJIRI	0:0898e006947b	43	* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
EDISON_NGUNJIRI	0:0898e006947b	44	* THE SOFTWARE.
EDISON_NGUNJIRI	0:0898e006947b	45	*/
EDISON_NGUNJIRI	0:0898e006947b	46	#include "mbed.h"
EDISON_NGUNJIRI	0:0898e006947b	47	#include "TextLCD.h"
EDISON_NGUNJIRI	0:0898e006947b	48	#include "TextLCD_UDC.inc"
EDISON_NGUNJIRI	0:0898e006947b	49	#include "TextLCD_UTF8.inc"
EDISON_NGUNJIRI	0:0898e006947b	50
EDISON_NGUNJIRI	0:0898e006947b	51	/** Create a TextLCD_Base interface
EDISON_NGUNJIRI	0:0898e006947b	52	*
EDISON_NGUNJIRI	0:0898e006947b	53	* @param type Sets the panel size/addressing mode (default = LCD16x2)
EDISON_NGUNJIRI	0:0898e006947b	54	* @param ctrl LCD controller (default = HD44780)
EDISON_NGUNJIRI	0:0898e006947b	55	*/
EDISON_NGUNJIRI	0:0898e006947b	56	TextLCD_Base::TextLCD_Base(LCDType type, LCDCtrl ctrl) : _type(type), _ctrl(ctrl) {
EDISON_NGUNJIRI	0:0898e006947b	57
EDISON_NGUNJIRI	0:0898e006947b	58	// Extract LCDType data
EDISON_NGUNJIRI	0:0898e006947b	59
EDISON_NGUNJIRI	0:0898e006947b	60	// Columns encoded in b15..b8
EDISON_NGUNJIRI	0:0898e006947b	61	_nr_cols = (_type & LCD_T_COL_MSK) >> LCD_T_COL_SHFT;
EDISON_NGUNJIRI	0:0898e006947b	62
EDISON_NGUNJIRI	0:0898e006947b	63	// Rows encoded in b23..b16
EDISON_NGUNJIRI	0:0898e006947b	64	_nr_rows = (_type & LCD_T_ROW_MSK) >> LCD_T_ROW_SHFT;
EDISON_NGUNJIRI	0:0898e006947b	65
EDISON_NGUNJIRI	0:0898e006947b	66	// Addressing mode encoded in b27..b24
EDISON_NGUNJIRI	0:0898e006947b	67	_addr_mode = _type & LCD_T_ADR_MSK;
EDISON_NGUNJIRI	0:0898e006947b	68
EDISON_NGUNJIRI	0:0898e006947b	69	// Font table, encoded in LCDCtrl
EDISON_NGUNJIRI	0:0898e006947b	70	_font = _ctrl & LCD_C_FNT_MSK;
EDISON_NGUNJIRI	0:0898e006947b	71	}
EDISON_NGUNJIRI	0:0898e006947b	72
EDISON_NGUNJIRI	0:0898e006947b	73	/** Init the LCD Controller(s)
EDISON_NGUNJIRI	0:0898e006947b	74	* Clear display
EDISON_NGUNJIRI	0:0898e006947b	75	* @param _LCDDatalength dl sets the datalength of data/commands
EDISON_NGUNJIRI	0:0898e006947b	76	* @return none
EDISON_NGUNJIRI	0:0898e006947b	77	*/
EDISON_NGUNJIRI	0:0898e006947b	78	void TextLCD_Base::_init(_LCDDatalength dl) {
EDISON_NGUNJIRI	0:0898e006947b	79
EDISON_NGUNJIRI	0:0898e006947b	80	thread_sleep_for(100); // Wait 100ms to ensure powered up
EDISON_NGUNJIRI	0:0898e006947b	81
EDISON_NGUNJIRI	0:0898e006947b	82	#if (LCD_TWO_CTRL == 1)
EDISON_NGUNJIRI	0:0898e006947b	83	// Select and configure second LCD controller when needed
EDISON_NGUNJIRI	0:0898e006947b	84	if(_type==LCD40x4) {
EDISON_NGUNJIRI	0:0898e006947b	85	_ctrl_idx=_LCDCtrl_1; // Select 2nd controller
EDISON_NGUNJIRI	0:0898e006947b	86	_initCtrl(dl); // Init 2nd controller
EDISON_NGUNJIRI	0:0898e006947b	87	}
EDISON_NGUNJIRI	0:0898e006947b	88	#endif
EDISON_NGUNJIRI	0:0898e006947b	89
EDISON_NGUNJIRI	0:0898e006947b	90	// Select and configure primary LCD controller
EDISON_NGUNJIRI	0:0898e006947b	91	_ctrl_idx=_LCDCtrl_0; // Select primary controller
EDISON_NGUNJIRI	0:0898e006947b	92	_initCtrl(dl); // Init primary controller
EDISON_NGUNJIRI	0:0898e006947b	93
EDISON_NGUNJIRI	0:0898e006947b	94	// Clear whole display and Reset Cursor location
EDISON_NGUNJIRI	0:0898e006947b	95	// Note: This will make sure that some 3-line displays that skip topline of a 4-line configuration
EDISON_NGUNJIRI	0:0898e006947b	96	// are cleared and init cursor correctly.
EDISON_NGUNJIRI	0:0898e006947b	97	cls();
EDISON_NGUNJIRI	0:0898e006947b	98	}
EDISON_NGUNJIRI	0:0898e006947b	99
EDISON_NGUNJIRI	0:0898e006947b	100	/** Init the LCD controller
EDISON_NGUNJIRI	0:0898e006947b	101	* Set number of lines, fonttype, no cursor etc
EDISON_NGUNJIRI	0:0898e006947b	102	* The controller is accessed in 4-bit parallel mode either directly via mbed pins or through I2C or SPI expander.
EDISON_NGUNJIRI	0:0898e006947b	103	* Some controllers also support native I2C or SPI interfaces.
EDISON_NGUNJIRI	0:0898e006947b	104	*
EDISON_NGUNJIRI	0:0898e006947b	105	* @param _LCDDatalength dl sets the 4 or 8 bit datalength of data/commands. Required for some native serial modes that dont work when DL=0.
EDISON_NGUNJIRI	0:0898e006947b	106	* @return none
EDISON_NGUNJIRI	0:0898e006947b	107	*
EDISON_NGUNJIRI	0:0898e006947b	108	* Note: some configurations are commented out because they have not yet been tested due to lack of hardware
EDISON_NGUNJIRI	0:0898e006947b	109	*/
EDISON_NGUNJIRI	0:0898e006947b	110	void TextLCD_Base::_initCtrl(_LCDDatalength dl) {
EDISON_NGUNJIRI	0:0898e006947b	111	int _bias_lines=0; // Set Bias and lines (Instr Set 1), temporary variable.
EDISON_NGUNJIRI	0:0898e006947b	112	int _lines=0; // Set lines (Ext Instr Set), temporary variable.
EDISON_NGUNJIRI	0:0898e006947b	113
EDISON_NGUNJIRI	0:0898e006947b	114	this->_setRS(false); // command mode
EDISON_NGUNJIRI	0:0898e006947b	115
EDISON_NGUNJIRI	0:0898e006947b	116	if (dl == _LCD_DL_4) {
EDISON_NGUNJIRI	0:0898e006947b	117	// The Controller could be in 8 bit mode (power-on reset) or in 4 bit mode (warm reboot) at this point.
EDISON_NGUNJIRI	0:0898e006947b	118	// Follow this procedure to make sure the Controller enters the correct state. The hardware interface
EDISON_NGUNJIRI	0:0898e006947b	119	// between the uP and the LCD can only write the 4 most significant bits (Most Significant Nibble, MSN).
EDISON_NGUNJIRI	0:0898e006947b	120	// In 4 bit mode the LCD expects the MSN first, followed by the LSN.
EDISON_NGUNJIRI	0:0898e006947b	121	//
EDISON_NGUNJIRI	0:0898e006947b	122	// Current state: 8 bit mode \| 4 bit mode, MSN is next \| 4 bit mode, LSN is next
EDISON_NGUNJIRI	0:0898e006947b	123	//-------------------------------------------------------------------------------------------------
EDISON_NGUNJIRI	0:0898e006947b	124	_writeNibble(0x3); // set 8 bit mode (MSN) and dummy LSN, \| set 8 bit mode (MSN), \| set dummy LSN,
EDISON_NGUNJIRI	0:0898e006947b	125	// remains in 8 bit mode \| remains in 4 bit mode \| remains in 4 bit mode
EDISON_NGUNJIRI	0:0898e006947b	126	thread_sleep_for(15); //
EDISON_NGUNJIRI	0:0898e006947b	127
EDISON_NGUNJIRI	0:0898e006947b	128	_writeNibble(0x3); // set 8 bit mode (MSN) and dummy LSN, \| set dummy LSN, \| set 8bit mode (MSN),
EDISON_NGUNJIRI	0:0898e006947b	129	// remains in 8 bit mode \| change to 8 bit mode \| remains in 4 bit mode
EDISON_NGUNJIRI	0:0898e006947b	130	thread_sleep_for(15); //
EDISON_NGUNJIRI	0:0898e006947b	131
EDISON_NGUNJIRI	0:0898e006947b	132	_writeNibble(0x3); // set 8 bit mode (MSN) and dummy LSN, \| set 8 bit mode (MSN) and dummy LSN, \| set dummy LSN,
EDISON_NGUNJIRI	0:0898e006947b	133	// remains in 8 bit mode \| remains in 8 bit mode \| change to 8 bit mode
EDISON_NGUNJIRI	0:0898e006947b	134	thread_sleep_for(15); //
EDISON_NGUNJIRI	0:0898e006947b	135
EDISON_NGUNJIRI	0:0898e006947b	136	// Controller is now in 8 bit mode
EDISON_NGUNJIRI	0:0898e006947b	137
EDISON_NGUNJIRI	0:0898e006947b	138	_writeNibble(0x2); // Change to 4-bit mode (MSN), the LSN is undefined dummy
EDISON_NGUNJIRI	0:0898e006947b	139	wait_us(40); // most instructions take 40us
EDISON_NGUNJIRI	0:0898e006947b	140
EDISON_NGUNJIRI	0:0898e006947b	141	// Controller is now in 4-bit mode
EDISON_NGUNJIRI	0:0898e006947b	142	// Note: 4/8 bit mode is ignored for most native SPI and I2C devices. They dont use the parallel bus.
EDISON_NGUNJIRI	0:0898e006947b	143	// However, _writeNibble() method is void anyway for native SPI and I2C devices.
EDISON_NGUNJIRI	0:0898e006947b	144	}
EDISON_NGUNJIRI	0:0898e006947b	145	else {
EDISON_NGUNJIRI	0:0898e006947b	146	// Reset in 8 bit mode, final Function set will follow
EDISON_NGUNJIRI	0:0898e006947b	147	_writeCommand(0x30); // Function set 0 0 1 DL=1 N F x x
EDISON_NGUNJIRI	0:0898e006947b	148	thread_sleep_for(1); // most instructions take 40us
EDISON_NGUNJIRI	0:0898e006947b	149	}
EDISON_NGUNJIRI	0:0898e006947b	150
EDISON_NGUNJIRI	0:0898e006947b	151	// Device specific initialisations: DC/DC converter to generate VLCD or VLED, number of lines etc
EDISON_NGUNJIRI	0:0898e006947b	152	switch (_ctrl) {
EDISON_NGUNJIRI	0:0898e006947b	153
EDISON_NGUNJIRI	0:0898e006947b	154	case KS0073:
EDISON_NGUNJIRI	0:0898e006947b	155	// Initialise Display configuration
EDISON_NGUNJIRI	0:0898e006947b	156	switch (_type) {
EDISON_NGUNJIRI	0:0898e006947b	157	// case LCD6x1:
EDISON_NGUNJIRI	0:0898e006947b	158	case LCD8x1: //8x1 is a regular 1 line display
EDISON_NGUNJIRI	0:0898e006947b	159	// case LCD8x2B: //8x1 is a 16x1 line display
EDISON_NGUNJIRI	0:0898e006947b	160	case LCD12x1:
EDISON_NGUNJIRI	0:0898e006947b	161	case LCD16x1:
EDISON_NGUNJIRI	0:0898e006947b	162	case LCD20x1:
EDISON_NGUNJIRI	0:0898e006947b	163	case LCD24x1:
EDISON_NGUNJIRI	0:0898e006947b	164	// case LCD32x1: // EXT pin is High, extension driver needed
EDISON_NGUNJIRI	0:0898e006947b	165	// case LCD40x1: // EXT pin is High, extension driver needed
EDISON_NGUNJIRI	0:0898e006947b	166	// case LCD52x1: // EXT pin is High, extension driver needed
EDISON_NGUNJIRI	0:0898e006947b	167	_function = dl \| 0x02; // Set function, 0 0 1 DL, N, RE(0), DH, REV
EDISON_NGUNJIRI	0:0898e006947b	168	// Note: 4 bit mode is NOT ignored for native SPI !
EDISON_NGUNJIRI	0:0898e006947b	169	// DL=1 (8 bits bus), DL=0 (4 bits bus)
EDISON_NGUNJIRI	0:0898e006947b	170	// N=0 (1-line mode), N=1 (2-line mode), dont care for 4 line mode
EDISON_NGUNJIRI	0:0898e006947b	171	// RE=0 (Dis. Extended Regs, special mode for KS0073)
EDISON_NGUNJIRI	0:0898e006947b	172	// DH=1 (Disp shift enable, special mode for KS0073)
EDISON_NGUNJIRI	0:0898e006947b	173	// REV=0 (Reverse normal, special mode for KS0073)
EDISON_NGUNJIRI	0:0898e006947b	174
EDISON_NGUNJIRI	0:0898e006947b	175	_function_1 = dl \| 0x04; // Set function, 0 0 1 DL, N, RE(1), BE, LP (Ext Regs)
EDISON_NGUNJIRI	0:0898e006947b	176	// Note: 4 bit mode is NOT ignored for native SPI !
EDISON_NGUNJIRI	0:0898e006947b	177	// DL=1 (8 bits bus), DL=0 (4 bits bus)
EDISON_NGUNJIRI	0:0898e006947b	178	// N=0 (1-line mode), N=1 (2-line mode), dont care for 4 line mode
EDISON_NGUNJIRI	0:0898e006947b	179	// RE=1 (Ena Extended Regs, special mode for KS0073)
EDISON_NGUNJIRI	0:0898e006947b	180	// BE=0 (Blink Enable, CG/SEG RAM, special mode for KS0073)
EDISON_NGUNJIRI	0:0898e006947b	181	// LP=0 (LP=1 Low power mode, LP=0 Normal)
EDISON_NGUNJIRI	0:0898e006947b	182
EDISON_NGUNJIRI	0:0898e006947b	183	_function_x = 0x00; // Ext Function set 0000 1 FW BW NW (Ext Regs)
EDISON_NGUNJIRI	0:0898e006947b	184	// NW=0 (1,2 line), NW=1 (4 Line, special mode for KS0073)
EDISON_NGUNJIRI	0:0898e006947b	185	break;
EDISON_NGUNJIRI	0:0898e006947b	186
EDISON_NGUNJIRI	0:0898e006947b	187	// case LCD12x3D: // Special mode for KS0073, KS0078 and PCF21XX
EDISON_NGUNJIRI	0:0898e006947b	188	// case LCD12x3D1: // Special mode for KS0073, KS0078 and PCF21XX
EDISON_NGUNJIRI	0:0898e006947b	189	case LCD12x4D: // Special mode for KS0073, KS0078 and PCF21XX
EDISON_NGUNJIRI	0:0898e006947b	190	// case LCD16x3D: // Special mode for KS0073, KS0078
EDISON_NGUNJIRI	0:0898e006947b	191	// case LCD16x3D1: // Special mode for KS0073, KS0078
EDISON_NGUNJIRI	0:0898e006947b	192	// case LCD16x4D: // Special mode for KS0073, KS0078
EDISON_NGUNJIRI	0:0898e006947b	193	case LCD20x4D: // Special mode for KS0073, KS0078
EDISON_NGUNJIRI	0:0898e006947b	194	_function = dl \| 0x02; // Set function, 0 0 1 DL, N, RE(0), DH, REV
EDISON_NGUNJIRI	0:0898e006947b	195	// Note: 4 bit mode is NOT ignored for native SPI !
EDISON_NGUNJIRI	0:0898e006947b	196	// DL=1 (8 bits bus), DL=0 (4 bits bus)
EDISON_NGUNJIRI	0:0898e006947b	197	// N=0 (1-line mode), N=1 (2-line mode), dont care for 4 line mode
EDISON_NGUNJIRI	0:0898e006947b	198	// RE=0 (Dis. Extended Regs, special mode for KS0073)
EDISON_NGUNJIRI	0:0898e006947b	199	// DH=1 (Disp shift enable, special mode for KS0073)
EDISON_NGUNJIRI	0:0898e006947b	200	// REV=0 (Reverse normal, special mode for KS0073)
EDISON_NGUNJIRI	0:0898e006947b	201
EDISON_NGUNJIRI	0:0898e006947b	202	_function_1 = dl \| 0x04; // Set function, 0 0 1 DL, N, RE(1), BE, LP (Ext Regs)
EDISON_NGUNJIRI	0:0898e006947b	203	// Note: 4 bit mode is NOT ignored for native SPI !
EDISON_NGUNJIRI	0:0898e006947b	204	// DL=1 (8 bits bus), DL=0 (4 bits bus)
EDISON_NGUNJIRI	0:0898e006947b	205	// N=0 (1-line mode), N=1 (2-line mode), dont care for 4 line mode
EDISON_NGUNJIRI	0:0898e006947b	206	// RE=1 (Ena Extended Regs, special mode for KS0073)
EDISON_NGUNJIRI	0:0898e006947b	207	// BE=0 (Blink Enable, CG/SEG RAM, special mode for KS0073)
EDISON_NGUNJIRI	0:0898e006947b	208	// LP=0 (LP=1 Low power mode, LP=0 Normal)
EDISON_NGUNJIRI	0:0898e006947b	209
EDISON_NGUNJIRI	0:0898e006947b	210	_function_x = 0x01; // Ext Function set 0000 1 FW BW NW (Ext Regs)
EDISON_NGUNJIRI	0:0898e006947b	211	// NW=0 (1,2 line), NW=1 (4 Line, special mode for KS0073)
EDISON_NGUNJIRI	0:0898e006947b	212	break;
EDISON_NGUNJIRI	0:0898e006947b	213
EDISON_NGUNJIRI	0:0898e006947b	214	// case LCD6x2:
EDISON_NGUNJIRI	0:0898e006947b	215	case LCD8x2:
EDISON_NGUNJIRI	0:0898e006947b	216	case LCD16x2:
EDISON_NGUNJIRI	0:0898e006947b	217	// case LCD16x1C:
EDISON_NGUNJIRI	0:0898e006947b	218	case LCD20x2:
EDISON_NGUNJIRI	0:0898e006947b	219	case LCD24x2:
EDISON_NGUNJIRI	0:0898e006947b	220	case LCD32x2:
EDISON_NGUNJIRI	0:0898e006947b	221	// All other LCD types are initialised as 2 Line displays
EDISON_NGUNJIRI	0:0898e006947b	222	_function = dl \| 0x0A; // Set function, 0 0 1 DL, N, RE(0), DH, REV
EDISON_NGUNJIRI	0:0898e006947b	223	// Note: 4 bit mode is NOT ignored for native SPI !
EDISON_NGUNJIRI	0:0898e006947b	224	// DL=1 (8 bits bus), DL=0 (4 bits bus)
EDISON_NGUNJIRI	0:0898e006947b	225	// N=1 (2-line mode), N=0 (1-line mode)
EDISON_NGUNJIRI	0:0898e006947b	226	// RE=0 (Dis. Extended Regs, special mode for KS0073)
EDISON_NGUNJIRI	0:0898e006947b	227	// DH=1 (Disp shift enable, special mode for KS0073)
EDISON_NGUNJIRI	0:0898e006947b	228	// REV=0 (Reverse normal, special mode for KS0073)
EDISON_NGUNJIRI	0:0898e006947b	229
EDISON_NGUNJIRI	0:0898e006947b	230	_function_1 = dl \| 0x0C; // Set function, 0 0 1 DL, N, RE(1), BE, LP (Ext Regs)
EDISON_NGUNJIRI	0:0898e006947b	231	// Note: 4 bit mode is NOT ignored for native SPI !
EDISON_NGUNJIRI	0:0898e006947b	232	// DL=1 (8 bits bus), DL=0 (4 bits bus)
EDISON_NGUNJIRI	0:0898e006947b	233	// N=1 (2 line mode), N=0 (1-line mode)
EDISON_NGUNJIRI	0:0898e006947b	234	// RE=1 (Ena Extended Regs, special mode for KS0073)
EDISON_NGUNJIRI	0:0898e006947b	235	// BE=0 (Blink Enable, CG/SEG RAM, special mode for KS0073)
EDISON_NGUNJIRI	0:0898e006947b	236	// LP=0 (LP=1 Low power mode, LP=0 Normal)
EDISON_NGUNJIRI	0:0898e006947b	237
EDISON_NGUNJIRI	0:0898e006947b	238	_function_x = 0x00; // Ext Function set 0000 1 FW BW NW (Ext Regs)
EDISON_NGUNJIRI	0:0898e006947b	239	// NW=0 (1,2 line), NW=1 (4 Line, special mode for KS0073)
EDISON_NGUNJIRI	0:0898e006947b	240	break;
EDISON_NGUNJIRI	0:0898e006947b	241
EDISON_NGUNJIRI	0:0898e006947b	242	default:
EDISON_NGUNJIRI	0:0898e006947b	243	error("Error: LCD Controller type does not support this Display type\n\r");
EDISON_NGUNJIRI	0:0898e006947b	244	break;
EDISON_NGUNJIRI	0:0898e006947b	245	} // switch type
EDISON_NGUNJIRI	0:0898e006947b	246
EDISON_NGUNJIRI	0:0898e006947b	247	// init special features
EDISON_NGUNJIRI	0:0898e006947b	248	_writeCommand(0x20 \| _function_1);// Function set 001 DL N RE(1) BE LP (Ext Regs)
EDISON_NGUNJIRI	0:0898e006947b	249	// DL=0 (4 bits bus), DL=1 (8 bits mode)
EDISON_NGUNJIRI	0:0898e006947b	250	// N=0 (1 line mode), N=1 (2 line mode)
EDISON_NGUNJIRI	0:0898e006947b	251	// RE=1 (Ena Extended Regs, special mode for KS0073)
EDISON_NGUNJIRI	0:0898e006947b	252	// BE=0 (Blink Enable/Disable, CG/SEG RAM, special mode for KS0073)
EDISON_NGUNJIRI	0:0898e006947b	253	// LP=0 (LP=1 Low power mode, LP=0 Normal)
EDISON_NGUNJIRI	0:0898e006947b	254
EDISON_NGUNJIRI	0:0898e006947b	255	_writeCommand(0x08 \| _function_x); // Ext Function set 0000 1 FW BW NW (Ext Regs)
EDISON_NGUNJIRI	0:0898e006947b	256	// FW=0 (5-dot font, special mode for KS0073)
EDISON_NGUNJIRI	0:0898e006947b	257	// BW=0 (Cur BW invert disable, special mode for KS0073)
EDISON_NGUNJIRI	0:0898e006947b	258	// NW=0 (1,2 Line), NW=1 (4 line, special mode for KS0073)
EDISON_NGUNJIRI	0:0898e006947b	259
EDISON_NGUNJIRI	0:0898e006947b	260	_writeCommand(0x10); // Scroll/Shift set 0001 DS/HS4 DS/HS3 DS/HS2 DS/HS1 (Ext Regs)
EDISON_NGUNJIRI	0:0898e006947b	261	// Dotscroll/Display shift enable (Special mode for KS0073)
EDISON_NGUNJIRI	0:0898e006947b	262
EDISON_NGUNJIRI	0:0898e006947b	263	_writeCommand(0x80); // Scroll Quantity set 1 0 SQ5 SQ4 SQ3 SQ2 SQ1 SQ0 (Ext Regs)
EDISON_NGUNJIRI	0:0898e006947b	264	// Scroll quantity (Special mode for KS0073)
EDISON_NGUNJIRI	0:0898e006947b	265
EDISON_NGUNJIRI	0:0898e006947b	266	_writeCommand(0x20 \| _function); // Function set 001 DL N RE(0) DH REV (Std Regs)
EDISON_NGUNJIRI	0:0898e006947b	267	// DL=0 (4 bits bus), DL=1 (8 bits mode)
EDISON_NGUNJIRI	0:0898e006947b	268	// N=0 (1 line mode), N=1 (2 line mode)
EDISON_NGUNJIRI	0:0898e006947b	269	// RE=0 (Dis. Extended Regs, special mode for KS0073)
EDISON_NGUNJIRI	0:0898e006947b	270	// DH=1 (Disp shift enable/disable, special mode for KS0073)
EDISON_NGUNJIRI	0:0898e006947b	271	// REV=0 (Reverse/Normal, special mode for KS0073)
EDISON_NGUNJIRI	0:0898e006947b	272	break; // case KS0073 Controller
EDISON_NGUNJIRI	0:0898e006947b	273
EDISON_NGUNJIRI	0:0898e006947b	274
EDISON_NGUNJIRI	0:0898e006947b	275	case KS0078:
EDISON_NGUNJIRI	0:0898e006947b	276	// Initialise Display configuration
EDISON_NGUNJIRI	0:0898e006947b	277	switch (_type) {
EDISON_NGUNJIRI	0:0898e006947b	278	case LCD8x1: //8x1 is a regular 1 line display
EDISON_NGUNJIRI	0:0898e006947b	279	case LCD8x2B: //8x2B is a special case of 16x1
EDISON_NGUNJIRI	0:0898e006947b	280	// case LCD12x1:
EDISON_NGUNJIRI	0:0898e006947b	281	case LCD16x1:
EDISON_NGUNJIRI	0:0898e006947b	282	// case LCD20x1:
EDISON_NGUNJIRI	0:0898e006947b	283	case LCD24x1:
EDISON_NGUNJIRI	0:0898e006947b	284	_function = dl \| 0x02; // Function set 001 DL N RE(0) DH REV (Std Regs)
EDISON_NGUNJIRI	0:0898e006947b	285	// DL=0 (4 bits bus)
EDISON_NGUNJIRI	0:0898e006947b	286	// N=0 (1 line mode), N=1 (2 line mode)
EDISON_NGUNJIRI	0:0898e006947b	287	// RE=0 (Dis. Extended Regs, special mode for KS0078)
EDISON_NGUNJIRI	0:0898e006947b	288	// DH=1 (Disp shift enable, special mode for KS0078)
EDISON_NGUNJIRI	0:0898e006947b	289	// REV=0 (Reverse normal, special mode for KS0078)
EDISON_NGUNJIRI	0:0898e006947b	290
EDISON_NGUNJIRI	0:0898e006947b	291	_function_1 = dl \| 0x04; // Function set 001 DL N RE(1) BE 0 (Ext Regs)
EDISON_NGUNJIRI	0:0898e006947b	292	// DL=0 (4 bits bus)
EDISON_NGUNJIRI	0:0898e006947b	293	// N=0 (1 line mode), N=1 (2 line mode)
EDISON_NGUNJIRI	0:0898e006947b	294	// RE=1 (Ena Extended Regs, special mode for KS0078)
EDISON_NGUNJIRI	0:0898e006947b	295	// BE=0 (Blink Enable, CG/SEG RAM, special mode for KS0078)
EDISON_NGUNJIRI	0:0898e006947b	296	// 0
EDISON_NGUNJIRI	0:0898e006947b	297
EDISON_NGUNJIRI	0:0898e006947b	298	_function_x = 0x00; // Ext Function set 0000 1 FW BW NW (Ext Regs)
EDISON_NGUNJIRI	0:0898e006947b	299	// NW=0 (1,2 line), NW=1 (4 Line, special mode for KS0078)
EDISON_NGUNJIRI	0:0898e006947b	300	break;
EDISON_NGUNJIRI	0:0898e006947b	301
EDISON_NGUNJIRI	0:0898e006947b	302	// case LCD12x3D: // Special mode for KS0073, KS0078 and PCF21XX
EDISON_NGUNJIRI	0:0898e006947b	303	// case LCD12x3D1: // Special mode for KS0073, KS0078 and PCF21XX
EDISON_NGUNJIRI	0:0898e006947b	304	// case LCD12x4D: // Special mode for KS0073, KS0078 and PCF21XX
EDISON_NGUNJIRI	0:0898e006947b	305	// case LCD16x3D: // Special mode for KS0073, KS0078
EDISON_NGUNJIRI	0:0898e006947b	306	// case LCD16x4D: // Special mode for KS0073, KS0078
EDISON_NGUNJIRI	0:0898e006947b	307	// case LCD20x4D: // Special mode for KS0073, KS0078
EDISON_NGUNJIRI	0:0898e006947b	308	// case LCD24x3D: // Special mode for KS0078
EDISON_NGUNJIRI	0:0898e006947b	309	// case LCD24x3D1: // Special mode for KS0078
EDISON_NGUNJIRI	0:0898e006947b	310	case LCD24x4D: // Special mode for KS0078
EDISON_NGUNJIRI	0:0898e006947b	311	_function = dl \| 0x02; // Function set 001 DL N RE(0) DH REV (Std Regs)
EDISON_NGUNJIRI	0:0898e006947b	312	// DL=0 (4 bits bus)
EDISON_NGUNJIRI	0:0898e006947b	313	// N=0 (dont care for 4 line mode)
EDISON_NGUNJIRI	0:0898e006947b	314	// RE=0 (Dis. Extended Regs, special mode for KS0078)
EDISON_NGUNJIRI	0:0898e006947b	315	// DH=1 (Disp shift enable, special mode for KS0078)
EDISON_NGUNJIRI	0:0898e006947b	316	// REV=0 (Reverse normal, special mode for KS0078)
EDISON_NGUNJIRI	0:0898e006947b	317
EDISON_NGUNJIRI	0:0898e006947b	318	_function_1 = dl \| 0x04; // Function set 001 DL N RE(1) BE 0 (Ext Regs)
EDISON_NGUNJIRI	0:0898e006947b	319	// DL=0 (4 bits bus)
EDISON_NGUNJIRI	0:0898e006947b	320	// N=0 (1 line mode), N=1 (2 line mode)
EDISON_NGUNJIRI	0:0898e006947b	321	// RE=1 (Ena Extended Regs, special mode for KS0078)
EDISON_NGUNJIRI	0:0898e006947b	322	// BE=0 (Blink Enable, CG/SEG RAM, special mode for KS0078)
EDISON_NGUNJIRI	0:0898e006947b	323	// 0
EDISON_NGUNJIRI	0:0898e006947b	324
EDISON_NGUNJIRI	0:0898e006947b	325	_function_x = 0x01; // Ext Function set 0000 1 FW BW NW (Ext Regs)
EDISON_NGUNJIRI	0:0898e006947b	326	// NW=0 (1,2 line), NW=1 (4 Line, special mode for KS0078)
EDISON_NGUNJIRI	0:0898e006947b	327	break;
EDISON_NGUNJIRI	0:0898e006947b	328
EDISON_NGUNJIRI	0:0898e006947b	329	// case LCD6x2:
EDISON_NGUNJIRI	0:0898e006947b	330	case LCD8x2:
EDISON_NGUNJIRI	0:0898e006947b	331	case LCD16x2:
EDISON_NGUNJIRI	0:0898e006947b	332	// case LCD16x1C:
EDISON_NGUNJIRI	0:0898e006947b	333	case LCD20x2:
EDISON_NGUNJIRI	0:0898e006947b	334	case LCD24x2:
EDISON_NGUNJIRI	0:0898e006947b	335	case LCD32x2:
EDISON_NGUNJIRI	0:0898e006947b	336	case LCD40x2:
EDISON_NGUNJIRI	0:0898e006947b	337	// All other LCD types are initialised as 2 Line displays (including LCD16x1C and LCD40x4)
EDISON_NGUNJIRI	0:0898e006947b	338	_function = dl \| 0x0A; // Function set 001 DL N RE(0) DH REV (Std Regs)
EDISON_NGUNJIRI	0:0898e006947b	339	// DL=0 (4 bits bus)
EDISON_NGUNJIRI	0:0898e006947b	340	// N=1 (1 line mode), N=1 (2 line mode)
EDISON_NGUNJIRI	0:0898e006947b	341	// RE=0 (Dis. Extended Regs, special mode for KS0078)
EDISON_NGUNJIRI	0:0898e006947b	342	// DH=1 (Disp shift enable, special mode for KS0078)
EDISON_NGUNJIRI	0:0898e006947b	343	// REV=0 (Reverse normal, special mode for KS0078)
EDISON_NGUNJIRI	0:0898e006947b	344
EDISON_NGUNJIRI	0:0898e006947b	345	_function_1 = dl \| 0x0C; // Function set 001 DL N RE(1) BE 0 (Ext Regs)
EDISON_NGUNJIRI	0:0898e006947b	346	// DL=0 (4 bits bus)
EDISON_NGUNJIRI	0:0898e006947b	347	// N=1 (1 line mode), N=1 (2 line mode)
EDISON_NGUNJIRI	0:0898e006947b	348	// RE=1 (Ena Extended Regs, special mode for KS0078)
EDISON_NGUNJIRI	0:0898e006947b	349	// BE=0 (Blink Enable, CG/SEG RAM, special mode for KS0078)
EDISON_NGUNJIRI	0:0898e006947b	350	// 0
EDISON_NGUNJIRI	0:0898e006947b	351
EDISON_NGUNJIRI	0:0898e006947b	352	_function_x = 0x00; // Ext Function set 0000 1 FW BW NW (Ext Regs)
EDISON_NGUNJIRI	0:0898e006947b	353	// NW=0 (1,2 line), NW=1 (4 Line, special mode for KS0078)
EDISON_NGUNJIRI	0:0898e006947b	354	break;
EDISON_NGUNJIRI	0:0898e006947b	355
EDISON_NGUNJIRI	0:0898e006947b	356	default:
EDISON_NGUNJIRI	0:0898e006947b	357	error("Error: LCD Controller type does not support this Display type\n\r");
EDISON_NGUNJIRI	0:0898e006947b	358	break;
EDISON_NGUNJIRI	0:0898e006947b	359	} // switch type
EDISON_NGUNJIRI	0:0898e006947b	360
EDISON_NGUNJIRI	0:0898e006947b	361	// init special features
EDISON_NGUNJIRI	0:0898e006947b	362	_writeCommand(0x20 \| _function_1);// Function set 001 DL N RE(1) BE 0 (Ext Regs)
EDISON_NGUNJIRI	0:0898e006947b	363	// DL=0 (4 bits bus), DL=1 (8 bits mode)
EDISON_NGUNJIRI	0:0898e006947b	364	// N=0 (1 line mode), N=1 (2 line mode)
EDISON_NGUNJIRI	0:0898e006947b	365	// RE=1 (Ena Extended Regs, special mode for KS0078)
EDISON_NGUNJIRI	0:0898e006947b	366	// BE=0 (Blink Enable/Disable, CG/SEG RAM, special mode for KS0078)
EDISON_NGUNJIRI	0:0898e006947b	367	// 0
EDISON_NGUNJIRI	0:0898e006947b	368
EDISON_NGUNJIRI	0:0898e006947b	369	_writeCommand(0x08 \| _function_x); // Ext Function set 0000 1 FW BW NW (Ext Regs)
EDISON_NGUNJIRI	0:0898e006947b	370	// FW=0 (5-dot font, special mode for KS0078)
EDISON_NGUNJIRI	0:0898e006947b	371	// BW=0 (Cur BW invert disable, special mode for KS0078)
EDISON_NGUNJIRI	0:0898e006947b	372	// NW=0 (1,2 Line), NW=1 (4 line, special mode for KS0078)
EDISON_NGUNJIRI	0:0898e006947b	373
EDISON_NGUNJIRI	0:0898e006947b	374	_writeCommand(0x10); // Scroll/Shift set 0001 DS/HS4 DS/HS3 DS/HS2 DS/HS1 (Ext Regs)
EDISON_NGUNJIRI	0:0898e006947b	375	// Dotscroll/Display shift enable (Special mode for KS0078)
EDISON_NGUNJIRI	0:0898e006947b	376
EDISON_NGUNJIRI	0:0898e006947b	377	_writeCommand(0x80); // Scroll Quantity set 1 0 SQ5 SQ4 SQ3 SQ2 SQ1 SQ0 (Ext Regs)
EDISON_NGUNJIRI	0:0898e006947b	378	// Scroll quantity (Special mode for KS0078)
EDISON_NGUNJIRI	0:0898e006947b	379
EDISON_NGUNJIRI	0:0898e006947b	380	_writeCommand(0x20 \| _function); // Function set 001 DL N RE(0) DH REV (Std Regs)
EDISON_NGUNJIRI	0:0898e006947b	381	// DL=0 (4 bits bus), DL=1 (8 bits mode)
EDISON_NGUNJIRI	0:0898e006947b	382	// N=0 (1 line mode), N=1 (2 line mode)
EDISON_NGUNJIRI	0:0898e006947b	383	// RE=0 (Dis. Extended Regs, special mode for KS0078)
EDISON_NGUNJIRI	0:0898e006947b	384	// DH=1 (Disp shift enable/disable, special mode for KS0078)
EDISON_NGUNJIRI	0:0898e006947b	385	// REV=0 (Reverse/Normal, special mode for KS0078)
EDISON_NGUNJIRI	0:0898e006947b	386	break; // case KS0078 Controller
EDISON_NGUNJIRI	0:0898e006947b	387
EDISON_NGUNJIRI	0:0898e006947b	388	case ST7032_3V3:
EDISON_NGUNJIRI	0:0898e006947b	389	// ST7032 controller: Initialise Voltage booster for VLCD. VDD=3V3
EDISON_NGUNJIRI	0:0898e006947b	390	// Note: very similar to SPLC792A
EDISON_NGUNJIRI	0:0898e006947b	391	case ST7032_5V:
EDISON_NGUNJIRI	0:0898e006947b	392	// ST7032 controller: Disable Voltage booster for VLCD. VDD=5V
EDISON_NGUNJIRI	0:0898e006947b	393
EDISON_NGUNJIRI	0:0898e006947b	394	// Initialise Display configuration
EDISON_NGUNJIRI	0:0898e006947b	395	switch (_type) {
EDISON_NGUNJIRI	0:0898e006947b	396	case LCD8x1: //8x1 is a regular 1 line display
EDISON_NGUNJIRI	0:0898e006947b	397	case LCD8x2B: //8x2B is a special case of 16x1
EDISON_NGUNJIRI	0:0898e006947b	398	// case LCD12x1:
EDISON_NGUNJIRI	0:0898e006947b	399	case LCD16x1:
EDISON_NGUNJIRI	0:0898e006947b	400	// case LCD20x1:
EDISON_NGUNJIRI	0:0898e006947b	401	case LCD24x1:
EDISON_NGUNJIRI	0:0898e006947b	402	_function = 0x00; // FUNCTION SET 0 0 1 DL=0 (4 bit), N=0 (1-line display mode), F=0 (5*7dot), 0, IS
EDISON_NGUNJIRI	0:0898e006947b	403	// Note: 4 bit mode is ignored for native SPI and I2C devices
EDISON_NGUNJIRI	0:0898e006947b	404	// Saved to allow switch between Instruction sets at later time
EDISON_NGUNJIRI	0:0898e006947b	405	break;
EDISON_NGUNJIRI	0:0898e006947b	406
EDISON_NGUNJIRI	0:0898e006947b	407	case LCD12x3D: // Special mode for KS0078 and PCF21XX
EDISON_NGUNJIRI	0:0898e006947b	408	case LCD12x3D1: // Special mode for KS0078 and PCF21XX
EDISON_NGUNJIRI	0:0898e006947b	409	case LCD12x4D: // Special mode for KS0078 and PCF21XX
EDISON_NGUNJIRI	0:0898e006947b	410	case LCD16x3G: // Special mode for ST7036
EDISON_NGUNJIRI	0:0898e006947b	411	case LCD24x4D: // Special mode for KS0078
EDISON_NGUNJIRI	0:0898e006947b	412	error("Error: LCD Controller type does not support this Display type\n\r");
EDISON_NGUNJIRI	0:0898e006947b	413	break;
EDISON_NGUNJIRI	0:0898e006947b	414
EDISON_NGUNJIRI	0:0898e006947b	415	default:
EDISON_NGUNJIRI	0:0898e006947b	416	// All other LCD types are initialised as 2 Line displays
EDISON_NGUNJIRI	0:0898e006947b	417	_function = 0x08; // FUNCTION SET 0 0 1 DL=0 (4 bit), N=1 (2-line display mode), F=0 (5*7dot), 0, IS
EDISON_NGUNJIRI	0:0898e006947b	418	// Note: 4 bit mode is ignored for native SPI and I2C devices
EDISON_NGUNJIRI	0:0898e006947b	419	// Saved to allow switch between Instruction sets at later time
EDISON_NGUNJIRI	0:0898e006947b	420	break;
EDISON_NGUNJIRI	0:0898e006947b	421	} // switch type
EDISON_NGUNJIRI	0:0898e006947b	422
EDISON_NGUNJIRI	0:0898e006947b	423	// init special features
EDISON_NGUNJIRI	0:0898e006947b	424	_writeCommand(0x20 \| _function \| 0x01); // Set function, 0 0 1 DL N F 0 IS=1 Select Instr Set = 1
EDISON_NGUNJIRI	0:0898e006947b	425
EDISON_NGUNJIRI	0:0898e006947b	426	_writeCommand(0x1C); // Internal OSC frequency adjustment Framefreq=183HZ, Bias will be 1/4 (Instr Set=1)
EDISON_NGUNJIRI	0:0898e006947b	427	// Note: Bias and Osc register not available on SPLC792A
EDISON_NGUNJIRI	0:0898e006947b	428
EDISON_NGUNJIRI	0:0898e006947b	429	_contrast = LCD_ST7032_CONTRAST;
EDISON_NGUNJIRI	0:0898e006947b	430	_writeCommand(0x70 \| (_contrast & 0x0F)); // Set Contrast Low bits, 0 1 1 1 C3 C2 C1 C0 (IS=1)
EDISON_NGUNJIRI	0:0898e006947b	431
EDISON_NGUNJIRI	0:0898e006947b	432
EDISON_NGUNJIRI	0:0898e006947b	433	if (_ctrl == ST7032_3V3) {
EDISON_NGUNJIRI	0:0898e006947b	434	// _icon_power = 0x04; // Icon display off (Bit3=0), Booster circuit is turned on (Bit2=1) (IS=1)
EDISON_NGUNJIRI	0:0898e006947b	435	_icon_power = 0x0C; // Icon display on (Bit3=1), Booster circuit is turned on (Bit2=1) (IS=1)
EDISON_NGUNJIRI	0:0898e006947b	436	// Note: Booster circuit always on for SPLC792A, Bit2 is dont care
EDISON_NGUNJIRI	0:0898e006947b	437	// Saved to allow contrast change at later time
EDISON_NGUNJIRI	0:0898e006947b	438	}
EDISON_NGUNJIRI	0:0898e006947b	439	else {
EDISON_NGUNJIRI	0:0898e006947b	440	// _icon_power = 0x00; // Icon display off, Booster circuit is turned off (IS=1)
EDISON_NGUNJIRI	0:0898e006947b	441	_icon_power = 0x08; // Icon display on, Booster circuit is turned off (IS=1)
EDISON_NGUNJIRI	0:0898e006947b	442	// Saved to allow contrast change at later time
EDISON_NGUNJIRI	0:0898e006947b	443	}
EDISON_NGUNJIRI	0:0898e006947b	444	_writeCommand(0x50 \| _icon_power \| ((_contrast >> 4) & 0x03)); // Set Icon, Booster and Contrast High bits, 0 1 0 1 Ion Bon C5 C4 (IS=1)
EDISON_NGUNJIRI	0:0898e006947b	445	thread_sleep_for(10); // Wait 10ms to ensure powered up
EDISON_NGUNJIRI	0:0898e006947b	446
EDISON_NGUNJIRI	0:0898e006947b	447	_writeCommand(0x68 \| (LCD_ST7032_RAB & 0x07)); // Voltage follower, 0 1 1 0 FOn=1, Ampl ratio Rab2=1, Rab1=0, Rab0=0 (IS=1)
EDISON_NGUNJIRI	0:0898e006947b	448	thread_sleep_for(10); // Wait 10ms to ensure powered up
EDISON_NGUNJIRI	0:0898e006947b	449
EDISON_NGUNJIRI	0:0898e006947b	450	_writeCommand(0x20 \| _function); // Select Instruction Set = 0
EDISON_NGUNJIRI	0:0898e006947b	451
EDISON_NGUNJIRI	0:0898e006947b	452	break; // case ST7032_3V3 Controller
EDISON_NGUNJIRI	0:0898e006947b	453	// case ST7032_5V Controller
EDISON_NGUNJIRI	0:0898e006947b	454
EDISON_NGUNJIRI	0:0898e006947b	455	case ST7036_3V3:
EDISON_NGUNJIRI	0:0898e006947b	456	// ST7036 controller: Initialise Voltage booster for VLCD. VDD=3V3
EDISON_NGUNJIRI	0:0898e006947b	457	// Note: supports 1,2 (LCD_T_A) or 3 lines (LCD_T_G)
EDISON_NGUNJIRI	0:0898e006947b	458	case ST7036_5V:
EDISON_NGUNJIRI	0:0898e006947b	459	// ST7036 controller: Disable Voltage booster for VLCD. VDD=5V
EDISON_NGUNJIRI	0:0898e006947b	460	// Note: supports 1,2 (LCD_T_A) or 3 lines (LCD_T_G)
EDISON_NGUNJIRI	0:0898e006947b	461
EDISON_NGUNJIRI	0:0898e006947b	462	// Initialise Display configuration
EDISON_NGUNJIRI	0:0898e006947b	463	switch (_type) {
EDISON_NGUNJIRI	0:0898e006947b	464	case LCD8x1: //8x1 is a regular 1 line display
EDISON_NGUNJIRI	0:0898e006947b	465	case LCD8x2B: //8x2D is a special case of 16x1
EDISON_NGUNJIRI	0:0898e006947b	466	// case LCD12x1:
EDISON_NGUNJIRI	0:0898e006947b	467	case LCD16x1:
EDISON_NGUNJIRI	0:0898e006947b	468	case LCD24x1:
EDISON_NGUNJIRI	0:0898e006947b	469	_function = 0x00; // Set function, 0 0 1 DL=0 (4-bit Databus), N=0 (1 Line), DH=0 (5x7font), IS2, IS1 (Select Instruction Set)
EDISON_NGUNJIRI	0:0898e006947b	470	// Note: 4 bit mode is ignored for native SPI and I2C devices
EDISON_NGUNJIRI	0:0898e006947b	471	// Saved to allow switch between Instruction sets at later time
EDISON_NGUNJIRI	0:0898e006947b	472
EDISON_NGUNJIRI	0:0898e006947b	473	_bias_lines = 0x04; // Bias: 1/5, 1 or 2-Lines LCD
EDISON_NGUNJIRI	0:0898e006947b	474	break;
EDISON_NGUNJIRI	0:0898e006947b	475
EDISON_NGUNJIRI	0:0898e006947b	476	// case LCD12x3G: // Special mode for ST7036
EDISON_NGUNJIRI	0:0898e006947b	477	case LCD16x3G: // Special mode for ST7036
EDISON_NGUNJIRI	0:0898e006947b	478	_function = 0x08; // Set function, 0 0 1 DL=0 (4-bit Databus), N=1 (2 Line), DH=0 (5x7font), IS2,IS1 (Select Instruction Set)
EDISON_NGUNJIRI	0:0898e006947b	479	// Note: 4 bit mode is ignored for native SPI and I2C devices
EDISON_NGUNJIRI	0:0898e006947b	480	// Saved to allow switch between Instruction sets at later time
EDISON_NGUNJIRI	0:0898e006947b	481
EDISON_NGUNJIRI	0:0898e006947b	482	_bias_lines = 0x05; // Bias: 1/5, 3-Lines LCD
EDISON_NGUNJIRI	0:0898e006947b	483	break;
EDISON_NGUNJIRI	0:0898e006947b	484
EDISON_NGUNJIRI	0:0898e006947b	485	// case LCD12x3D1: // Special mode for KS0078 and PCF21XX
EDISON_NGUNJIRI	0:0898e006947b	486	// case LCD16x3D1: // Special mode for SSD1803
EDISON_NGUNJIRI	0:0898e006947b	487	case LCD12x4D: // Special mode for PCF2116
EDISON_NGUNJIRI	0:0898e006947b	488	case LCD24x4D: // Special mode for KS0078
EDISON_NGUNJIRI	0:0898e006947b	489	error("Error: LCD Controller type does not support this Display type\n\r");
EDISON_NGUNJIRI	0:0898e006947b	490	break;
EDISON_NGUNJIRI	0:0898e006947b	491
EDISON_NGUNJIRI	0:0898e006947b	492	default:
EDISON_NGUNJIRI	0:0898e006947b	493	// All other LCD types are initialised as 2 Line displays (including LCD16x1C and LCD40x4)
EDISON_NGUNJIRI	0:0898e006947b	494	_function = 0x08; // Set function, 0 0 1 DL=0 (4-bit Databus), N=1 (2 Line), DH=0 (5x7font), IS2,IS1 (Select Instruction Set)
EDISON_NGUNJIRI	0:0898e006947b	495	// Note: 4 bit mode is ignored for native SPI and I2C devices
EDISON_NGUNJIRI	0:0898e006947b	496	// Saved to allow switch between Instruction sets at later time
EDISON_NGUNJIRI	0:0898e006947b	497
EDISON_NGUNJIRI	0:0898e006947b	498	_bias_lines = 0x04; // Bias: 1/5, 1 or 2-Lines LCD
EDISON_NGUNJIRI	0:0898e006947b	499	break;
EDISON_NGUNJIRI	0:0898e006947b	500	} // switch type
EDISON_NGUNJIRI	0:0898e006947b	501
EDISON_NGUNJIRI	0:0898e006947b	502
EDISON_NGUNJIRI	0:0898e006947b	503	// init special features
EDISON_NGUNJIRI	0:0898e006947b	504	_writeCommand(0x20 \| _function \| 0x01); // Set function, IS2,IS1 = 01 (Select Instr Set = 1)
EDISON_NGUNJIRI	0:0898e006947b	505	_writeCommand(0x10 \| _bias_lines); // Set Bias and 1,2 or 3 lines (Instr Set 1)
EDISON_NGUNJIRI	0:0898e006947b	506
EDISON_NGUNJIRI	0:0898e006947b	507	_contrast = LCD_ST7036_CONTRAST;
EDISON_NGUNJIRI	0:0898e006947b	508	_writeCommand(0x70 \| (_contrast & 0x0F)); // Set Contrast, 0 1 1 1 C3 C2 C1 C0 (Instr Set 1)
EDISON_NGUNJIRI	0:0898e006947b	509
EDISON_NGUNJIRI	0:0898e006947b	510	if (_ctrl == ST7036_3V3) {
EDISON_NGUNJIRI	0:0898e006947b	511	_icon_power = 0x0C; // Set Icon, Booster, Contrast High bits, 0 1 0 1 Ion=1 Bon=1 C5 C4 (Instr Set 1)
EDISON_NGUNJIRI	0:0898e006947b	512	// _icon_power = 0x04; // Set Icon, Booster, Contrast High bits, 0 1 0 1 Ion=0 Bon=1 C5 C4 (Instr Set 1)
EDISON_NGUNJIRI	0:0898e006947b	513	// Saved to allow contrast change at later time
EDISON_NGUNJIRI	0:0898e006947b	514	}
EDISON_NGUNJIRI	0:0898e006947b	515	else {
EDISON_NGUNJIRI	0:0898e006947b	516	_icon_power = 0x08; // Set Icon, Booster, Contrast High bits, 0 1 0 1 Ion=1 Bon=0 C5 C4 (Instr Set 1)
EDISON_NGUNJIRI	0:0898e006947b	517	// _icon_power = 0x00; // Set Icon, Booster, Contrast High bits, 0 1 0 1 Ion=0 Bon=0 C5 C4 (Instr Set 1)
EDISON_NGUNJIRI	0:0898e006947b	518	}
EDISON_NGUNJIRI	0:0898e006947b	519
EDISON_NGUNJIRI	0:0898e006947b	520	_writeCommand(0x50 \| _icon_power \| ((_contrast >> 4) & 0x03)); // Set Contrast C5, C4 (Instr Set 1)
EDISON_NGUNJIRI	0:0898e006947b	521	thread_sleep_for(10); // Wait 10ms to ensure powered up
EDISON_NGUNJIRI	0:0898e006947b	522
EDISON_NGUNJIRI	0:0898e006947b	523	_writeCommand(0x68 \| (LCD_ST7036_RAB & 0x07)); // Voltagefollower On = 1, Ampl ratio Rab2, Rab1, Rab0 = 1 0 1 (Instr Set 1)
EDISON_NGUNJIRI	0:0898e006947b	524	thread_sleep_for(10); // Wait 10ms to ensure powered up
EDISON_NGUNJIRI	0:0898e006947b	525
EDISON_NGUNJIRI	0:0898e006947b	526	_writeCommand(0x20 \| _function); // Set function, IS2,IS1 = 00 (Select Instruction Set = 0)
EDISON_NGUNJIRI	0:0898e006947b	527
EDISON_NGUNJIRI	0:0898e006947b	528	break; // case ST7036_3V3 Controller
EDISON_NGUNJIRI	0:0898e006947b	529	// case ST7036_5V Controller
EDISON_NGUNJIRI	0:0898e006947b	530
EDISON_NGUNJIRI	0:0898e006947b	531	case ST7070:
EDISON_NGUNJIRI	0:0898e006947b	532	// Initialise Display configuration
EDISON_NGUNJIRI	0:0898e006947b	533	switch (_type) {
EDISON_NGUNJIRI	0:0898e006947b	534	case LCD8x1: //8x1 is a regular 1 line display
EDISON_NGUNJIRI	0:0898e006947b	535	case LCD8x2B: //8x2D is a special case of 16x1
EDISON_NGUNJIRI	0:0898e006947b	536	// case LCD12x1:
EDISON_NGUNJIRI	0:0898e006947b	537	case LCD16x1:
EDISON_NGUNJIRI	0:0898e006947b	538	case LCD24x1:
EDISON_NGUNJIRI	0:0898e006947b	539	_function = dl \| 0x00; // Set function, 0 0 1 DL=0 (4-bit Databus), N=0 (1 Line), EXT=0, x, x
EDISON_NGUNJIRI	0:0898e006947b	540	// Note: 4 bit mode is NOT ignored for native SPI !
EDISON_NGUNJIRI	0:0898e006947b	541	// Saved to allow switch between Instruction sets at later time
EDISON_NGUNJIRI	0:0898e006947b	542	break;
EDISON_NGUNJIRI	0:0898e006947b	543
EDISON_NGUNJIRI	0:0898e006947b	544	// case LCD12x3D1: // Special mode for KS0078 and PCF21XX
EDISON_NGUNJIRI	0:0898e006947b	545	// case LCD16x3D1: // Special mode for SSD1803
EDISON_NGUNJIRI	0:0898e006947b	546	case LCD12x4D: // Special mode for PCF2116
EDISON_NGUNJIRI	0:0898e006947b	547	case LCD24x4D: // Special mode for KS0078
EDISON_NGUNJIRI	0:0898e006947b	548	// case LCD12x3G: // Special mode for ST7036
EDISON_NGUNJIRI	0:0898e006947b	549	case LCD16x3G: // Special mode for ST7036
EDISON_NGUNJIRI	0:0898e006947b	550	error("Error: LCD Controller type does not support this Display type\n\r");
EDISON_NGUNJIRI	0:0898e006947b	551	break;
EDISON_NGUNJIRI	0:0898e006947b	552
EDISON_NGUNJIRI	0:0898e006947b	553	default:
EDISON_NGUNJIRI	0:0898e006947b	554	// All other LCD types are initialised as 2 Line displays (including LCD16x1C and LCD40x4)
EDISON_NGUNJIRI	0:0898e006947b	555	_function = dl \| 0x08; // Set function, 0 0 1 DL, N=1 (2 Line), EXT=0, x, x
EDISON_NGUNJIRI	0:0898e006947b	556	// Note: 4 bit mode is NOT ignored for native SPI !
EDISON_NGUNJIRI	0:0898e006947b	557	// Saved to allow switch between Instruction sets at later time
EDISON_NGUNJIRI	0:0898e006947b	558	break;
EDISON_NGUNJIRI	0:0898e006947b	559	} // switch type
EDISON_NGUNJIRI	0:0898e006947b	560
EDISON_NGUNJIRI	0:0898e006947b	561	// _writeCommand(0x00); // NOP, make sure to sync SPI
EDISON_NGUNJIRI	0:0898e006947b	562
EDISON_NGUNJIRI	0:0898e006947b	563	// init special features
EDISON_NGUNJIRI	0:0898e006947b	564	_writeCommand(0x20 \| _function \| 0x04); // Set function, 0 0 1 DL N EXT=1 x x (Select Instr Set = 1)
EDISON_NGUNJIRI	0:0898e006947b	565
EDISON_NGUNJIRI	0:0898e006947b	566	_writeCommand(0x04 \| 0x00); // Set Bias resistors 0 0 0 0 0 1 Rb1,Rb0= 0 0 (Extern Res) (Instr Set 1)
EDISON_NGUNJIRI	0:0898e006947b	567
EDISON_NGUNJIRI	0:0898e006947b	568	_writeCommand(0x40 \| 0x00); // COM/SEG directions 0 1 0 0 C1, C2, S1, S2 (Instr Set 1)
EDISON_NGUNJIRI	0:0898e006947b	569	// C1=1: Com1-8 -> Com8-1; C2=1: Com9-16 -> Com16-9
EDISON_NGUNJIRI	0:0898e006947b	570	// S1=1: Seg1-40 -> Seg40-1; S2=1: Seg41-80 -> Seg80-41
EDISON_NGUNJIRI	0:0898e006947b	571
EDISON_NGUNJIRI	0:0898e006947b	572	_writeCommand(0x20 \| _function); // Set function, EXT=0 (Select Instr Set = 0)
EDISON_NGUNJIRI	0:0898e006947b	573
EDISON_NGUNJIRI	0:0898e006947b	574	break; // case ST7070 Controller
EDISON_NGUNJIRI	0:0898e006947b	575
EDISON_NGUNJIRI	0:0898e006947b	576	case SSD1803_3V3:
EDISON_NGUNJIRI	0:0898e006947b	577	// SSD1803 controller: Initialise Voltage booster for VLCD. VDD=3V3
EDISON_NGUNJIRI	0:0898e006947b	578	// Note: supports 1,2, 3 or 4 lines
EDISON_NGUNJIRI	0:0898e006947b	579	// case SSD1803_5V:
EDISON_NGUNJIRI	0:0898e006947b	580	// SSD1803 controller: No Voltage booster for VLCD. VDD=5V
EDISON_NGUNJIRI	0:0898e006947b	581
EDISON_NGUNJIRI	0:0898e006947b	582	// Initialise Display configuration
EDISON_NGUNJIRI	0:0898e006947b	583	switch (_type) {
EDISON_NGUNJIRI	0:0898e006947b	584	case LCD8x1: //8x1 is a regular 1 line display
EDISON_NGUNJIRI	0:0898e006947b	585	case LCD8x2B: //8x2D is a special case of 16x1
EDISON_NGUNJIRI	0:0898e006947b	586	// case LCD12x1:
EDISON_NGUNJIRI	0:0898e006947b	587	case LCD16x1:
EDISON_NGUNJIRI	0:0898e006947b	588	case LCD24x1:
EDISON_NGUNJIRI	0:0898e006947b	589	_function = 0x00; // Set function 0 0 1 DL N DH RE(0) IS
EDISON_NGUNJIRI	0:0898e006947b	590	// Saved to allow switch between Instruction sets at later time
EDISON_NGUNJIRI	0:0898e006947b	591	// DL=0 4-bit Databus,
EDISON_NGUNJIRI	0:0898e006947b	592	// Note: 4 bit mode is ignored for native SPI and I2C devices
EDISON_NGUNJIRI	0:0898e006947b	593	// N=0 1 Line / 3 Line
EDISON_NGUNJIRI	0:0898e006947b	594	// DH=0 Double Height disable
EDISON_NGUNJIRI	0:0898e006947b	595	// IS=0
EDISON_NGUNJIRI	0:0898e006947b	596
EDISON_NGUNJIRI	0:0898e006947b	597	_function_1 = 0x02; // Set function, 0 0 1 DL N BE RE(1) REV
EDISON_NGUNJIRI	0:0898e006947b	598	// Saved to allow switch between Instruction sets at later time
EDISON_NGUNJIRI	0:0898e006947b	599	// DL=0 4-bit Databus,
EDISON_NGUNJIRI	0:0898e006947b	600	// Note: 4 bit mode is ignored for native SPI and I2C devices
EDISON_NGUNJIRI	0:0898e006947b	601	// N=0 1 Line / 3 Line
EDISON_NGUNJIRI	0:0898e006947b	602	// BE=0 Blink Enable off, special feature of SSD1803
EDISON_NGUNJIRI	0:0898e006947b	603	// REV=0 Reverse off, special feature of SSD1803
EDISON_NGUNJIRI	0:0898e006947b	604
EDISON_NGUNJIRI	0:0898e006947b	605	_lines = 0x00; // Ext function set 0 0 0 0 1 FW BW NW
EDISON_NGUNJIRI	0:0898e006947b	606	// NW=0 1-Line LCD (N=0)
EDISON_NGUNJIRI	0:0898e006947b	607	break;
EDISON_NGUNJIRI	0:0898e006947b	608
EDISON_NGUNJIRI	0:0898e006947b	609	case LCD12x3D: // Special mode for KS0078 and PCF21XX
EDISON_NGUNJIRI	0:0898e006947b	610	// case LCD12x3D1: // Special mode for KS0078 and PCF21XX
EDISON_NGUNJIRI	0:0898e006947b	611	case LCD16x3D: // Special mode for KS0078
EDISON_NGUNJIRI	0:0898e006947b	612	// case LCD16x3D1: // Special mode for SSD1803
EDISON_NGUNJIRI	0:0898e006947b	613	// case LCD20x3D: // Special mode for SSD1803
EDISON_NGUNJIRI	0:0898e006947b	614	_function = 0x00; // Set function 0 0 1 DL N DH RE(0) IS
EDISON_NGUNJIRI	0:0898e006947b	615	// Saved to allow switch between Instruction sets at later time
EDISON_NGUNJIRI	0:0898e006947b	616	// DL=0 4-bit Databus,
EDISON_NGUNJIRI	0:0898e006947b	617	// Note: 4 bit mode is ignored for native SPI and I2C devices
EDISON_NGUNJIRI	0:0898e006947b	618	// N=0 1 Line / 3 Line
EDISON_NGUNJIRI	0:0898e006947b	619	// DH=0 Double Height disable
EDISON_NGUNJIRI	0:0898e006947b	620	// IS=0
EDISON_NGUNJIRI	0:0898e006947b	621
EDISON_NGUNJIRI	0:0898e006947b	622	_function_1 = 0x02; // Set function, 0 0 1 DL N BE RE(1) REV
EDISON_NGUNJIRI	0:0898e006947b	623	// Saved to allow switch between Instruction sets at later time
EDISON_NGUNJIRI	0:0898e006947b	624	// DL=0 4-bit Databus,
EDISON_NGUNJIRI	0:0898e006947b	625	// Note: 4 bit mode is ignored for native SPI and I2C devices
EDISON_NGUNJIRI	0:0898e006947b	626	// N=0 1 Line / 3 Line
EDISON_NGUNJIRI	0:0898e006947b	627	// BE=0 Blink Enable off, special feature of SSD1803
EDISON_NGUNJIRI	0:0898e006947b	628	// REV=0 Reverse off, special feature of SSD1803
EDISON_NGUNJIRI	0:0898e006947b	629
EDISON_NGUNJIRI	0:0898e006947b	630	_lines = 0x00; // Ext function set 0 0 0 0 1 FW BW NW
EDISON_NGUNJIRI	0:0898e006947b	631	// NW=1 3-Line LCD (N=0)
EDISON_NGUNJIRI	0:0898e006947b	632	break;
EDISON_NGUNJIRI	0:0898e006947b	633
EDISON_NGUNJIRI	0:0898e006947b	634	// case LCD10x2D: // Special mode for SSD1803, 4-line mode but switch to double height font
EDISON_NGUNJIRI	0:0898e006947b	635	case LCD10x4D: // Special mode for SSD1803
EDISON_NGUNJIRI	0:0898e006947b	636	case LCD20x4D: // Special mode for SSD1803
EDISON_NGUNJIRI	0:0898e006947b	637	_function = 0x08; // Set function 0 0 1 DL N DH RE(0) IS
EDISON_NGUNJIRI	0:0898e006947b	638	// Saved to allow switch between Instruction sets at later time
EDISON_NGUNJIRI	0:0898e006947b	639	// DL=0 4-bit Databus,
EDISON_NGUNJIRI	0:0898e006947b	640	// Note: 4 bit mode is ignored for native SPI and I2C devices
EDISON_NGUNJIRI	0:0898e006947b	641	// N=1 4 Line
EDISON_NGUNJIRI	0:0898e006947b	642	// DH=0 Double Height disable
EDISON_NGUNJIRI	0:0898e006947b	643	// IS=0
EDISON_NGUNJIRI	0:0898e006947b	644
EDISON_NGUNJIRI	0:0898e006947b	645	_function_1 = 0x0A; // Set function, 0 0 1 DL N BE RE(1) REV
EDISON_NGUNJIRI	0:0898e006947b	646	// Saved to allow switch between Instruction sets at later time
EDISON_NGUNJIRI	0:0898e006947b	647	// DL=0 4-bit Databus,
EDISON_NGUNJIRI	0:0898e006947b	648	// Note: 4 bit mode is ignored for native SPI and I2C devices
EDISON_NGUNJIRI	0:0898e006947b	649	// N=1 4 Line
EDISON_NGUNJIRI	0:0898e006947b	650	// BE=0 Blink Enable off, special feature of SSD1803
EDISON_NGUNJIRI	0:0898e006947b	651	// REV=0 Reverse off, special feature of SSD1803
EDISON_NGUNJIRI	0:0898e006947b	652
EDISON_NGUNJIRI	0:0898e006947b	653	_lines = 0x01; // Ext function set 0 0 0 0 1 FW BW NW
EDISON_NGUNJIRI	0:0898e006947b	654	// NW=1 4-Line LCD (N=1)
EDISON_NGUNJIRI	0:0898e006947b	655	break;
EDISON_NGUNJIRI	0:0898e006947b	656
EDISON_NGUNJIRI	0:0898e006947b	657	case LCD16x3G: // Special mode for ST7036
EDISON_NGUNJIRI	0:0898e006947b	658	case LCD24x4D: // Special mode for KS0078
EDISON_NGUNJIRI	0:0898e006947b	659	error("Error: LCD Controller type does not support this Display type\n\r");
EDISON_NGUNJIRI	0:0898e006947b	660	break;
EDISON_NGUNJIRI	0:0898e006947b	661
EDISON_NGUNJIRI	0:0898e006947b	662	default:
EDISON_NGUNJIRI	0:0898e006947b	663	// All other LCD types are initialised as 2 Line displays (including LCD16x1C and LCD40x4)
EDISON_NGUNJIRI	0:0898e006947b	664	_function = 0x08; // Set function 0 0 1 DL N DH RE(0) IS
EDISON_NGUNJIRI	0:0898e006947b	665	// Saved to allow switch between Instruction sets at later time
EDISON_NGUNJIRI	0:0898e006947b	666	// DL=0 4-bit Databus,
EDISON_NGUNJIRI	0:0898e006947b	667	// Note: 4 bit mode is ignored for native SPI and I2C devices
EDISON_NGUNJIRI	0:0898e006947b	668	// N=1 2 line / 4 Line
EDISON_NGUNJIRI	0:0898e006947b	669	// DH=0 Double Height disable
EDISON_NGUNJIRI	0:0898e006947b	670	// RE=0
EDISON_NGUNJIRI	0:0898e006947b	671	// IS=0
EDISON_NGUNJIRI	0:0898e006947b	672
EDISON_NGUNJIRI	0:0898e006947b	673	_function_1 = 0x0A; // Set function, 0 0 1 DL N BE RE(1) REV
EDISON_NGUNJIRI	0:0898e006947b	674	// Saved to allow switch between Instruction sets at later time
EDISON_NGUNJIRI	0:0898e006947b	675	// DL=0 4-bit Databus,
EDISON_NGUNJIRI	0:0898e006947b	676	// Note: 4 bit mode is ignored for native SPI and I2C devices
EDISON_NGUNJIRI	0:0898e006947b	677	// N=1 2 line / 4 Line
EDISON_NGUNJIRI	0:0898e006947b	678	// BE=0 Blink Enable off, special feature of SSD1803
EDISON_NGUNJIRI	0:0898e006947b	679	// RE=1
EDISON_NGUNJIRI	0:0898e006947b	680	// REV=0 Reverse off, special feature of SSD1803
EDISON_NGUNJIRI	0:0898e006947b	681
EDISON_NGUNJIRI	0:0898e006947b	682	_lines = 0x00; // Ext function set 0 0 0 0 1 FW BW NW
EDISON_NGUNJIRI	0:0898e006947b	683	// NW=0 2-Line LCD (N=1)
EDISON_NGUNJIRI	0:0898e006947b	684	break;
EDISON_NGUNJIRI	0:0898e006947b	685	} // switch type
EDISON_NGUNJIRI	0:0898e006947b	686
EDISON_NGUNJIRI	0:0898e006947b	687
EDISON_NGUNJIRI	0:0898e006947b	688	// init special features
EDISON_NGUNJIRI	0:0898e006947b	689	_writeCommand(0x20 \| _function_1); // Set function, 0 0 1 DL N BE RE(1) REV
EDISON_NGUNJIRI	0:0898e006947b	690	// Select Extended Instruction Set
EDISON_NGUNJIRI	0:0898e006947b	691
EDISON_NGUNJIRI	0:0898e006947b	692	_writeCommand(0x06); // Set ext entry mode, 0 0 0 0 0 1 BDC=1 COM1-32, BDS=0 SEG100-1 "Bottom View" (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	693	// _writeCommand(0x05); // Set ext entry mode, 0 0 0 0 0 1 BDC=0 COM32-1, BDS=1 SEG1-100 "Top View" (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	694	thread_sleep_for(5); // Wait to ensure completion or SSD1803 fails to set Top/Bottom after reset..
EDISON_NGUNJIRI	0:0898e006947b	695
EDISON_NGUNJIRI	0:0898e006947b	696	_writeCommand(0x08 \| _lines); // Set ext function 0 0 0 0 1 FW BW NW 1,2,3 or 4 lines (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	697
EDISON_NGUNJIRI	0:0898e006947b	698	_writeCommand(0x10); // Double Height and Bias, 0 0 0 1 UD2=0, UD1=0, BS1=0 Bias 1/5, DH=0 (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	699
EDISON_NGUNJIRI	0:0898e006947b	700	// _writeCommand(0x76); // Set TC Control, 0 1 1 1 0 1 1 0 (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	701	// _writeData(0x02); // Set TC data, 0 0 0 0 0 TC2,TC1,TC0 = 0 1 0 (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	702
EDISON_NGUNJIRI	0:0898e006947b	703	_writeCommand(0x20 \| _function \| 0x01); // Set function, 0 0 1 DL N DH RE(0) IS=1 Select Instruction Set 1
EDISON_NGUNJIRI	0:0898e006947b	704	// Select Std Instr set, Select IS=1
EDISON_NGUNJIRI	0:0898e006947b	705
EDISON_NGUNJIRI	0:0898e006947b	706	_contrast = LCD_SSD1_CONTRAST;
EDISON_NGUNJIRI	0:0898e006947b	707	_writeCommand(0x70 \| (_contrast & 0x0F)); // Set Contrast 0 1 1 1 C3, C2, C1, C0 (Instr Set 1)
EDISON_NGUNJIRI	0:0898e006947b	708
EDISON_NGUNJIRI	0:0898e006947b	709	// _icon_power = 0x04; // Icon off, Booster on (Instr Set 1)
EDISON_NGUNJIRI	0:0898e006947b	710	_icon_power = 0x0C; // Icon on, Booster on (Instr Set 1)
EDISON_NGUNJIRI	0:0898e006947b	711	// Saved to allow contrast change at later time
EDISON_NGUNJIRI	0:0898e006947b	712	_writeCommand(0x50 \| _icon_power \| ((_contrast >> 4) & 0x03)); // Set Power, Icon and Contrast, 0 1 0 1 Ion Bon C5 C4 (Instr Set 1)
EDISON_NGUNJIRI	0:0898e006947b	713	thread_sleep_for(10); // Wait 10ms to ensure powered up
EDISON_NGUNJIRI	0:0898e006947b	714
EDISON_NGUNJIRI	0:0898e006947b	715	_writeCommand(0x68 \| (LCD_SSD1_RAB & 0x07)); // Set Voltagefollower 0 1 1 0 Don = 1, Ampl ratio Rab2, Rab1, Rab0 = 1 1 0 (Instr Set 1)
EDISON_NGUNJIRI	0:0898e006947b	716	thread_sleep_for(10); // Wait 10ms to ensure powered up
EDISON_NGUNJIRI	0:0898e006947b	717
EDISON_NGUNJIRI	0:0898e006947b	718	_writeCommand(0x20 \| _function_1); // Set function, 0 0 1 DL N BE RE(1) REV
EDISON_NGUNJIRI	0:0898e006947b	719	// Select Extended Instruction Set 1
EDISON_NGUNJIRI	0:0898e006947b	720	_writeCommand(0x10); // Shift/Scroll enable, 0 0 0 1 DS4/HS4 DS3/HS3 DS2/HS2 DS1/HS1 (Ext Instr Set 1)
EDISON_NGUNJIRI	0:0898e006947b	721
EDISON_NGUNJIRI	0:0898e006947b	722
EDISON_NGUNJIRI	0:0898e006947b	723	_writeCommand(0x20 \| _function); // Set function, 0 0 1 DL N DH RE(0) IS=0 Select Instruction Set 0
EDISON_NGUNJIRI	0:0898e006947b	724	// Select Std Instr set, Select IS=0
EDISON_NGUNJIRI	0:0898e006947b	725
EDISON_NGUNJIRI	0:0898e006947b	726	break; // case SSD1803 Controller
EDISON_NGUNJIRI	0:0898e006947b	727
EDISON_NGUNJIRI	0:0898e006947b	728
EDISON_NGUNJIRI	0:0898e006947b	729	// Note1: The PCF21XX family of controllers has several types that dont have an onboard voltage generator for V-LCD.
EDISON_NGUNJIRI	0:0898e006947b	730	// You must supply this LCD voltage externally and not try to enable VGen.
EDISON_NGUNJIRI	0:0898e006947b	731	// Note2: The early versions of PCF2116 controllers (eg PCF2116C) can not generate sufficiently negative voltage for the LCD at a VDD of 3V3.
EDISON_NGUNJIRI	0:0898e006947b	732	// You must supply this voltage externally and not enable VGen or you must use a higher VDD (e.g. 5V) and enable VGen.
EDISON_NGUNJIRI	0:0898e006947b	733	// More recent versions of the controller (eg PCF2116K) have an improved VGen that will work with 3V3.
EDISON_NGUNJIRI	0:0898e006947b	734	// Note3: See datasheet, PCF2116 and other types provide a V0 pin to control the LCD contrast voltage that is provided by VGen. This pins allows
EDISON_NGUNJIRI	0:0898e006947b	735	// contrast control similar to that of pin 3 on the standard 14pin LCD module connector.
EDISON_NGUNJIRI	0:0898e006947b	736	// You can disable VGen by connecting Vo to VDD. VLCD will then be used directly as LCD voltage.
EDISON_NGUNJIRI	0:0898e006947b	737	// Note4: PCF2113 and PCF2119 are different wrt to VLCD generator! There is no V0 pin. The contrast voltage is software controlled by setting the VA and VB registers.
EDISON_NGUNJIRI	0:0898e006947b	738	// Vgen is automatically switched off when the contrast voltage VA or VB is set to 0x00. Note that certain limits apply to allowed values for VA and VB.
EDISON_NGUNJIRI	0:0898e006947b	739	// Note5: See datasheet, members of the PCF21XX family support different numbers of rows/columns. Not all can support 3 or 4 rows.
EDISON_NGUNJIRI	0:0898e006947b	740	// Note6: See datasheet, the PCF21XX-C and PCF21XX-K use a non-standard character set. This may result is strange looking text when not corrected..
EDISON_NGUNJIRI	0:0898e006947b	741
EDISON_NGUNJIRI	0:0898e006947b	742	case PCF2103_3V3:
EDISON_NGUNJIRI	0:0898e006947b	743	// PCF2103 controller: No Voltage generator for VLCD, VDD=3V3..5V, VLCD input controls contrast voltage.
EDISON_NGUNJIRI	0:0898e006947b	744	// Initialise Display configuration
EDISON_NGUNJIRI	0:0898e006947b	745	switch (_type) {
EDISON_NGUNJIRI	0:0898e006947b	746	case LCD24x1:
EDISON_NGUNJIRI	0:0898e006947b	747	_function = 0x00; //FUNCTION SET 0 0 1 DL=0 4-bit, 0, M=0 1-line/24 chars display mode, 0, H=0
EDISON_NGUNJIRI	0:0898e006947b	748	//Note: 4 bit mode is ignored for I2C mode
EDISON_NGUNJIRI	0:0898e006947b	749	break;
EDISON_NGUNJIRI	0:0898e006947b	750
EDISON_NGUNJIRI	0:0898e006947b	751	// case LCD12x1D: //Special mode for PCF21XX, Only top line used
EDISON_NGUNJIRI	0:0898e006947b	752	case LCD12x2:
EDISON_NGUNJIRI	0:0898e006947b	753	_function = 0x04; //FUNCTION SET 0 0 1 DL=0 4-bit, 0, M=1 2-line/12 chars display mode, 0, H=0
EDISON_NGUNJIRI	0:0898e006947b	754	//Note: 4 bit mode is ignored for I2C mode
EDISON_NGUNJIRI	0:0898e006947b	755	break;
EDISON_NGUNJIRI	0:0898e006947b	756
EDISON_NGUNJIRI	0:0898e006947b	757	default:
EDISON_NGUNJIRI	0:0898e006947b	758	error("Error: LCD Controller type does not support this Display type\n\r");
EDISON_NGUNJIRI	0:0898e006947b	759	break;
EDISON_NGUNJIRI	0:0898e006947b	760
EDISON_NGUNJIRI	0:0898e006947b	761	} // switch type
EDISON_NGUNJIRI	0:0898e006947b	762
EDISON_NGUNJIRI	0:0898e006947b	763	_writeCommand(0x20 \| _function \| 0x01); // Set function, Select Instr Set = 1
EDISON_NGUNJIRI	0:0898e006947b	764	thread_sleep_for(10); // Wait 10ms to ensure powered up
EDISON_NGUNJIRI	0:0898e006947b	765
EDISON_NGUNJIRI	0:0898e006947b	766	// Note: Display from GA628 shows 12 chars. This is actually the right half of a 24x1 display. The commons have been connected in reverse order.
EDISON_NGUNJIRI	0:0898e006947b	767	_writeCommand(0x05); // Display Conf Set 0000 0, 1, P=0, Q=1 (Instr. Set 1)
EDISON_NGUNJIRI	0:0898e006947b	768
EDISON_NGUNJIRI	0:0898e006947b	769	_writeCommand(0x02); // Screen Config 0000 001, L=0 (Instr. Set 1)
EDISON_NGUNJIRI	0:0898e006947b	770	_writeCommand(0x08); // ICON Conf 0000 1, IM=0 (Char mode), IB=0 (no Icon blink), 0 (Instr. Set 1)
EDISON_NGUNJIRI	0:0898e006947b	771
EDISON_NGUNJIRI	0:0898e006947b	772	_writeCommand(0x20 \| _function); // Set function, Select Instr Set = 0
EDISON_NGUNJIRI	0:0898e006947b	773
EDISON_NGUNJIRI	0:0898e006947b	774	#if(0)
EDISON_NGUNJIRI	0:0898e006947b	775	// Select CG RAM
EDISON_NGUNJIRI	0:0898e006947b	776	_writeCommand(0x40); //Set CG-RAM address, 8 sequential locations needed per UDC
EDISON_NGUNJIRI	0:0898e006947b	777	// Store UDC/Icon pattern:
EDISON_NGUNJIRI	0:0898e006947b	778	// 3 x 8 rows x 5 bits = 120 bits for Normal pattern (UDC 0..2) and
EDISON_NGUNJIRI	0:0898e006947b	779	// 3 x 8 rows x 5 bits = 120 bits for Blink pattern (UDC 4..6)
EDISON_NGUNJIRI	0:0898e006947b	780	for (int i=0; i<(8 * 8); i++) {
EDISON_NGUNJIRI	0:0898e006947b	781	// _writeData(0x1F); // All On
EDISON_NGUNJIRI	0:0898e006947b	782	_writeData(0x00); // All Off
EDISON_NGUNJIRI	0:0898e006947b	783	}
EDISON_NGUNJIRI	0:0898e006947b	784	#endif
EDISON_NGUNJIRI	0:0898e006947b	785	break; // case PCF2103_3V3 Controller
EDISON_NGUNJIRI	0:0898e006947b	786
EDISON_NGUNJIRI	0:0898e006947b	787	case PCF2113_3V3:
EDISON_NGUNJIRI	0:0898e006947b	788	// PCF2113 controller: Initialise Voltage booster for VLCD. VDD=3V3. VA and VB control contrast.
EDISON_NGUNJIRI	0:0898e006947b	789	// Initialise Display configuration
EDISON_NGUNJIRI	0:0898e006947b	790	switch (_type) {
EDISON_NGUNJIRI	0:0898e006947b	791	// case LCD12x1:
EDISON_NGUNJIRI	0:0898e006947b	792	// _function = 0x02; // FUNCTION SET 0 0 1 DL=0 4 bit, 0, M=0 1-line/12 chars display mode, SL=1, IS=0
EDISON_NGUNJIRI	0:0898e006947b	793	// Note: 4 bit mode is ignored for I2C mode
EDISON_NGUNJIRI	0:0898e006947b	794	case LCD24x1:
EDISON_NGUNJIRI	0:0898e006947b	795	_function = 0x00; // FUNCTION SET 0 0 1 DL=0 4 bit, 0, M=0 1-line/24 chars display mode, SL=0, IS=0
EDISON_NGUNJIRI	0:0898e006947b	796	// Note: 4 bit mode is ignored for I2C mode
EDISON_NGUNJIRI	0:0898e006947b	797	break;
EDISON_NGUNJIRI	0:0898e006947b	798
EDISON_NGUNJIRI	0:0898e006947b	799	case LCD12x2:
EDISON_NGUNJIRI	0:0898e006947b	800	_function = 0x04; // FUNCTION SET 0 0 1 DL=0 4 bit, 0, M=1 2-line/12 chars display mode, SL=0, IS=0
EDISON_NGUNJIRI	0:0898e006947b	801	break;
EDISON_NGUNJIRI	0:0898e006947b	802
EDISON_NGUNJIRI	0:0898e006947b	803	default:
EDISON_NGUNJIRI	0:0898e006947b	804	error("Error: LCD Controller type does not support this Display type\n\r");
EDISON_NGUNJIRI	0:0898e006947b	805	break;
EDISON_NGUNJIRI	0:0898e006947b	806
EDISON_NGUNJIRI	0:0898e006947b	807	} // switch type
EDISON_NGUNJIRI	0:0898e006947b	808
EDISON_NGUNJIRI	0:0898e006947b	809	// Init special features
EDISON_NGUNJIRI	0:0898e006947b	810	_writeCommand(0x20 \| _function \| 0x01); // Set function, Select Instr Set = 1
EDISON_NGUNJIRI	0:0898e006947b	811
EDISON_NGUNJIRI	0:0898e006947b	812	_writeCommand(0x04); // Display Conf Set 0000 0, 1, P=0, Q=0 (Instr. Set 1)
EDISON_NGUNJIRI	0:0898e006947b	813	_writeCommand(0x10); // Temp Compensation Set 0001 0, 0, TC1=0, TC2=0 (Instr. Set 1)
EDISON_NGUNJIRI	0:0898e006947b	814	// _writeCommand(0x42); // HV GEN 0100 S1=1, S2=0 (2x multiplier) (Instr. Set 1)
EDISON_NGUNJIRI	0:0898e006947b	815	_writeCommand(0x40 \| (LCD_PCF2_S12 & 0x03)); // HV Gen 0100 S1=1, S2=0 (2x multiplier) (Instr. Set 1)
EDISON_NGUNJIRI	0:0898e006947b	816
EDISON_NGUNJIRI	0:0898e006947b	817	_contrast = LCD_PCF2_CONTRAST;
EDISON_NGUNJIRI	0:0898e006947b	818	_writeCommand(0x80 \| 0x00 \| (_contrast & 0x3F)); // VLCD_set (Instr. Set 1) 1, V=0, VA=contrast
EDISON_NGUNJIRI	0:0898e006947b	819	_writeCommand(0x80 \| 0x40 \| (_contrast & 0x3F)); // VLCD_set (Instr. Set 1) 1, V=1, VB=contrast
EDISON_NGUNJIRI	0:0898e006947b	820	thread_sleep_for(10); // Wait 10ms to ensure powered up
EDISON_NGUNJIRI	0:0898e006947b	821
EDISON_NGUNJIRI	0:0898e006947b	822	_writeCommand(0x02); // Screen Config 0000 001, L=0 (Instr. Set 1)
EDISON_NGUNJIRI	0:0898e006947b	823	_writeCommand(0x08); // ICON Conf 0000 1, IM=0 (Char mode), IB=0 (no icon blink) DM=0 (no direct mode) (Instr. Set 1)
EDISON_NGUNJIRI	0:0898e006947b	824
EDISON_NGUNJIRI	0:0898e006947b	825	_writeCommand(0x20 \| _function); // Set function, Select Instr Set = 0
EDISON_NGUNJIRI	0:0898e006947b	826
EDISON_NGUNJIRI	0:0898e006947b	827	break; // case PCF2113_3V3 Controller
EDISON_NGUNJIRI	0:0898e006947b	828
EDISON_NGUNJIRI	0:0898e006947b	829
EDISON_NGUNJIRI	0:0898e006947b	830	// case PCF2113_5V:
EDISON_NGUNJIRI	0:0898e006947b	831	// PCF2113 controller: No Voltage generator for VLCD. VDD=5V. Contrast voltage controlled by VA or VB.
EDISON_NGUNJIRI	0:0898e006947b	832	//@TODO
EDISON_NGUNJIRI	0:0898e006947b	833
EDISON_NGUNJIRI	0:0898e006947b	834
EDISON_NGUNJIRI	0:0898e006947b	835	case PCF2116_3V3:
EDISON_NGUNJIRI	0:0898e006947b	836	// PCF2116 controller: Voltage generator for VLCD. VDD=5V. V0 controls contrast voltage.
EDISON_NGUNJIRI	0:0898e006947b	837	// Initialise Display configuration
EDISON_NGUNJIRI	0:0898e006947b	838	switch (_type) {
EDISON_NGUNJIRI	0:0898e006947b	839	// case LCD12x1:
EDISON_NGUNJIRI	0:0898e006947b	840	// case LCD12x2:
EDISON_NGUNJIRI	0:0898e006947b	841	case LCD24x1:
EDISON_NGUNJIRI	0:0898e006947b	842	_writeCommand(0x22); //FUNCTION SET 0 0 1 DL=0 4-bit, N=0/M=0 1-line/24 chars display mode, G=1 Vgen on, 0
EDISON_NGUNJIRI	0:0898e006947b	843	//Note: 4 bit mode is ignored for I2C mode
EDISON_NGUNJIRI	0:0898e006947b	844	thread_sleep_for(10); // Wait 10ms to ensure powered up
EDISON_NGUNJIRI	0:0898e006947b	845	break;
EDISON_NGUNJIRI	0:0898e006947b	846
EDISON_NGUNJIRI	0:0898e006947b	847	case LCD12x3D: // Special mode for KS0078 and PCF21XX
EDISON_NGUNJIRI	0:0898e006947b	848	case LCD12x3D1: // Special mode for PCF21XX
EDISON_NGUNJIRI	0:0898e006947b	849	case LCD12x4D: // Special mode for PCF21XX:
EDISON_NGUNJIRI	0:0898e006947b	850	_writeCommand(0x2E); //FUNCTION SET 0 0 1 DL=0 4-bit, N=1/M=1 4-line/12 chars display mode, G=1 VGen on, 0
EDISON_NGUNJIRI	0:0898e006947b	851	//Note: 4 bit mode is ignored for I2C mode
EDISON_NGUNJIRI	0:0898e006947b	852	thread_sleep_for(10); // Wait 10ms to ensure powered up
EDISON_NGUNJIRI	0:0898e006947b	853	break;
EDISON_NGUNJIRI	0:0898e006947b	854
EDISON_NGUNJIRI	0:0898e006947b	855	case LCD24x2:
EDISON_NGUNJIRI	0:0898e006947b	856	_writeCommand(0x2A); //FUNCTION SET 0 0 1 DL=0 4-bit, N=1/M=0 2-line/24 chars display mode, G=1 VGen on, 0
EDISON_NGUNJIRI	0:0898e006947b	857	//Note: 4 bit mode is ignored for I2C mode
EDISON_NGUNJIRI	0:0898e006947b	858	thread_sleep_for(10); // Wait 10ms to ensure powered up
EDISON_NGUNJIRI	0:0898e006947b	859	break;
EDISON_NGUNJIRI	0:0898e006947b	860
EDISON_NGUNJIRI	0:0898e006947b	861	default:
EDISON_NGUNJIRI	0:0898e006947b	862	error("Error: LCD Controller type does not support this Display type\n\r");
EDISON_NGUNJIRI	0:0898e006947b	863	break;
EDISON_NGUNJIRI	0:0898e006947b	864
EDISON_NGUNJIRI	0:0898e006947b	865	} // switch type
EDISON_NGUNJIRI	0:0898e006947b	866
EDISON_NGUNJIRI	0:0898e006947b	867	break; // case PCF2116_3V3 Controller
EDISON_NGUNJIRI	0:0898e006947b	868
EDISON_NGUNJIRI	0:0898e006947b	869
EDISON_NGUNJIRI	0:0898e006947b	870	//Experimental for cellphone 3-line display, SA=0x74, No Ack supported, Character set C or K, DL = 8 bit, N=0,M=1 (reserved mode !!), external VLCD -2V5
EDISON_NGUNJIRI	0:0898e006947b	871	//@TODO
EDISON_NGUNJIRI	0:0898e006947b	872	case PCF2116_5V:
EDISON_NGUNJIRI	0:0898e006947b	873	// PCF2116 controller: No Voltage generator for VLCD. VDD=5V. V0 controls contrast voltage.
EDISON_NGUNJIRI	0:0898e006947b	874	// Initialise Display configuration
EDISON_NGUNJIRI	0:0898e006947b	875	switch (_type) {
EDISON_NGUNJIRI	0:0898e006947b	876	// case LCD12x1:
EDISON_NGUNJIRI	0:0898e006947b	877	// case LCD12x2:
EDISON_NGUNJIRI	0:0898e006947b	878	// case LCD24x1:
EDISON_NGUNJIRI	0:0898e006947b	879	// _writeCommand(0x20); //FUNCTION SET 0 0 1 DL=0 4-bit, N=0/M=0 1-line/24 chars display mode, G=0 no Vgen, 0
EDISON_NGUNJIRI	0:0898e006947b	880	//Note: 4 bit mode is ignored for I2C mode
EDISON_NGUNJIRI	0:0898e006947b	881	// thread_sleep_for(10); // Wait 10ms to ensure powered up
EDISON_NGUNJIRI	0:0898e006947b	882	// break;
EDISON_NGUNJIRI	0:0898e006947b	883
EDISON_NGUNJIRI	0:0898e006947b	884	case LCD12x3D: // Special mode for KS0078 and PCF21XX
EDISON_NGUNJIRI	0:0898e006947b	885	case LCD12x3D1: // Special mode for PCF21XX
EDISON_NGUNJIRI	0:0898e006947b	886	case LCD12x4D: // Special mode for PCF21XX:
EDISON_NGUNJIRI	0:0898e006947b	887	// _writeCommand(0x34); //FUNCTION SET 8 bit, N=0/M=1 4-line/12 chars display mode OK
EDISON_NGUNJIRI	0:0898e006947b	888	// _writeCommand(0x24); //FUNCTION SET 4 bit, N=0/M=1 4-line/12 chars display mode OK
EDISON_NGUNJIRI	0:0898e006947b	889	_writeCommand(0x2C); //FUNCTION SET 0 0 1 DL=0 4-bit, N=1/M=1 4-line/12 chars display mode, G=0 no Vgen, 0 OK
EDISON_NGUNJIRI	0:0898e006947b	890	//Note: 4 bit mode is ignored for I2C mode
EDISON_NGUNJIRI	0:0898e006947b	891	thread_sleep_for(10); // Wait 10ms to ensure powered up
EDISON_NGUNJIRI	0:0898e006947b	892	break;
EDISON_NGUNJIRI	0:0898e006947b	893
EDISON_NGUNJIRI	0:0898e006947b	894	// case LCD24x2:
EDISON_NGUNJIRI	0:0898e006947b	895	// _writeCommand(0x28); //FUNCTION SET 4 bit, N=1/M=0 2-line/24 chars display mode
EDISON_NGUNJIRI	0:0898e006947b	896	//Note: 4 bit mode is ignored for I2C mode
EDISON_NGUNJIRI	0:0898e006947b	897	// thread_sleep_for(10); // Wait 10ms to ensure powered up
EDISON_NGUNJIRI	0:0898e006947b	898	// break;
EDISON_NGUNJIRI	0:0898e006947b	899
EDISON_NGUNJIRI	0:0898e006947b	900	default:
EDISON_NGUNJIRI	0:0898e006947b	901	error("Error: LCD Controller type does not support this Display type\n\r");
EDISON_NGUNJIRI	0:0898e006947b	902	break;
EDISON_NGUNJIRI	0:0898e006947b	903
EDISON_NGUNJIRI	0:0898e006947b	904	} // switch type
EDISON_NGUNJIRI	0:0898e006947b	905
EDISON_NGUNJIRI	0:0898e006947b	906	break; // case PCF2116_5V Controller
EDISON_NGUNJIRI	0:0898e006947b	907
EDISON_NGUNJIRI	0:0898e006947b	908	case PCF2119_3V3:
EDISON_NGUNJIRI	0:0898e006947b	909	case PCF2119R_3V3:
EDISON_NGUNJIRI	0:0898e006947b	910	// PCF2119 controller: Initialise Voltage booster for VLCD. VDD=3V3. VA and VB control contrast.
EDISON_NGUNJIRI	0:0898e006947b	911	// Note1: See datasheet, the PCF2119 supports icons and provides separate constrast control for Icons and characters.
EDISON_NGUNJIRI	0:0898e006947b	912	// Note2: Vgen is switched off when the contrast voltage VA or VB is set to 0x00.
EDISON_NGUNJIRI	0:0898e006947b	913
EDISON_NGUNJIRI	0:0898e006947b	914	//POR or Hardware Reset should be applied
EDISON_NGUNJIRI	0:0898e006947b	915	thread_sleep_for(10); // Wait 10ms to ensure powered up
EDISON_NGUNJIRI	0:0898e006947b	916
EDISON_NGUNJIRI	0:0898e006947b	917	// Initialise Display configuration
EDISON_NGUNJIRI	0:0898e006947b	918	switch (_type) {
EDISON_NGUNJIRI	0:0898e006947b	919	case LCD8x1:
EDISON_NGUNJIRI	0:0898e006947b	920	// case LCD12x1:
EDISON_NGUNJIRI	0:0898e006947b	921	case LCD16x1:
EDISON_NGUNJIRI	0:0898e006947b	922	_function = 0x02; // FUNCTION SET 0 0 1 DL=0 4-bit, 0 , M=0 1-line/16 chars display mode, SL=1
EDISON_NGUNJIRI	0:0898e006947b	923	// Note: 4 bit mode is ignored for I2C mode
EDISON_NGUNJIRI	0:0898e006947b	924	break;
EDISON_NGUNJIRI	0:0898e006947b	925
EDISON_NGUNJIRI	0:0898e006947b	926	case LCD24x1:
EDISON_NGUNJIRI	0:0898e006947b	927	// case LCD32x1:
EDISON_NGUNJIRI	0:0898e006947b	928	_function = 0x00; // FUNCTION SET 0 0 1 DL=0 4-bit, 0 , M=0 1-line/32 chars display mode, SL=0
EDISON_NGUNJIRI	0:0898e006947b	929	// Note: 4 bit mode is ignored for I2C mode
EDISON_NGUNJIRI	0:0898e006947b	930	break;
EDISON_NGUNJIRI	0:0898e006947b	931
EDISON_NGUNJIRI	0:0898e006947b	932	case LCD8x2:
EDISON_NGUNJIRI	0:0898e006947b	933	// case LCD12x2:
EDISON_NGUNJIRI	0:0898e006947b	934	case LCD16x2:
EDISON_NGUNJIRI	0:0898e006947b	935	_function = 0x04; // FUNCTION SET 0 0 1 DL=0 4-bit, 0, M=1 2-line/16 chars display mode, SL=0
EDISON_NGUNJIRI	0:0898e006947b	936	// Note: 4 bit mode is ignored for I2C mode
EDISON_NGUNJIRI	0:0898e006947b	937	break;
EDISON_NGUNJIRI	0:0898e006947b	938
EDISON_NGUNJIRI	0:0898e006947b	939	default:
EDISON_NGUNJIRI	0:0898e006947b	940	error("Error: LCD Controller type does not support this Display type\n\r");
EDISON_NGUNJIRI	0:0898e006947b	941	break;
EDISON_NGUNJIRI	0:0898e006947b	942
EDISON_NGUNJIRI	0:0898e006947b	943	} // switch type
EDISON_NGUNJIRI	0:0898e006947b	944
EDISON_NGUNJIRI	0:0898e006947b	945	// Init special features
EDISON_NGUNJIRI	0:0898e006947b	946	_writeCommand(0x20 \| _function \| 0x01); // Set function, Select Instruction Set = 1
EDISON_NGUNJIRI	0:0898e006947b	947
EDISON_NGUNJIRI	0:0898e006947b	948	// _writeCommand(0x04); // DISP CONF SET (Instr. Set 1) 0000, 0, 1, P=0, Q=0 (IC at Bottom)
EDISON_NGUNJIRI	0:0898e006947b	949	// _writeCommand(0x05); // Display Conf Set 0000, 0, 1, P=0, Q=1
EDISON_NGUNJIRI	0:0898e006947b	950	// _writeCommand(0x06); // Display Conf Set 0000, 0, 1, P=1, Q=0
EDISON_NGUNJIRI	0:0898e006947b	951	_writeCommand(0x07); // Display Conf Set 0000, 0, 1, P=1, Q=1 (IC at Top)
EDISON_NGUNJIRI	0:0898e006947b	952
EDISON_NGUNJIRI	0:0898e006947b	953	_writeCommand(0x10); // TEMP CTRL SET (Instr. Set 1) 0001, 0, 0, TC1=0, TC2=0
EDISON_NGUNJIRI	0:0898e006947b	954	// _writeCommand(0x42); // HV GEN (Instr. Set 1) 0100, 0, 0, S1=1, S2=0 (2x multiplier)
EDISON_NGUNJIRI	0:0898e006947b	955	_writeCommand(0x40 \| (LCD_PCF2_S12 & 0x03)); // HV GEN (Instr. Set 1) 0100, 0, 0, S1=1, S2=0 (2x multiplier)
EDISON_NGUNJIRI	0:0898e006947b	956
EDISON_NGUNJIRI	0:0898e006947b	957	_contrast = LCD_PCF2_CONTRAST;
EDISON_NGUNJIRI	0:0898e006947b	958	_writeCommand(0x80 \| 0x00 \| (_contrast & 0x3F)); // VLCD_set (Instr. Set 1) V=0, VA=contrast
EDISON_NGUNJIRI	0:0898e006947b	959	_writeCommand(0x80 \| 0x40 \| (_contrast & 0x3F)); // VLCD_set (Instr. Set 1) V=1, VB=contrast
EDISON_NGUNJIRI	0:0898e006947b	960	thread_sleep_for(10); // Wait 10ms to ensure powered up
EDISON_NGUNJIRI	0:0898e006947b	961
EDISON_NGUNJIRI	0:0898e006947b	962	_writeCommand(0x02); // SCRN CONF (Instr. Set 1) L=0
EDISON_NGUNJIRI	0:0898e006947b	963	_writeCommand(0x08); // ICON CONF (Instr. Set 1) IM=0 (Char mode) IB=0 (no icon blink) DM=0 (no direct mode)
EDISON_NGUNJIRI	0:0898e006947b	964
EDISON_NGUNJIRI	0:0898e006947b	965	_writeCommand(0x20 \| _function); // Select Instruction Set = 0
EDISON_NGUNJIRI	0:0898e006947b	966
EDISON_NGUNJIRI	0:0898e006947b	967	break; // case PCF2119_3V3 Controller
EDISON_NGUNJIRI	0:0898e006947b	968
EDISON_NGUNJIRI	0:0898e006947b	969	// case PCF2119_5V:
EDISON_NGUNJIRI	0:0898e006947b	970	// PCF2119 controller: No Voltage booster for VLCD. VDD=3V3. VA and VB control contrast.
EDISON_NGUNJIRI	0:0898e006947b	971	// Note1: See datasheet, the PCF2119 supports icons and provides separate constrast control for Icons and characters.
EDISON_NGUNJIRI	0:0898e006947b	972	// Note2: Vgen is switched off when the contrast voltage VA or VB is set to 0x00.
EDISON_NGUNJIRI	0:0898e006947b	973	//@TODO
EDISON_NGUNJIRI	0:0898e006947b	974
EDISON_NGUNJIRI	0:0898e006947b	975	case WS0010:
EDISON_NGUNJIRI	0:0898e006947b	976	// WS0010 OLED controller: Initialise DC/DC Voltage converter for LEDs
EDISON_NGUNJIRI	0:0898e006947b	977	// Note1: Identical to RS0010
EDISON_NGUNJIRI	0:0898e006947b	978	// Note2: supports 1 or 2 lines (and 16x100 graphics)
EDISON_NGUNJIRI	0:0898e006947b	979	// supports 4 fonts (English/Japanese (default), Western European-I, English/Russian, Western European-II)
EDISON_NGUNJIRI	0:0898e006947b	980	// Cursor/Disp shift set 0001 SC RL 0 0
EDISON_NGUNJIRI	0:0898e006947b	981	//
EDISON_NGUNJIRI	0:0898e006947b	982	// Mode and Power set 0001 GC PWR 1 1
EDISON_NGUNJIRI	0:0898e006947b	983	// GC = 0 (Graph Mode=1, Char Mode=0)
EDISON_NGUNJIRI	0:0898e006947b	984	// PWR = 1 (DC/DC On/Off)
EDISON_NGUNJIRI	0:0898e006947b	985
EDISON_NGUNJIRI	0:0898e006947b	986	//@Todo: This may be needed to enable a warm reboot
EDISON_NGUNJIRI	0:0898e006947b	987	//_writeCommand(0x13); // Char mode, DC/DC off
EDISON_NGUNJIRI	0:0898e006947b	988	//thread_sleep_for(10); // Wait 10ms to ensure powered down
EDISON_NGUNJIRI	0:0898e006947b	989	_writeCommand(0x17); // Char mode, DC/DC on
EDISON_NGUNJIRI	0:0898e006947b	990	thread_sleep_for(10); // Wait 10ms to ensure powered up
EDISON_NGUNJIRI	0:0898e006947b	991
EDISON_NGUNJIRI	0:0898e006947b	992	// Initialise Display configuration
EDISON_NGUNJIRI	0:0898e006947b	993	switch (_type) {
EDISON_NGUNJIRI	0:0898e006947b	994	case LCD8x1: //8x1 is a regular 1 line display
EDISON_NGUNJIRI	0:0898e006947b	995	case LCD8x2B: //8x2B is a special case of 16x1
EDISON_NGUNJIRI	0:0898e006947b	996	// case LCD12x1:
EDISON_NGUNJIRI	0:0898e006947b	997	case LCD16x1:
EDISON_NGUNJIRI	0:0898e006947b	998	case LCD24x1:
EDISON_NGUNJIRI	0:0898e006947b	999	_writeCommand(0x20); // Function set 001 DL N F FT1 FT0
EDISON_NGUNJIRI	0:0898e006947b	1000	// DL=0 (4 bits bus)
EDISON_NGUNJIRI	0:0898e006947b	1001	// N=0 (1 line)
EDISON_NGUNJIRI	0:0898e006947b	1002	// F=0 (5x7 dots font)
EDISON_NGUNJIRI	0:0898e006947b	1003	// FT=00 (00 = Engl/Jap, 01 = WestEur1, 10 = Engl/Russian, 11 = WestEur2
EDISON_NGUNJIRI	0:0898e006947b	1004	break;
EDISON_NGUNJIRI	0:0898e006947b	1005
EDISON_NGUNJIRI	0:0898e006947b	1006	case LCD12x3D: // Special mode for KS0078 and PCF21XX
EDISON_NGUNJIRI	0:0898e006947b	1007	case LCD12x3D1: // Special mode for PCF21XX
EDISON_NGUNJIRI	0:0898e006947b	1008	case LCD12x4D: // Special mode for PCF21XX:
EDISON_NGUNJIRI	0:0898e006947b	1009	case LCD16x3G: // Special mode for ST7036
EDISON_NGUNJIRI	0:0898e006947b	1010	case LCD24x4D: // Special mode for KS0078
EDISON_NGUNJIRI	0:0898e006947b	1011	error("Error: LCD Controller type does not support this Display type\n\r");
EDISON_NGUNJIRI	0:0898e006947b	1012	break;
EDISON_NGUNJIRI	0:0898e006947b	1013
EDISON_NGUNJIRI	0:0898e006947b	1014	default:
EDISON_NGUNJIRI	0:0898e006947b	1015	// All other LCD types are initialised as 2 Line displays (including LCD16x1C and LCD40x4)
EDISON_NGUNJIRI	0:0898e006947b	1016	_writeCommand(0x28); // Function set 001 DL N F FT1 FT0
EDISON_NGUNJIRI	0:0898e006947b	1017	// DL=0 (4 bits bus)
EDISON_NGUNJIRI	0:0898e006947b	1018	// N=1 (2 lines)
EDISON_NGUNJIRI	0:0898e006947b	1019	// F=0 (5x7 dots font)
EDISON_NGUNJIRI	0:0898e006947b	1020	// FT=00 (00 = Engl/Jap, 01 = WestEur1, 10 = Engl/Russian, 11 = WestEur2
EDISON_NGUNJIRI	0:0898e006947b	1021
EDISON_NGUNJIRI	0:0898e006947b	1022	break;
EDISON_NGUNJIRI	0:0898e006947b	1023	} // switch type
EDISON_NGUNJIRI	0:0898e006947b	1024
EDISON_NGUNJIRI	0:0898e006947b	1025	break; // case WS0010 Controller
EDISON_NGUNJIRI	0:0898e006947b	1026
EDISON_NGUNJIRI	0:0898e006947b	1027
EDISON_NGUNJIRI	0:0898e006947b	1028	case US2066_3V3:
EDISON_NGUNJIRI	0:0898e006947b	1029	// US2066/SSD1311 OLED controller, Initialise for VDD=3V3
EDISON_NGUNJIRI	0:0898e006947b	1030	// Note: supports 1,2, 3 or 4 lines
EDISON_NGUNJIRI	0:0898e006947b	1031	// case USS2066_5V:
EDISON_NGUNJIRI	0:0898e006947b	1032	// US2066 controller, VDD=5V
EDISON_NGUNJIRI	0:0898e006947b	1033
EDISON_NGUNJIRI	0:0898e006947b	1034	// Initialise Display configuration
EDISON_NGUNJIRI	0:0898e006947b	1035	switch (_type) {
EDISON_NGUNJIRI	0:0898e006947b	1036	case LCD8x1: //8x1 is a regular 1 line display
EDISON_NGUNJIRI	0:0898e006947b	1037	case LCD8x2B: //8x2D is a special case of 16x1
EDISON_NGUNJIRI	0:0898e006947b	1038	// case LCD12x1:
EDISON_NGUNJIRI	0:0898e006947b	1039	case LCD16x1:
EDISON_NGUNJIRI	0:0898e006947b	1040	// case LCD20x1:
EDISON_NGUNJIRI	0:0898e006947b	1041	_function = 0x00; // Set function 0 0 1 X N DH RE(0) IS
EDISON_NGUNJIRI	0:0898e006947b	1042	// Saved to allow switch between Instruction sets at later time
EDISON_NGUNJIRI	0:0898e006947b	1043	// DL=X bit is ignored for US2066. Uses hardwired pins instead
EDISON_NGUNJIRI	0:0898e006947b	1044	// N=0 1 Line / 3 Line
EDISON_NGUNJIRI	0:0898e006947b	1045	// DH=0 Double Height disable
EDISON_NGUNJIRI	0:0898e006947b	1046	// IS=0
EDISON_NGUNJIRI	0:0898e006947b	1047
EDISON_NGUNJIRI	0:0898e006947b	1048	_function_1 = 0x02; // Set function, 0 0 1 X N BE RE(1) REV
EDISON_NGUNJIRI	0:0898e006947b	1049	// Saved to allow switch between Instruction sets at later time
EDISON_NGUNJIRI	0:0898e006947b	1050	// DL=X bit is ignored for US2066. Uses hardwired pins instead
EDISON_NGUNJIRI	0:0898e006947b	1051	// N=0 1 Line / 3 Line
EDISON_NGUNJIRI	0:0898e006947b	1052	// BE=0 Blink Enable off, special feature of SSD1803, US2066
EDISON_NGUNJIRI	0:0898e006947b	1053	// REV=0 Reverse off, special feature of SSD1803, US2066
EDISON_NGUNJIRI	0:0898e006947b	1054
EDISON_NGUNJIRI	0:0898e006947b	1055	_lines = 0x00; // Ext function set 0 0 0 0 1 FW BW NW
EDISON_NGUNJIRI	0:0898e006947b	1056	// NW=0 1-Line LCD (N=0)
EDISON_NGUNJIRI	0:0898e006947b	1057	break;
EDISON_NGUNJIRI	0:0898e006947b	1058
EDISON_NGUNJIRI	0:0898e006947b	1059	case LCD16x1C:
EDISON_NGUNJIRI	0:0898e006947b	1060	case LCD8x2:
EDISON_NGUNJIRI	0:0898e006947b	1061	case LCD16x2:
EDISON_NGUNJIRI	0:0898e006947b	1062	case LCD20x2:
EDISON_NGUNJIRI	0:0898e006947b	1063	_function = 0x08; // Set function 0 0 1 X N DH RE(0) IS
EDISON_NGUNJIRI	0:0898e006947b	1064	// Saved to allow switch between Instruction sets at later time
EDISON_NGUNJIRI	0:0898e006947b	1065	// DL=X bit is ignored for US2066. Uses hardwired pins instead
EDISON_NGUNJIRI	0:0898e006947b	1066	// N=1 2 line / 4 Line
EDISON_NGUNJIRI	0:0898e006947b	1067	// DH=0 Double Height disable
EDISON_NGUNJIRI	0:0898e006947b	1068	// IS=0
EDISON_NGUNJIRI	0:0898e006947b	1069
EDISON_NGUNJIRI	0:0898e006947b	1070	_function_1 = 0x0A; // Set function, 0 0 1 X N BE RE(1) REV
EDISON_NGUNJIRI	0:0898e006947b	1071	// Saved to allow switch between Instruction sets at later time
EDISON_NGUNJIRI	0:0898e006947b	1072	// DL=X bit is ignored for US2066. Uses hardwired pins instead
EDISON_NGUNJIRI	0:0898e006947b	1073	// N=1 2 line / 4 Line
EDISON_NGUNJIRI	0:0898e006947b	1074	// BE=0 Blink Enable off, special feature of SSD1803, US2066
EDISON_NGUNJIRI	0:0898e006947b	1075	// REV=0 Reverse off, special feature of SSD1803, US2066
EDISON_NGUNJIRI	0:0898e006947b	1076
EDISON_NGUNJIRI	0:0898e006947b	1077	_lines = 0x00; // Ext function set 0 0 0 0 1 FW BW NW
EDISON_NGUNJIRI	0:0898e006947b	1078	// NW=0 2-Line LCD (N=1)
EDISON_NGUNJIRI	0:0898e006947b	1079	break;
EDISON_NGUNJIRI	0:0898e006947b	1080
EDISON_NGUNJIRI	0:0898e006947b	1081	case LCD12x3D: // Special mode for KS0078 and PCF21XX
EDISON_NGUNJIRI	0:0898e006947b	1082	// case LCD12x3D1: // Special mode for KS0078 and PCF21XX
EDISON_NGUNJIRI	0:0898e006947b	1083	case LCD16x3D: // Special mode for KS0078, SSD1803 and US2066
EDISON_NGUNJIRI	0:0898e006947b	1084	// case LCD16x3D1: // Special mode for SSD1803, US2066
EDISON_NGUNJIRI	0:0898e006947b	1085	// case LCD20x3D: // Special mode for SSD1803, US2066
EDISON_NGUNJIRI	0:0898e006947b	1086	_function = 0x00; // Set function 0 0 1 X N DH RE(0) IS
EDISON_NGUNJIRI	0:0898e006947b	1087	// Saved to allow switch between Instruction sets at later time
EDISON_NGUNJIRI	0:0898e006947b	1088	// DL=X bit is ignored for US2066. Uses hardwired pins instead
EDISON_NGUNJIRI	0:0898e006947b	1089	// N=0 1 Line / 3 Line
EDISON_NGUNJIRI	0:0898e006947b	1090	// DH=0 Double Height disable
EDISON_NGUNJIRI	0:0898e006947b	1091	// IS=0
EDISON_NGUNJIRI	0:0898e006947b	1092
EDISON_NGUNJIRI	0:0898e006947b	1093	_function_1 = 0x02; // Set function, 0 0 1 X N BE RE(1) REV
EDISON_NGUNJIRI	0:0898e006947b	1094	// Saved to allow switch between Instruction sets at later time
EDISON_NGUNJIRI	0:0898e006947b	1095	// DL=X bit is ignored for US2066. Uses hardwired pins instead
EDISON_NGUNJIRI	0:0898e006947b	1096	// N=0 1 Line / 3 Line
EDISON_NGUNJIRI	0:0898e006947b	1097	// BE=0 Blink Enable off, special feature of SSD1803, US2066
EDISON_NGUNJIRI	0:0898e006947b	1098	// REV=0 Reverse off, special feature of SSD1803, US2066
EDISON_NGUNJIRI	0:0898e006947b	1099
EDISON_NGUNJIRI	0:0898e006947b	1100	_lines = 0x00; // Ext function set 0 0 0 0 1 FW BW NW
EDISON_NGUNJIRI	0:0898e006947b	1101	// NW=1 3-Line LCD (N=0)
EDISON_NGUNJIRI	0:0898e006947b	1102	break;
EDISON_NGUNJIRI	0:0898e006947b	1103
EDISON_NGUNJIRI	0:0898e006947b	1104	case LCD20x4D: // Special mode for SSD1803, US2066
EDISON_NGUNJIRI	0:0898e006947b	1105	_function = 0x08; // Set function 0 0 1 X N DH RE(0) IS
EDISON_NGUNJIRI	0:0898e006947b	1106	// Saved to allow switch between Instruction sets at later time
EDISON_NGUNJIRI	0:0898e006947b	1107	// DL=X bit is ignored for US2066. Uses hardwired pins instead
EDISON_NGUNJIRI	0:0898e006947b	1108	// N=1 2 line / 4 Line
EDISON_NGUNJIRI	0:0898e006947b	1109	// DH=0 Double Height disable
EDISON_NGUNJIRI	0:0898e006947b	1110	// IS=0
EDISON_NGUNJIRI	0:0898e006947b	1111
EDISON_NGUNJIRI	0:0898e006947b	1112	_function_1 = 0x0A; // Set function, 0 0 1 DL N BE RE(1) REV
EDISON_NGUNJIRI	0:0898e006947b	1113	// Saved to allow switch between Instruction sets at later time
EDISON_NGUNJIRI	0:0898e006947b	1114	// DL=0 bit is ignored for US2066. Uses hardwired pins instead
EDISON_NGUNJIRI	0:0898e006947b	1115	// N=1 2 line / 4 Line
EDISON_NGUNJIRI	0:0898e006947b	1116	// BE=0 Blink Enable off, special feature of SSD1803, US2066
EDISON_NGUNJIRI	0:0898e006947b	1117	// REV=0 Reverse off, special feature of SSD1803, US2066
EDISON_NGUNJIRI	0:0898e006947b	1118
EDISON_NGUNJIRI	0:0898e006947b	1119	_lines = 0x01; // Ext function set 0 0 0 0 1 FW BW NW
EDISON_NGUNJIRI	0:0898e006947b	1120	// NW=1 4-Line LCD (N=1)
EDISON_NGUNJIRI	0:0898e006947b	1121	break;
EDISON_NGUNJIRI	0:0898e006947b	1122
EDISON_NGUNJIRI	0:0898e006947b	1123	// case LCD24x1:
EDISON_NGUNJIRI	0:0898e006947b	1124	// case LCD16x3G: // Special mode for ST7036
EDISON_NGUNJIRI	0:0898e006947b	1125	// case LCD24x4D: // Special mode for KS0078
EDISON_NGUNJIRI	0:0898e006947b	1126	default:
EDISON_NGUNJIRI	0:0898e006947b	1127	error("Error: LCD Controller type does not support this Display type\n\r");
EDISON_NGUNJIRI	0:0898e006947b	1128	break;
EDISON_NGUNJIRI	0:0898e006947b	1129
EDISON_NGUNJIRI	0:0898e006947b	1130	} // switch type
EDISON_NGUNJIRI	0:0898e006947b	1131
EDISON_NGUNJIRI	0:0898e006947b	1132	_writeCommand(0x00); // NOP, make sure to sync SPI
EDISON_NGUNJIRI	0:0898e006947b	1133
EDISON_NGUNJIRI	0:0898e006947b	1134	// init special features
EDISON_NGUNJIRI	0:0898e006947b	1135	_writeCommand(0x20 \| _function_1); // Set function, 0 0 1 X N BE RE(1) REV
EDISON_NGUNJIRI	0:0898e006947b	1136	// Select Extended Instruction Set
EDISON_NGUNJIRI	0:0898e006947b	1137
EDISON_NGUNJIRI	0:0898e006947b	1138	_writeCommand(0x71); // Function Select A: 0 1 1 1 0 0 0 1 (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	1139	_writeData(0x00); // Disable Internal VDD
EDISON_NGUNJIRI	0:0898e006947b	1140
EDISON_NGUNJIRI	0:0898e006947b	1141	_writeCommand(0x79); // Function Select OLED: 0 1 1 1 1 0 0 1 (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	1142
EDISON_NGUNJIRI	0:0898e006947b	1143	_writeCommand(0xD5); // Display Clock Divide Ratio: 1 1 0 1 0 1 0 1 (Ext Instr Set, OLED Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	1144	_writeCommand(0x70); // Display Clock Divide Ratio value: 0 1 1 1 0 0 0 0 (Ext Instr Set, OLED Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	1145
EDISON_NGUNJIRI	0:0898e006947b	1146	_writeCommand(0x78); // Function Disable OLED: 0 1 1 1 1 0 0 0 (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	1147
EDISON_NGUNJIRI	0:0898e006947b	1148	// _writeCommand(0x06); // Set ext entry mode, 0 0 0 0 0 1 BDC=1 COM1-32, BDS=0 SEG100-1 "Bottom View" (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	1149	_writeCommand(0x05); // Set ext entry mode, 0 0 0 0 0 1 BDC=0 COM32-1, BDS=1 SEG1-100 "Top View" (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	1150
EDISON_NGUNJIRI	0:0898e006947b	1151	_writeCommand(0x08 \| _lines); // Set ext function 0 0 0 0 1 FW BW NW 1,2,3 or 4 lines (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	1152
EDISON_NGUNJIRI	0:0898e006947b	1153	// _writeCommand(0x1C); // Double Height, 0 0 0 1 UD2=1, UD1=1, X, DH'=0 (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	1154	// // Default
EDISON_NGUNJIRI	0:0898e006947b	1155
EDISON_NGUNJIRI	0:0898e006947b	1156	_writeCommand(0x72); // Function Select B: 0 1 1 1 0 0 1 0 (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	1157	_writeData(0x01); // Select ROM A (CGRAM 8, CGROM 248)
EDISON_NGUNJIRI	0:0898e006947b	1158
EDISON_NGUNJIRI	0:0898e006947b	1159	_writeCommand(0x79); // Function Select OLED: 0 1 1 1 1 0 0 1 (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	1160
EDISON_NGUNJIRI	0:0898e006947b	1161	_writeCommand(0xDA); // Set Segm Pins Config: 1 1 0 1 1 0 1 0 (Ext Instr Set, OLED)
EDISON_NGUNJIRI	0:0898e006947b	1162	_writeCommand(0x10); // Set Segm Pins Config value: Altern Odd/Even, Disable Remap (Ext Instr Set, OLED)
EDISON_NGUNJIRI	0:0898e006947b	1163
EDISON_NGUNJIRI	0:0898e006947b	1164	_writeCommand(0xDC); // Function Select C: 1 1 0 1 1 1 0 0 (Ext Instr Set, OLED)
EDISON_NGUNJIRI	0:0898e006947b	1165	// _writeCommand(0x00); // Set internal VSL, GPIO pin HiZ (always read low)
EDISON_NGUNJIRI	0:0898e006947b	1166	_writeCommand(0x80); // Set external VSL, GPIO pin HiZ (always read low)
EDISON_NGUNJIRI	0:0898e006947b	1167
EDISON_NGUNJIRI	0:0898e006947b	1168	_contrast = LCD_US20_CONTRAST;
EDISON_NGUNJIRI	0:0898e006947b	1169	_writeCommand(0x81); // Set Contrast Control: 1 0 0 0 0 0 0 1 (Ext Instr Set, OLED)
EDISON_NGUNJIRI	0:0898e006947b	1170	_writeCommand((_contrast << 2) \| 0x03); // Set Contrast Value: 8 bits, use 6 bits for compatibility
EDISON_NGUNJIRI	0:0898e006947b	1171
EDISON_NGUNJIRI	0:0898e006947b	1172	_writeCommand(0xD9); // Set Phase Length: 1 1 0 1 1 0 0 1 (Ext Instr Set, OLED)
EDISON_NGUNJIRI	0:0898e006947b	1173	_writeCommand(0xF1); // Set Phase Length Value:
EDISON_NGUNJIRI	0:0898e006947b	1174
EDISON_NGUNJIRI	0:0898e006947b	1175	_writeCommand(0xDB); // Set VCOMH Deselect Lvl: 1 1 0 1 1 0 1 1 (Ext Instr Set, OLED)
EDISON_NGUNJIRI	0:0898e006947b	1176	_writeCommand(0x30); // Set VCOMH Deselect Value: 0.83 x VCC
EDISON_NGUNJIRI	0:0898e006947b	1177
EDISON_NGUNJIRI	0:0898e006947b	1178	thread_sleep_for(10); // Wait 10ms to ensure powered up
EDISON_NGUNJIRI	0:0898e006947b	1179
EDISON_NGUNJIRI	0:0898e006947b	1180	//Test Fade/Blinking. Hard Blink on/off, No fade in/out ??
EDISON_NGUNJIRI	0:0898e006947b	1181	// _writeCommand(0x23); // Set (Ext Instr Set, OLED)
EDISON_NGUNJIRI	0:0898e006947b	1182	// _writeCommand(0x3F); // Set interval 128 frames
EDISON_NGUNJIRI	0:0898e006947b	1183	//End Test Blinking
EDISON_NGUNJIRI	0:0898e006947b	1184
EDISON_NGUNJIRI	0:0898e006947b	1185	_writeCommand(0x78); // Function Disable OLED: 0 1 1 1 1 0 0 0 (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	1186
EDISON_NGUNJIRI	0:0898e006947b	1187	_writeCommand(0x20 \| _function \| 0x01); // Set function, 0 0 1 X N DH RE(0) IS=1 Select Instruction Set 1
EDISON_NGUNJIRI	0:0898e006947b	1188	// Select Std Instr set, Select IS=1
EDISON_NGUNJIRI	0:0898e006947b	1189
EDISON_NGUNJIRI	0:0898e006947b	1190	_writeCommand(0x20 \| _function_1); // Set function, 0 0 1 X N BE RE(1) REV
EDISON_NGUNJIRI	0:0898e006947b	1191	// Select Ext Instr Set, IS=1
EDISON_NGUNJIRI	0:0898e006947b	1192	_writeCommand(0x10); // Shift/Scroll enable, 0 0 0 1 DS4/HS4 DS3/HS3 DS2/HS2 DS1/HS1 (Ext Instr Set, IS=1)
EDISON_NGUNJIRI	0:0898e006947b	1193
EDISON_NGUNJIRI	0:0898e006947b	1194	_writeCommand(0x20 \| _function); // Set function, 0 0 1 DL N DH RE(0) IS=0 Select Instruction Set 0
EDISON_NGUNJIRI	0:0898e006947b	1195	// Select Std Instr set, Select IS=0
EDISON_NGUNJIRI	0:0898e006947b	1196	break; // case US2066/SSD1311 Controller
EDISON_NGUNJIRI	0:0898e006947b	1197
EDISON_NGUNJIRI	0:0898e006947b	1198	//not yet tested on hardware
EDISON_NGUNJIRI	0:0898e006947b	1199	case PT6314 :
EDISON_NGUNJIRI	0:0898e006947b	1200	// Initialise Display configuration
EDISON_NGUNJIRI	0:0898e006947b	1201	switch (_type) {
EDISON_NGUNJIRI	0:0898e006947b	1202	case LCD8x1: //8x1 is a regular 1 line display
EDISON_NGUNJIRI	0:0898e006947b	1203	case LCD8x2B: //8x2B is a special case of 16x1
EDISON_NGUNJIRI	0:0898e006947b	1204	// case LCD12x1:
EDISON_NGUNJIRI	0:0898e006947b	1205	case LCD16x1:
EDISON_NGUNJIRI	0:0898e006947b	1206	case LCD20x1:
EDISON_NGUNJIRI	0:0898e006947b	1207	case LCD24x1:
EDISON_NGUNJIRI	0:0898e006947b	1208	_function = 0x00; // Function set 001 DL N X BR1 BR0
EDISON_NGUNJIRI	0:0898e006947b	1209	// DL=0 (4 bits bus)
EDISON_NGUNJIRI	0:0898e006947b	1210	// Note: 4 bit mode is ignored for native SPI and I2C devices
EDISON_NGUNJIRI	0:0898e006947b	1211	// N=0 (1 line)
EDISON_NGUNJIRI	0:0898e006947b	1212	// X
EDISON_NGUNJIRI	0:0898e006947b	1213	// BR1=0 (2 significant bits for brightness
EDISON_NGUNJIRI	0:0898e006947b	1214	// BR0=0
EDISON_NGUNJIRI	0:0898e006947b	1215	// 0x0 = 100%
EDISON_NGUNJIRI	0:0898e006947b	1216	// 0x1 = 75%
EDISON_NGUNJIRI	0:0898e006947b	1217	// 0x2 = 50%
EDISON_NGUNJIRI	0:0898e006947b	1218	// 0x3 = 25%
EDISON_NGUNJIRI	0:0898e006947b	1219
EDISON_NGUNJIRI	0:0898e006947b	1220	break;
EDISON_NGUNJIRI	0:0898e006947b	1221
EDISON_NGUNJIRI	0:0898e006947b	1222	// All other valid LCD types are initialised as 2 Line displays
EDISON_NGUNJIRI	0:0898e006947b	1223	case LCD8x2:
EDISON_NGUNJIRI	0:0898e006947b	1224	case LCD16x2:
EDISON_NGUNJIRI	0:0898e006947b	1225	case LCD20x2:
EDISON_NGUNJIRI	0:0898e006947b	1226	case LCD24x2:
EDISON_NGUNJIRI	0:0898e006947b	1227	_function = 0x08; // Function set 001 DL N X BR1 BR2
EDISON_NGUNJIRI	0:0898e006947b	1228	// DL=0 (4 bits bus)
EDISON_NGUNJIRI	0:0898e006947b	1229	// Note: 4 bit mode is ignored for native SPI and I2C devices
EDISON_NGUNJIRI	0:0898e006947b	1230	// N=1 (2 lines)
EDISON_NGUNJIRI	0:0898e006947b	1231	// X
EDISON_NGUNJIRI	0:0898e006947b	1232	// BR1=0 (2 significant bits for brightness
EDISON_NGUNJIRI	0:0898e006947b	1233	// BR0=0
EDISON_NGUNJIRI	0:0898e006947b	1234	break;
EDISON_NGUNJIRI	0:0898e006947b	1235
EDISON_NGUNJIRI	0:0898e006947b	1236	default:
EDISON_NGUNJIRI	0:0898e006947b	1237	error("Error: LCD Controller type does not support this Display type\n\r");
EDISON_NGUNJIRI	0:0898e006947b	1238	break;
EDISON_NGUNJIRI	0:0898e006947b	1239	} // switch type
EDISON_NGUNJIRI	0:0898e006947b	1240
EDISON_NGUNJIRI	0:0898e006947b	1241	_contrast = LCD_PT63_CONTRAST;
EDISON_NGUNJIRI	0:0898e006947b	1242	_writeCommand(0x20 \| _function \| ((~_contrast) >> 4)); // Invert and shift to use 2 MSBs
EDISON_NGUNJIRI	0:0898e006947b	1243	break; // case PT6314 Controller (VFD)
EDISON_NGUNJIRI	0:0898e006947b	1244
EDISON_NGUNJIRI	0:0898e006947b	1245
EDISON_NGUNJIRI	0:0898e006947b	1246	case HD66712:
EDISON_NGUNJIRI	0:0898e006947b	1247	// Initialise Display configuration
EDISON_NGUNJIRI	0:0898e006947b	1248	switch (_type) {
EDISON_NGUNJIRI	0:0898e006947b	1249	case LCD8x1: //8x1 is a regular 1 line display
EDISON_NGUNJIRI	0:0898e006947b	1250	case LCD12x1:
EDISON_NGUNJIRI	0:0898e006947b	1251	case LCD16x1:
EDISON_NGUNJIRI	0:0898e006947b	1252	case LCD20x1:
EDISON_NGUNJIRI	0:0898e006947b	1253	case LCD24x1:
EDISON_NGUNJIRI	0:0898e006947b	1254	// case LCD32x1: // EXT pin is High, extension driver needed
EDISON_NGUNJIRI	0:0898e006947b	1255	_function = 0x02; // Function set 001 DL N RE(0) - - (Std Regs)
EDISON_NGUNJIRI	0:0898e006947b	1256	// DL=0 (4 bits bus)
EDISON_NGUNJIRI	0:0898e006947b	1257	// N=0 (1-line mode, N=1 2-line mode)
EDISON_NGUNJIRI	0:0898e006947b	1258	// RE=0 (Dis. Extended Regs, special mode for HD66712)
EDISON_NGUNJIRI	0:0898e006947b	1259	//
EDISON_NGUNJIRI	0:0898e006947b	1260
EDISON_NGUNJIRI	0:0898e006947b	1261	_function_1 = 0x04; // Function set 001 DL N RE(1) BE LP (Ext Regs)
EDISON_NGUNJIRI	0:0898e006947b	1262	// DL=0 (4 bits bus)
EDISON_NGUNJIRI	0:0898e006947b	1263	// N=0 (1-line mode, N=1 2-line mode)
EDISON_NGUNJIRI	0:0898e006947b	1264	// RE=1 (Ena Extended Regs; special mode for HD66712)
EDISON_NGUNJIRI	0:0898e006947b	1265	// BE=0 (Blink Enable, CG/SEG RAM; special mode for HD66712)
EDISON_NGUNJIRI	0:0898e006947b	1266	// LP=0 (LP=1 Low power mode, LP=0 Normal; special mode for HD66712)
EDISON_NGUNJIRI	0:0898e006947b	1267
EDISON_NGUNJIRI	0:0898e006947b	1268	_function_x = 0x00; // Ext Function set 0000 1 FW BW NW (Ext Regs)
EDISON_NGUNJIRI	0:0898e006947b	1269	// NW=0 (1,2 line), NW=1 (4 Line, special mode for HD66712)
EDISON_NGUNJIRI	0:0898e006947b	1270	break;
EDISON_NGUNJIRI	0:0898e006947b	1271
EDISON_NGUNJIRI	0:0898e006947b	1272	// case LCD12x3D: // Special mode for KS0073, KS0078, PCF21XX and HD66712
EDISON_NGUNJIRI	0:0898e006947b	1273	// case LCD12x3D1: // Special mode for KS0073, KS0078, PCF21XX and HD66712
EDISON_NGUNJIRI	0:0898e006947b	1274	case LCD12x4D: // Special mode for KS0073, KS0078, PCF21XX and HD66712
EDISON_NGUNJIRI	0:0898e006947b	1275	// case LCD16x3D: // Special mode for KS0073, KS0078 and HD66712
EDISON_NGUNJIRI	0:0898e006947b	1276	// case LCD16x4D: // Special mode for KS0073, KS0078 and HD66712
EDISON_NGUNJIRI	0:0898e006947b	1277	case LCD20x4D: // Special mode for KS0073, KS0078 and HD66712
EDISON_NGUNJIRI	0:0898e006947b	1278	_function = 0x02; // Function set 001 DL N RE(0) - - (Std Regs)
EDISON_NGUNJIRI	0:0898e006947b	1279	// DL=0 (4 bits bus)
EDISON_NGUNJIRI	0:0898e006947b	1280	// N=0 (1-line mode, N=1 2-line mode)
EDISON_NGUNJIRI	0:0898e006947b	1281	// RE=0 (Dis. Extended Regs, special mode for HD66712)
EDISON_NGUNJIRI	0:0898e006947b	1282	//
EDISON_NGUNJIRI	0:0898e006947b	1283
EDISON_NGUNJIRI	0:0898e006947b	1284	_function_1 = 0x04; // Function set 001 DL N RE(1) BE LP (Ext Regs)
EDISON_NGUNJIRI	0:0898e006947b	1285	// DL=0 (4 bits bus)
EDISON_NGUNJIRI	0:0898e006947b	1286	// N=0 (1-line mode, N=1 2-line mode)
EDISON_NGUNJIRI	0:0898e006947b	1287	// RE=1 (Ena Extended Regs; special mode for HD66712)
EDISON_NGUNJIRI	0:0898e006947b	1288	// BE=0 (Blink Enable, CG/SEG RAM; special mode for HD66712)
EDISON_NGUNJIRI	0:0898e006947b	1289	// LP=0 (LP=1 Low power mode, LP=0 Normal; special mode for HD66712)
EDISON_NGUNJIRI	0:0898e006947b	1290
EDISON_NGUNJIRI	0:0898e006947b	1291	_function_x = 0x01; // Ext Function set 0000 1 FW BW NW (Ext Regs)
EDISON_NGUNJIRI	0:0898e006947b	1292	// NW=0 (1,2 line), NW=1 (4 Line, special mode for HD66712)
EDISON_NGUNJIRI	0:0898e006947b	1293	break;
EDISON_NGUNJIRI	0:0898e006947b	1294
EDISON_NGUNJIRI	0:0898e006947b	1295	case LCD16x3G: // Special mode for ST7036
EDISON_NGUNJIRI	0:0898e006947b	1296	// case LCD24x3D: // Special mode for KS0078
EDISON_NGUNJIRI	0:0898e006947b	1297	// case LCD24x3D1: // Special mode for KS0078
EDISON_NGUNJIRI	0:0898e006947b	1298	case LCD24x4D: // Special mode for KS0078
EDISON_NGUNJIRI	0:0898e006947b	1299	error("Error: LCD Controller type does not support this Display type\n\r");
EDISON_NGUNJIRI	0:0898e006947b	1300	break;
EDISON_NGUNJIRI	0:0898e006947b	1301
EDISON_NGUNJIRI	0:0898e006947b	1302	default:
EDISON_NGUNJIRI	0:0898e006947b	1303	// All other LCD types are initialised as 2 Line displays (including LCD16x1C and LCD40x4)
EDISON_NGUNJIRI	0:0898e006947b	1304	_function = 0x0A; // Function set 001 DL N RE(0) - - (Std Regs)
EDISON_NGUNJIRI	0:0898e006947b	1305	// DL=0 (4 bits bus)
EDISON_NGUNJIRI	0:0898e006947b	1306	// N=1 (2-line mode), N=0 (1-line mode)
EDISON_NGUNJIRI	0:0898e006947b	1307	// RE=0 (Dis. Extended Regs, special mode for HD66712)
EDISON_NGUNJIRI	0:0898e006947b	1308
EDISON_NGUNJIRI	0:0898e006947b	1309	_function_1 = 0x0C; // Function set 001 DL N RE(1) BE LP (Ext Regs)
EDISON_NGUNJIRI	0:0898e006947b	1310	// DL=0 (4 bits bus)
EDISON_NGUNJIRI	0:0898e006947b	1311	// N=1 (2 line mode), N=0 (1-line mode)
EDISON_NGUNJIRI	0:0898e006947b	1312	// RE=1 (Ena Extended Regs, special mode for HD66712)
EDISON_NGUNJIRI	0:0898e006947b	1313	// BE=0 (Blink Enable, CG/SEG RAM, special mode for HD66712)
EDISON_NGUNJIRI	0:0898e006947b	1314	// LP=0 (LP=1 Low power mode, LP=0 Normal)
EDISON_NGUNJIRI	0:0898e006947b	1315
EDISON_NGUNJIRI	0:0898e006947b	1316	_function_x = 0x00; // Ext Function set 0000 1 FW BW NW (Ext Regs)
EDISON_NGUNJIRI	0:0898e006947b	1317	// NW=0 (1,2 line), NW=1 (4 Line, special mode for HD66712)
EDISON_NGUNJIRI	0:0898e006947b	1318	break;
EDISON_NGUNJIRI	0:0898e006947b	1319	} // switch type
EDISON_NGUNJIRI	0:0898e006947b	1320
EDISON_NGUNJIRI	0:0898e006947b	1321	// init special features
EDISON_NGUNJIRI	0:0898e006947b	1322	_writeCommand(0x20 \| _function_1);// Function set 001 DL N RE(1) BE LP (Ext Regs)
EDISON_NGUNJIRI	0:0898e006947b	1323	// DL=0 (4 bits bus), DL=1 (8 bits mode)
EDISON_NGUNJIRI	0:0898e006947b	1324	// N=0 (1 line mode), N=1 (2 line mode)
EDISON_NGUNJIRI	0:0898e006947b	1325	// RE=1 (Ena Extended Regs, special mode for HD66712)
EDISON_NGUNJIRI	0:0898e006947b	1326	// BE=0 (Blink Enable/Disable, CG/SEG RAM, special mode for HD66712)
EDISON_NGUNJIRI	0:0898e006947b	1327	// LP=0 (LP=1 Low power mode, LP=0 Normal)
EDISON_NGUNJIRI	0:0898e006947b	1328
EDISON_NGUNJIRI	0:0898e006947b	1329	_writeCommand(0x08 \| _function_x); // Ext Function set 0000 1 FW BW NW (Ext Regs)
EDISON_NGUNJIRI	0:0898e006947b	1330	// FW=0 (5-dot font, special mode for HD66712)
EDISON_NGUNJIRI	0:0898e006947b	1331	// BW=0 (Cur BW invert disable, special mode for HD66712)
EDISON_NGUNJIRI	0:0898e006947b	1332	// NW=0 (1,2 Line), NW=1 (4 line, special mode for HD66712)
EDISON_NGUNJIRI	0:0898e006947b	1333
EDISON_NGUNJIRI	0:0898e006947b	1334	_writeCommand(0x10); // Scroll/Shift set 0001 HS4 HS3 HS2 HS1 (Ext Regs)
EDISON_NGUNJIRI	0:0898e006947b	1335	// Dotscroll/Display shift enable (Special mode for HD66712)
EDISON_NGUNJIRI	0:0898e006947b	1336
EDISON_NGUNJIRI	0:0898e006947b	1337	_writeCommand(0x80); // Scroll Quantity set 1 0 HDS5 HDS4 HDS3 HDS2 HDS1 HDS0 (Ext Regs)
EDISON_NGUNJIRI	0:0898e006947b	1338	// Scroll quantity (Special mode for HD66712)
EDISON_NGUNJIRI	0:0898e006947b	1339
EDISON_NGUNJIRI	0:0898e006947b	1340	_writeCommand(0x20 \| _function); // Function set 001 DL N RE(0) DH REV (Std Regs)
EDISON_NGUNJIRI	0:0898e006947b	1341	// DL=0 (4 bits bus), DL=1 (8 bits mode)
EDISON_NGUNJIRI	0:0898e006947b	1342	// N=0 (1 line mode), N=1 (2 line mode)
EDISON_NGUNJIRI	0:0898e006947b	1343	// RE=0 (Dis. Extended Regs, special mode for HD66712)
EDISON_NGUNJIRI	0:0898e006947b	1344	// DH=1 (Disp shift enable/disable, special mode for HD66712)
EDISON_NGUNJIRI	0:0898e006947b	1345	// REV=0 (Reverse/Normal, special mode for HD66712)
EDISON_NGUNJIRI	0:0898e006947b	1346	break; // case HD66712 Controller
EDISON_NGUNJIRI	0:0898e006947b	1347
EDISON_NGUNJIRI	0:0898e006947b	1348	case SPLC792A_3V3:
EDISON_NGUNJIRI	0:0898e006947b	1349	// SPLC792A controller: Initialise Voltage booster for VLCD. VDD=3V3
EDISON_NGUNJIRI	0:0898e006947b	1350	// Note very similar to ST7032
EDISON_NGUNJIRI	0:0898e006947b	1351
EDISON_NGUNJIRI	0:0898e006947b	1352	// Initialise Display configuration
EDISON_NGUNJIRI	0:0898e006947b	1353	switch (_type) {
EDISON_NGUNJIRI	0:0898e006947b	1354	case LCD8x1: //8x1 is a regular 1 line display
EDISON_NGUNJIRI	0:0898e006947b	1355	case LCD8x2B: //8x2B is a special case of 16x1
EDISON_NGUNJIRI	0:0898e006947b	1356	// case LCD12x1:
EDISON_NGUNJIRI	0:0898e006947b	1357	case LCD16x1:
EDISON_NGUNJIRI	0:0898e006947b	1358	// case LCD20x1:
EDISON_NGUNJIRI	0:0898e006947b	1359	case LCD24x1:
EDISON_NGUNJIRI	0:0898e006947b	1360	_function = 0x00; // FUNCTION SET 0 0 1 DL=0 (4 bit), N=0 (1-line display mode), F=0 (5*7dot), 0, IS
EDISON_NGUNJIRI	0:0898e006947b	1361	// Note: 4 bit mode is ignored for native SPI and I2C devices
EDISON_NGUNJIRI	0:0898e006947b	1362	// Saved to allow switch between Instruction sets at later time
EDISON_NGUNJIRI	0:0898e006947b	1363	break;
EDISON_NGUNJIRI	0:0898e006947b	1364
EDISON_NGUNJIRI	0:0898e006947b	1365	case LCD12x3D: // Special mode for KS0078 and PCF21XX
EDISON_NGUNJIRI	0:0898e006947b	1366	case LCD12x3D1: // Special mode for KS0078 and PCF21XX
EDISON_NGUNJIRI	0:0898e006947b	1367	case LCD12x4D: // Special mode for KS0078 and PCF21XX
EDISON_NGUNJIRI	0:0898e006947b	1368	case LCD16x3G: // Special mode for ST7036
EDISON_NGUNJIRI	0:0898e006947b	1369	case LCD24x4D: // Special mode for KS0078
EDISON_NGUNJIRI	0:0898e006947b	1370	error("Error: LCD Controller type does not support this Display type\n\r");
EDISON_NGUNJIRI	0:0898e006947b	1371	break;
EDISON_NGUNJIRI	0:0898e006947b	1372
EDISON_NGUNJIRI	0:0898e006947b	1373	default:
EDISON_NGUNJIRI	0:0898e006947b	1374	// All other LCD types are initialised as 2 Line displays
EDISON_NGUNJIRI	0:0898e006947b	1375	_function = 0x08; // FUNCTION SET 0 0 1 DL=0 (4 bit), N=1 (2-line display mode), F=0 (5*7dot), 0, IS
EDISON_NGUNJIRI	0:0898e006947b	1376	// Note: 4 bit mode is ignored for native SPI and I2C devices
EDISON_NGUNJIRI	0:0898e006947b	1377	// Saved to allow switch between Instruction sets at later time
EDISON_NGUNJIRI	0:0898e006947b	1378	break;
EDISON_NGUNJIRI	0:0898e006947b	1379	} // switch type
EDISON_NGUNJIRI	0:0898e006947b	1380
EDISON_NGUNJIRI	0:0898e006947b	1381	// init special features
EDISON_NGUNJIRI	0:0898e006947b	1382	_writeCommand(0x20 \| _function \| 0x01); // Set function, 0 0 1 DL N F 0 IS=1 Select Instr Set = 1
EDISON_NGUNJIRI	0:0898e006947b	1383
EDISON_NGUNJIRI	0:0898e006947b	1384	//SPLC792A Does not support Bias and Internal Osc register
EDISON_NGUNJIRI	0:0898e006947b	1385	// _writeCommand(0x1C); // Internal OSC frequency adjustment Framefreq=183HZ, Bias will be 1/4 (Instr Set=1)
EDISON_NGUNJIRI	0:0898e006947b	1386
EDISON_NGUNJIRI	0:0898e006947b	1387	_contrast = LCD_SPLC792A_CONTRAST;
EDISON_NGUNJIRI	0:0898e006947b	1388	_writeCommand(0x70 \| (_contrast & 0x0F)); // Set Contrast Low bits, 0 1 1 1 C3 C2 C1 C0 (IS=1)
EDISON_NGUNJIRI	0:0898e006947b	1389
EDISON_NGUNJIRI	0:0898e006947b	1390
EDISON_NGUNJIRI	0:0898e006947b	1391	// _icon_power = 0x04; // Icon display off (Bit3=0), Booster circuit is turned on (Bit2=1) (IS=1)
EDISON_NGUNJIRI	0:0898e006947b	1392	_icon_power = 0x0C; // Icon display on (Bit3=1), Booster circuit is turned on (Bit2=1) (IS=1)
EDISON_NGUNJIRI	0:0898e006947b	1393	// Note: Booster circuit always on for SPLC792A, Bit2 is dont care
EDISON_NGUNJIRI	0:0898e006947b	1394	// Saved to allow contrast change at later time
EDISON_NGUNJIRI	0:0898e006947b	1395
EDISON_NGUNJIRI	0:0898e006947b	1396	_writeCommand(0x50 \| _icon_power \| ((_contrast >> 4) & 0x03)); // Set Icon, Booster and Contrast High bits, 0 1 0 1 Ion Bon C5 C4 (IS=1)
EDISON_NGUNJIRI	0:0898e006947b	1397	thread_sleep_for(10); // Wait 10ms to ensure powered up
EDISON_NGUNJIRI	0:0898e006947b	1398
EDISON_NGUNJIRI	0:0898e006947b	1399	_writeCommand(0x68 \| (LCD_SPLC792A_RAB & 0x07)); // Voltage follower, 0 1 1 0 FOn=1, Ampl ratio Rab2=1, Rab1=0, Rab0=0 (IS=1)
EDISON_NGUNJIRI	0:0898e006947b	1400	// Note: Follower circuit always on for SPLC792A, Bit3 is dont care
EDISON_NGUNJIRI	0:0898e006947b	1401	thread_sleep_for(10); // Wait 10ms to ensure powered up
EDISON_NGUNJIRI	0:0898e006947b	1402
EDISON_NGUNJIRI	0:0898e006947b	1403	_writeCommand(0x20 \| _function); // Select Instruction Set = 0
EDISON_NGUNJIRI	0:0898e006947b	1404
EDISON_NGUNJIRI	0:0898e006947b	1405	break; // case SPLC792A_3V3 Controller
EDISON_NGUNJIRI	0:0898e006947b	1406
EDISON_NGUNJIRI	0:0898e006947b	1407	case ST7066_ACM: // ST7066 4/8 bit, I2C on ACM1602 using a PIC
EDISON_NGUNJIRI	0:0898e006947b	1408	default:
EDISON_NGUNJIRI	0:0898e006947b	1409	// Devices fully compatible to HD44780 that do not use any DC/DC Voltage converters but external VLCD, no icons etc
EDISON_NGUNJIRI	0:0898e006947b	1410
EDISON_NGUNJIRI	0:0898e006947b	1411	// Initialise Display configuration
EDISON_NGUNJIRI	0:0898e006947b	1412	switch (_type) {
EDISON_NGUNJIRI	0:0898e006947b	1413	case LCD8x1: //8x1 is a regular 1 line display
EDISON_NGUNJIRI	0:0898e006947b	1414	case LCD8x2B: //8x2B is a special case of 16x1
EDISON_NGUNJIRI	0:0898e006947b	1415	// case LCD12x1:
EDISON_NGUNJIRI	0:0898e006947b	1416	case LCD16x1:
EDISON_NGUNJIRI	0:0898e006947b	1417	// case LCD20x1:
EDISON_NGUNJIRI	0:0898e006947b	1418	case LCD24x1:
EDISON_NGUNJIRI	0:0898e006947b	1419	// case LCD40x1:
EDISON_NGUNJIRI	0:0898e006947b	1420	_function = 0x00; // Function set 001 DL N F - -
EDISON_NGUNJIRI	0:0898e006947b	1421	// DL=0 (4 bits bus)
EDISON_NGUNJIRI	0:0898e006947b	1422	// N=0 (1 line)
EDISON_NGUNJIRI	0:0898e006947b	1423	// F=0 (5x7 dots font)
EDISON_NGUNJIRI	0:0898e006947b	1424	break;
EDISON_NGUNJIRI	0:0898e006947b	1425
EDISON_NGUNJIRI	0:0898e006947b	1426	case LCD12x3D: // Special mode for KS0078 and PCF21XX
EDISON_NGUNJIRI	0:0898e006947b	1427	case LCD12x3D1: // Special mode for KS0078 and PCF21XX
EDISON_NGUNJIRI	0:0898e006947b	1428	case LCD12x4D: // Special mode for KS0078 and PCF21XX:
EDISON_NGUNJIRI	0:0898e006947b	1429	case LCD16x3D: // Special mode for KS0078
EDISON_NGUNJIRI	0:0898e006947b	1430	// case LCD16x3D1: // Special mode for KS0078
EDISON_NGUNJIRI	0:0898e006947b	1431	// case LCD24x3D: // Special mode for KS0078
EDISON_NGUNJIRI	0:0898e006947b	1432	// case LCD24x3D1: // Special mode for KS0078
EDISON_NGUNJIRI	0:0898e006947b	1433	case LCD24x4D: // Special mode for KS0078
EDISON_NGUNJIRI	0:0898e006947b	1434	error("Error: LCD Controller type does not support this Display type\n\r");
EDISON_NGUNJIRI	0:0898e006947b	1435	break;
EDISON_NGUNJIRI	0:0898e006947b	1436
EDISON_NGUNJIRI	0:0898e006947b	1437	// All other LCD types are initialised as 2 Line displays (including LCD16x1C and LCD40x4)
EDISON_NGUNJIRI	0:0898e006947b	1438	default:
EDISON_NGUNJIRI	0:0898e006947b	1439	_function = 0x08; // Function set 001 DL N F - -
EDISON_NGUNJIRI	0:0898e006947b	1440	// DL=0 (4 bits bus)
EDISON_NGUNJIRI	0:0898e006947b	1441	// Note: 4 bit mode is ignored for native SPI and I2C devices
EDISON_NGUNJIRI	0:0898e006947b	1442	// N=1 (2 lines)
EDISON_NGUNJIRI	0:0898e006947b	1443	// F=0 (5x7 dots font, only option for 2 line display)
EDISON_NGUNJIRI	0:0898e006947b	1444	// - (Don't care)
EDISON_NGUNJIRI	0:0898e006947b	1445	break;
EDISON_NGUNJIRI	0:0898e006947b	1446	} // switch type
EDISON_NGUNJIRI	0:0898e006947b	1447
EDISON_NGUNJIRI	0:0898e006947b	1448	_writeCommand(0x20 \| _function);
EDISON_NGUNJIRI	0:0898e006947b	1449	break; // case default Controller
EDISON_NGUNJIRI	0:0898e006947b	1450
EDISON_NGUNJIRI	0:0898e006947b	1451	} // switch Controller specific initialisations
EDISON_NGUNJIRI	0:0898e006947b	1452
EDISON_NGUNJIRI	0:0898e006947b	1453	// Controller general initialisations
EDISON_NGUNJIRI	0:0898e006947b	1454	// _writeCommand(0x01); // Clear Display and set cursor to 0
EDISON_NGUNJIRI	0:0898e006947b	1455	// thread_sleep_for(10); // The CLS command takes 1.64 ms.
EDISON_NGUNJIRI	0:0898e006947b	1456	// // Since we are not using the Busy flag, Lets be safe and take 10 ms
EDISON_NGUNJIRI	0:0898e006947b	1457
EDISON_NGUNJIRI	0:0898e006947b	1458	_writeCommand(0x02); // Cursor Home, DDRAM Address to Origin
EDISON_NGUNJIRI	0:0898e006947b	1459	thread_sleep_for(10); // The Return Home command takes 1.64 ms.
EDISON_NGUNJIRI	0:0898e006947b	1460	// Since we are not using the Busy flag, Lets be safe and take 10 ms
EDISON_NGUNJIRI	0:0898e006947b	1461
EDISON_NGUNJIRI	0:0898e006947b	1462	_writeCommand(0x06); // Entry Mode 0000 0 1 I/D S
EDISON_NGUNJIRI	0:0898e006947b	1463	// Cursor Direction and Display Shift
EDISON_NGUNJIRI	0:0898e006947b	1464	// I/D=1 (Cur incr)
EDISON_NGUNJIRI	0:0898e006947b	1465	// S=0 (No display shift)
EDISON_NGUNJIRI	0:0898e006947b	1466
EDISON_NGUNJIRI	0:0898e006947b	1467	_writeCommand(0x14); // Cursor or Display shift 0001 S/C R/L x x
EDISON_NGUNJIRI	0:0898e006947b	1468	// S/C=0 Cursor moves
EDISON_NGUNJIRI	0:0898e006947b	1469	// R/L=1 Right
EDISON_NGUNJIRI	0:0898e006947b	1470	//
EDISON_NGUNJIRI	0:0898e006947b	1471
EDISON_NGUNJIRI	0:0898e006947b	1472	// _writeCommand(0x0C); // Display Ctrl 0000 1 D C B
EDISON_NGUNJIRI	0:0898e006947b	1473	// // Display On, Cursor Off, Blink Off
EDISON_NGUNJIRI	0:0898e006947b	1474
EDISON_NGUNJIRI	0:0898e006947b	1475	// setCursor(CurOff_BlkOff);
EDISON_NGUNJIRI	0:0898e006947b	1476	setCursor(CurOn_BlkOff);
EDISON_NGUNJIRI	0:0898e006947b	1477	setMode(DispOn);
EDISON_NGUNJIRI	0:0898e006947b	1478	}
EDISON_NGUNJIRI	0:0898e006947b	1479
EDISON_NGUNJIRI	0:0898e006947b	1480
EDISON_NGUNJIRI	0:0898e006947b	1481	/** Clear the screen, Cursor home.
EDISON_NGUNJIRI	0:0898e006947b	1482	* Note: The whole display is initialised to charcode 0x20, which may not be a 'space' on some controllers with a
EDISON_NGUNJIRI	0:0898e006947b	1483	* different fontset such as the PCF2116C or PCF2119R. In this case you should fill the display with 'spaces'.
EDISON_NGUNJIRI	0:0898e006947b	1484	*/
EDISON_NGUNJIRI	0:0898e006947b	1485	void TextLCD_Base::cls() {
EDISON_NGUNJIRI	0:0898e006947b	1486
EDISON_NGUNJIRI	0:0898e006947b	1487	#if (LCD_TWO_CTRL == 1)
EDISON_NGUNJIRI	0:0898e006947b	1488	// Select and configure second LCD controller when needed
EDISON_NGUNJIRI	0:0898e006947b	1489	if(_type==LCD40x4) {
EDISON_NGUNJIRI	0:0898e006947b	1490	_ctrl_idx=_LCDCtrl_1; // Select 2nd controller
EDISON_NGUNJIRI	0:0898e006947b	1491
EDISON_NGUNJIRI	0:0898e006947b	1492	// Second LCD controller Cursor always Off
EDISON_NGUNJIRI	0:0898e006947b	1493	_setCursorAndDisplayMode(_currentMode, CurOff_BlkOff);
EDISON_NGUNJIRI	0:0898e006947b	1494
EDISON_NGUNJIRI	0:0898e006947b	1495	// Second LCD controller Clearscreen
EDISON_NGUNJIRI	0:0898e006947b	1496	_writeCommand(0x01); // cls, and set cursor to 0
EDISON_NGUNJIRI	0:0898e006947b	1497	thread_sleep_for(20); // The CLS command takes 1.64 ms.
EDISON_NGUNJIRI	0:0898e006947b	1498	// Since we are not using the Busy flag, Lets be safe and take 10 ms
EDISON_NGUNJIRI	0:0898e006947b	1499
EDISON_NGUNJIRI	0:0898e006947b	1500	_ctrl_idx=_LCDCtrl_0; // Select primary controller
EDISON_NGUNJIRI	0:0898e006947b	1501	}
EDISON_NGUNJIRI	0:0898e006947b	1502
EDISON_NGUNJIRI	0:0898e006947b	1503
EDISON_NGUNJIRI	0:0898e006947b	1504	// Primary LCD controller Clearscreen
EDISON_NGUNJIRI	0:0898e006947b	1505	_writeCommand(0x01); // cls, and set cursor to 0
EDISON_NGUNJIRI	0:0898e006947b	1506	thread_sleep_for(20); // The CLS command takes 1.64 ms.
EDISON_NGUNJIRI	0:0898e006947b	1507	// Since we are not using the Busy flag, Lets be safe and take 10 ms
EDISON_NGUNJIRI	0:0898e006947b	1508
EDISON_NGUNJIRI	0:0898e006947b	1509	// Restore cursormode on primary LCD controller when needed
EDISON_NGUNJIRI	0:0898e006947b	1510	if(_type==LCD40x4) {
EDISON_NGUNJIRI	0:0898e006947b	1511	_setCursorAndDisplayMode(_currentMode,_currentCursor);
EDISON_NGUNJIRI	0:0898e006947b	1512	}
EDISON_NGUNJIRI	0:0898e006947b	1513
EDISON_NGUNJIRI	0:0898e006947b	1514	#else
EDISON_NGUNJIRI	0:0898e006947b	1515	// Support only one LCD controller
EDISON_NGUNJIRI	0:0898e006947b	1516	_writeCommand(0x01); // cls, and set cursor to 0
EDISON_NGUNJIRI	0:0898e006947b	1517	thread_sleep_for(20); // The CLS command takes 1.64 ms.
EDISON_NGUNJIRI	0:0898e006947b	1518	// Since we are not using the Busy flag, Lets be safe and take 10 ms
EDISON_NGUNJIRI	0:0898e006947b	1519	#endif
EDISON_NGUNJIRI	0:0898e006947b	1520
EDISON_NGUNJIRI	0:0898e006947b	1521	setAddress(0, 0); // Reset Cursor location
EDISON_NGUNJIRI	0:0898e006947b	1522	// Note: This is needed because some displays (eg PCF21XX) don't use line 0 in the '3 Line' mode.
EDISON_NGUNJIRI	0:0898e006947b	1523	}
EDISON_NGUNJIRI	0:0898e006947b	1524
EDISON_NGUNJIRI	0:0898e006947b	1525	/** Locate cursor to a screen column and row
EDISON_NGUNJIRI	0:0898e006947b	1526	*
EDISON_NGUNJIRI	0:0898e006947b	1527	* @param column The horizontal position from the left, indexed from 0
EDISON_NGUNJIRI	0:0898e006947b	1528	* @param row The vertical position from the top, indexed from 0
EDISON_NGUNJIRI	0:0898e006947b	1529	*/
EDISON_NGUNJIRI	0:0898e006947b	1530	void TextLCD_Base::locate(int column, int row) {
EDISON_NGUNJIRI	0:0898e006947b	1531
EDISON_NGUNJIRI	0:0898e006947b	1532	// setAddress() does all the heavy lifting:
EDISON_NGUNJIRI	0:0898e006947b	1533	// check column and row sanity,
EDISON_NGUNJIRI	0:0898e006947b	1534	// switch controllers for LCD40x4 if needed
EDISON_NGUNJIRI	0:0898e006947b	1535	// switch cursor for LCD40x4 if needed
EDISON_NGUNJIRI	0:0898e006947b	1536	// set the new memory address to show cursor at correct location
EDISON_NGUNJIRI	0:0898e006947b	1537	setAddress(column, row);
EDISON_NGUNJIRI	0:0898e006947b	1538	}
EDISON_NGUNJIRI	0:0898e006947b	1539
EDISON_NGUNJIRI	0:0898e006947b	1540
EDISON_NGUNJIRI	0:0898e006947b	1541	/** Write a single character (Stream implementation)
EDISON_NGUNJIRI	0:0898e006947b	1542	*/
EDISON_NGUNJIRI	0:0898e006947b	1543	int TextLCD_Base::_putc(int value) {
EDISON_NGUNJIRI	0:0898e006947b	1544	int addr;
EDISON_NGUNJIRI	0:0898e006947b	1545
EDISON_NGUNJIRI	0:0898e006947b	1546	if (value == '\n') {
EDISON_NGUNJIRI	0:0898e006947b	1547	//No character to write
EDISON_NGUNJIRI	0:0898e006947b	1548
EDISON_NGUNJIRI	0:0898e006947b	1549	//Update Cursor
EDISON_NGUNJIRI	0:0898e006947b	1550	_column = 0;
EDISON_NGUNJIRI	0:0898e006947b	1551	_row++;
EDISON_NGUNJIRI	0:0898e006947b	1552	if (_row >= rows()) {
EDISON_NGUNJIRI	0:0898e006947b	1553	_row = 0;
EDISON_NGUNJIRI	0:0898e006947b	1554	}
EDISON_NGUNJIRI	0:0898e006947b	1555	}
EDISON_NGUNJIRI	0:0898e006947b	1556	else {
EDISON_NGUNJIRI	0:0898e006947b	1557	//Character to write
EDISON_NGUNJIRI	0:0898e006947b	1558
EDISON_NGUNJIRI	0:0898e006947b	1559	#if (LCD_DEF_FONT == 1) //Default HD44780 font
EDISON_NGUNJIRI	0:0898e006947b	1560	_writeData(value);
EDISON_NGUNJIRI	0:0898e006947b	1561	#elif (LCD_C_FONT == 1) \|\| (LCD_R_FONT == 1) //PCF21xxC or PCF21xxR font
EDISON_NGUNJIRI	0:0898e006947b	1562	_writeData(ASCII_2_LCD(value));
EDISON_NGUNJIRI	0:0898e006947b	1563	#elif (LCD_UTF8_FONT == 1) // UTF8 2 byte font (eg Cyrillic)
EDISON_NGUNJIRI	0:0898e006947b	1564	// value = UTF_2_LCD(value, utf_seq_rec_first_cyr, utf_seq_recode_cyr, &utf_rnd_recode_cyr[0][0]);
EDISON_NGUNJIRI	0:0898e006947b	1565	value = UTF_2_LCD(value);
EDISON_NGUNJIRI	0:0898e006947b	1566	if (value >= 0) {
EDISON_NGUNJIRI	0:0898e006947b	1567	_writeData(value);
EDISON_NGUNJIRI	0:0898e006947b	1568
EDISON_NGUNJIRI	0:0898e006947b	1569	// Only increment cursor when there is something to write
EDISON_NGUNJIRI	0:0898e006947b	1570	// Continue below to closing bracket...
EDISON_NGUNJIRI	0:0898e006947b	1571	#else
EDISON_NGUNJIRI	0:0898e006947b	1572	_writeData('?'); //Oops, no font defined
EDISON_NGUNJIRI	0:0898e006947b	1573	#endif
EDISON_NGUNJIRI	0:0898e006947b	1574
EDISON_NGUNJIRI	0:0898e006947b	1575	//Update Cursor
EDISON_NGUNJIRI	0:0898e006947b	1576	_column++;
EDISON_NGUNJIRI	0:0898e006947b	1577	if (_column >= columns()) {
EDISON_NGUNJIRI	0:0898e006947b	1578	_column = 0;
EDISON_NGUNJIRI	0:0898e006947b	1579	_row++;
EDISON_NGUNJIRI	0:0898e006947b	1580	if (_row >= rows()) {
EDISON_NGUNJIRI	0:0898e006947b	1581	_row = 0;
EDISON_NGUNJIRI	0:0898e006947b	1582	}
EDISON_NGUNJIRI	0:0898e006947b	1583	}
EDISON_NGUNJIRI	0:0898e006947b	1584
EDISON_NGUNJIRI	0:0898e006947b	1585	#if (LCD_DEF_FONT == 1) //Default HD44780 font
EDISON_NGUNJIRI	0:0898e006947b	1586
EDISON_NGUNJIRI	0:0898e006947b	1587	#elif (LCD_C_FONT == 1) \|\| (LCD_R_FONT == 1) //PCF21xxC or PCF21xxR font
EDISON_NGUNJIRI	0:0898e006947b	1588
EDISON_NGUNJIRI	0:0898e006947b	1589	#elif (LCD_UTF8_FONT == 1) //UTF8 2 byte font (eg Cyrillic)
EDISON_NGUNJIRI	0:0898e006947b	1590	// Continue code above to close bracket...
EDISON_NGUNJIRI	0:0898e006947b	1591	} // if (value >= 0) {..
EDISON_NGUNJIRI	0:0898e006947b	1592	#else
EDISON_NGUNJIRI	0:0898e006947b	1593
EDISON_NGUNJIRI	0:0898e006947b	1594	#endif
EDISON_NGUNJIRI	0:0898e006947b	1595
EDISON_NGUNJIRI	0:0898e006947b	1596	} //else
EDISON_NGUNJIRI	0:0898e006947b	1597
EDISON_NGUNJIRI	0:0898e006947b	1598	//Set next memoryaddress, make sure cursor blinks at next location
EDISON_NGUNJIRI	0:0898e006947b	1599	addr = getAddress(_column, _row);
EDISON_NGUNJIRI	0:0898e006947b	1600	_writeCommand(0x80 \| addr);
EDISON_NGUNJIRI	0:0898e006947b	1601
EDISON_NGUNJIRI	0:0898e006947b	1602	return value;
EDISON_NGUNJIRI	0:0898e006947b	1603	}
EDISON_NGUNJIRI	0:0898e006947b	1604
EDISON_NGUNJIRI	0:0898e006947b	1605
EDISON_NGUNJIRI	0:0898e006947b	1606	// get a single character (Stream implementation)
EDISON_NGUNJIRI	0:0898e006947b	1607	int TextLCD_Base::_getc() {
EDISON_NGUNJIRI	0:0898e006947b	1608	return -1;
EDISON_NGUNJIRI	0:0898e006947b	1609	}
EDISON_NGUNJIRI	0:0898e006947b	1610
EDISON_NGUNJIRI	0:0898e006947b	1611
EDISON_NGUNJIRI	0:0898e006947b	1612	#if ((LCD_C_FONT == 1) \|\| (LCD_R_FONT == 1)) //PCF21xxC or PCF21xxR font
EDISON_NGUNJIRI	0:0898e006947b	1613	/** Convert ASCII character code to the LCD fonttable code
EDISON_NGUNJIRI	0:0898e006947b	1614	*
EDISON_NGUNJIRI	0:0898e006947b	1615	* @param c The character to write to the display
EDISON_NGUNJIRI	0:0898e006947b	1616	* @return The character code for the specific fonttable of the controller
EDISON_NGUNJIRI	0:0898e006947b	1617	*/
EDISON_NGUNJIRI	0:0898e006947b	1618	int TextLCD_Base::ASCII_2_LCD (int c) {
EDISON_NGUNJIRI	0:0898e006947b	1619
EDISON_NGUNJIRI	0:0898e006947b	1620	//LCD_C_F0 is default for HD44780 and compatible series
EDISON_NGUNJIRI	0:0898e006947b	1621	// if (_font == LCD_C_F0) return c;
EDISON_NGUNJIRI	0:0898e006947b	1622
EDISON_NGUNJIRI	0:0898e006947b	1623	//LCD_C_FC for PCF21XXC series
EDISON_NGUNJIRI	0:0898e006947b	1624	//LCD_C_FR for PCF21XXR series
EDISON_NGUNJIRI	0:0898e006947b	1625	//Used code from Suga koubou library for PCF2119K and PCF2119R
EDISON_NGUNJIRI	0:0898e006947b	1626	if (((c >= ' ') && (c <= '?')) \|\| ((c >= 'A') && (c <= 'Z')) \|\| ((c >= 'a') && (c <= 'z'))) {
EDISON_NGUNJIRI	0:0898e006947b	1627	c \|= 0x80;
EDISON_NGUNJIRI	0:0898e006947b	1628	} else if (c >= 0xF0 && c <= 0xFF) {
EDISON_NGUNJIRI	0:0898e006947b	1629	c &= 0x0F;
EDISON_NGUNJIRI	0:0898e006947b	1630	}
EDISON_NGUNJIRI	0:0898e006947b	1631	return c;
EDISON_NGUNJIRI	0:0898e006947b	1632	}
EDISON_NGUNJIRI	0:0898e006947b	1633	#endif
EDISON_NGUNJIRI	0:0898e006947b	1634
EDISON_NGUNJIRI	0:0898e006947b	1635	#if(LCD_UTF8_FONT == 1)
EDISON_NGUNJIRI	0:0898e006947b	1636
EDISON_NGUNJIRI	0:0898e006947b	1637	/** Convert UTF8 2-byte character code to the LCD fonttable code
EDISON_NGUNJIRI	0:0898e006947b	1638	* @param c The character to write to the display
EDISON_NGUNJIRI	0:0898e006947b	1639	* @return character code for the specific fonttable of the controller or -1 if UTF8 code is not yet complete or incorrect
EDISON_NGUNJIRI	0:0898e006947b	1640	*
EDISON_NGUNJIRI	0:0898e006947b	1641	* Orig by Andriy, Modified by WH
EDISON_NGUNJIRI	0:0898e006947b	1642	*
EDISON_NGUNJIRI	0:0898e006947b	1643	* Note: The UTF8 decoding table for a specific controller is defined and selected in file TextLCD_UTF8.inc
EDISON_NGUNJIRI	0:0898e006947b	1644	* The table is accessed in this UTF_2_LCD() method through
EDISON_NGUNJIRI	0:0898e006947b	1645	* #define UTF_FIRST, UTF_LAST, UTF_SEQ_REC_FIRST, UTF_SEQ_REC_LAST and
EDISON_NGUNJIRI	0:0898e006947b	1646	* #define UTF_SEQ_RECODE and UTF_RND_RECODE
EDISON_NGUNJIRI	0:0898e006947b	1647	*/
EDISON_NGUNJIRI	0:0898e006947b	1648	int TextLCD_Base::UTF_2_LCD (int c) {
EDISON_NGUNJIRI	0:0898e006947b	1649	int utf_code;
EDISON_NGUNJIRI	0:0898e006947b	1650	int utf_low_byte; // Low byte UTF8
EDISON_NGUNJIRI	0:0898e006947b	1651	static int utf_hi_byte = 0; // High byte UTF8
EDISON_NGUNJIRI	0:0898e006947b	1652
EDISON_NGUNJIRI	0:0898e006947b	1653	if (c < 0x80) { // Regular ASCII code, no need to convert
EDISON_NGUNJIRI	0:0898e006947b	1654	return c;
EDISON_NGUNJIRI	0:0898e006947b	1655	}
EDISON_NGUNJIRI	0:0898e006947b	1656	else { // UTF8 handling, See wikipedia.org/wiki/UTF-8 and www.utf8-chartable.de
EDISON_NGUNJIRI	0:0898e006947b	1657	// printf("0x%X ", c);
EDISON_NGUNJIRI	0:0898e006947b	1658
EDISON_NGUNJIRI	0:0898e006947b	1659	if (c >= 0xC0) { // First UTF8 byte should be formatted as 110b bbaa, Do sanity check
EDISON_NGUNJIRI	0:0898e006947b	1660	utf_hi_byte = c & 0x1F; // Mask out significant bits (0x1F) and save high byte
EDISON_NGUNJIRI	0:0898e006947b	1661	return -1; // Nothing to display as yet, wait for second UTF8 byte
EDISON_NGUNJIRI	0:0898e006947b	1662	}
EDISON_NGUNJIRI	0:0898e006947b	1663
EDISON_NGUNJIRI	0:0898e006947b	1664	if (c <= 0xBF) { // Second UTF8 byte should be formatted as 10aa aaaa, Do sanity check
EDISON_NGUNJIRI	0:0898e006947b	1665	utf_low_byte = c & 0x3F; // Mask out significant bits (0x3F)
EDISON_NGUNJIRI	0:0898e006947b	1666
EDISON_NGUNJIRI	0:0898e006947b	1667	// Compose UTF character code from UTF8 bytes. The UTF codes will be between U+0080 and U+07FF
EDISON_NGUNJIRI	0:0898e006947b	1668	utf_code = (utf_hi_byte << 6) \| utf_low_byte; // 00000bbb aaaaaaaa
EDISON_NGUNJIRI	0:0898e006947b	1669	// printf("0x%4X ", utf_code);
EDISON_NGUNJIRI	0:0898e006947b	1670
EDISON_NGUNJIRI	0:0898e006947b	1671	// Sanity check on UTF codes
EDISON_NGUNJIRI	0:0898e006947b	1672	// For example Cyrillic characters are UTF encoded between 0x0400 and 0x04FF
EDISON_NGUNJIRI	0:0898e006947b	1673	if ((utf_code < UTF_FIRST) \|\| (utf_code > UTF_LAST)) {
EDISON_NGUNJIRI	0:0898e006947b	1674	return -1; // Invalid UTF8 code
EDISON_NGUNJIRI	0:0898e006947b	1675	};
EDISON_NGUNJIRI	0:0898e006947b	1676
EDISON_NGUNJIRI	0:0898e006947b	1677	//Map some specific UTF codes on a character in LCD fonttable using a special correcting lookup table
EDISON_NGUNJIRI	0:0898e006947b	1678	for (char i=0; UTF_RND_RECODE[i][0]; i++) { // Step through table until endvalue 0 is found or until a match is found
EDISON_NGUNJIRI	0:0898e006947b	1679	if (utf_code == UTF_RND_RECODE[i][0]) { // UTF8 code match is found
EDISON_NGUNJIRI	0:0898e006947b	1680	c = UTF_RND_RECODE[1][1];
EDISON_NGUNJIRI	0:0898e006947b	1681	return c; // found match in correcting random table
EDISON_NGUNJIRI	0:0898e006947b	1682	}
EDISON_NGUNJIRI	0:0898e006947b	1683	}
EDISON_NGUNJIRI	0:0898e006947b	1684
EDISON_NGUNJIRI	0:0898e006947b	1685	//Sanity check on table idx range
EDISON_NGUNJIRI	0:0898e006947b	1686	if ((utf_code < UTF_SEQ_REC_FIRST) \|\| (utf_code > UTF_SEQ_REC_LAST)) {
EDISON_NGUNJIRI	0:0898e006947b	1687	return -1; // Invalid UTF8 code
EDISON_NGUNJIRI	0:0898e006947b	1688	};
EDISON_NGUNJIRI	0:0898e006947b	1689
EDISON_NGUNJIRI	0:0898e006947b	1690	//Map all other UTF codes on a character in LCD fonttable using a sequential lookup table
EDISON_NGUNJIRI	0:0898e006947b	1691	c = UTF_SEQ_RECODE[utf_code - UTF_SEQ_REC_FIRST];
EDISON_NGUNJIRI	0:0898e006947b	1692	return c; // entry in sequential table
EDISON_NGUNJIRI	0:0898e006947b	1693	}
EDISON_NGUNJIRI	0:0898e006947b	1694	else {
EDISON_NGUNJIRI	0:0898e006947b	1695	return -1; // Invalid UTF8 code for second byte
EDISON_NGUNJIRI	0:0898e006947b	1696	}
EDISON_NGUNJIRI	0:0898e006947b	1697	} // End UTF8 handling
EDISON_NGUNJIRI	0:0898e006947b	1698	}
EDISON_NGUNJIRI	0:0898e006947b	1699
EDISON_NGUNJIRI	0:0898e006947b	1700	#endif
EDISON_NGUNJIRI	0:0898e006947b	1701
EDISON_NGUNJIRI	0:0898e006947b	1702
EDISON_NGUNJIRI	0:0898e006947b	1703	#if(LCD_PRINTF != 1)
EDISON_NGUNJIRI	0:0898e006947b	1704	/** Write a character to the LCD
EDISON_NGUNJIRI	0:0898e006947b	1705	*
EDISON_NGUNJIRI	0:0898e006947b	1706	* @param c The character to write to the display
EDISON_NGUNJIRI	0:0898e006947b	1707	*/
EDISON_NGUNJIRI	0:0898e006947b	1708	int TextLCD_Base::putc(int c){
EDISON_NGUNJIRI	0:0898e006947b	1709	return _putc(c);
EDISON_NGUNJIRI	0:0898e006947b	1710	}
EDISON_NGUNJIRI	0:0898e006947b	1711
EDISON_NGUNJIRI	0:0898e006947b	1712
EDISON_NGUNJIRI	0:0898e006947b	1713	/** Write a raw string to the LCD
EDISON_NGUNJIRI	0:0898e006947b	1714	*
EDISON_NGUNJIRI	0:0898e006947b	1715	* @param string text, may be followed by variables to emulate formatting the string.
EDISON_NGUNJIRI	0:0898e006947b	1716	* However, printf formatting is NOT supported and variables will be ignored!
EDISON_NGUNJIRI	0:0898e006947b	1717	*/
EDISON_NGUNJIRI	0:0898e006947b	1718	int TextLCD_Base::printf(const char* text, ...) {
EDISON_NGUNJIRI	0:0898e006947b	1719
EDISON_NGUNJIRI	0:0898e006947b	1720	while (*text !=0) {
EDISON_NGUNJIRI	0:0898e006947b	1721	_putc(*text);
EDISON_NGUNJIRI	0:0898e006947b	1722	text++;
EDISON_NGUNJIRI	0:0898e006947b	1723	}
EDISON_NGUNJIRI	0:0898e006947b	1724	return 0;
EDISON_NGUNJIRI	0:0898e006947b	1725	}
EDISON_NGUNJIRI	0:0898e006947b	1726	#endif
EDISON_NGUNJIRI	0:0898e006947b	1727
EDISON_NGUNJIRI	0:0898e006947b	1728
EDISON_NGUNJIRI	0:0898e006947b	1729	// Write a nibble using the 4-bit interface
EDISON_NGUNJIRI	0:0898e006947b	1730	void TextLCD_Base::_writeNibble(int value) {
EDISON_NGUNJIRI	0:0898e006947b	1731
EDISON_NGUNJIRI	0:0898e006947b	1732	// Enable is Low
EDISON_NGUNJIRI	0:0898e006947b	1733	this->_setEnable(true);
EDISON_NGUNJIRI	0:0898e006947b	1734	this->_setData(value); // Low nibble of value on D4..D7
EDISON_NGUNJIRI	0:0898e006947b	1735	wait_us(1); // Data setup time
EDISON_NGUNJIRI	0:0898e006947b	1736	this->_setEnable(false);
EDISON_NGUNJIRI	0:0898e006947b	1737	wait_us(1); // Datahold time
EDISON_NGUNJIRI	0:0898e006947b	1738	// Enable is Low
EDISON_NGUNJIRI	0:0898e006947b	1739	}
EDISON_NGUNJIRI	0:0898e006947b	1740
EDISON_NGUNJIRI	0:0898e006947b	1741	// Write a byte using the 4-bit interface
EDISON_NGUNJIRI	0:0898e006947b	1742	void TextLCD_Base::_writeByte(int value) {
EDISON_NGUNJIRI	0:0898e006947b	1743
EDISON_NGUNJIRI	0:0898e006947b	1744	// Enable is Low
EDISON_NGUNJIRI	0:0898e006947b	1745	this->_setEnable(true);
EDISON_NGUNJIRI	0:0898e006947b	1746	this->_setData(value >> 4); // High nibble
EDISON_NGUNJIRI	0:0898e006947b	1747	wait_us(1); // Data setup time
EDISON_NGUNJIRI	0:0898e006947b	1748	this->_setEnable(false);
EDISON_NGUNJIRI	0:0898e006947b	1749	wait_us(1); // Data hold time
EDISON_NGUNJIRI	0:0898e006947b	1750
EDISON_NGUNJIRI	0:0898e006947b	1751	this->_setEnable(true);
EDISON_NGUNJIRI	0:0898e006947b	1752	this->_setData(value); // Low nibble
EDISON_NGUNJIRI	0:0898e006947b	1753	wait_us(1); // Data setup time
EDISON_NGUNJIRI	0:0898e006947b	1754	this->_setEnable(false);
EDISON_NGUNJIRI	0:0898e006947b	1755	wait_us(1); // Datahold time
EDISON_NGUNJIRI	0:0898e006947b	1756
EDISON_NGUNJIRI	0:0898e006947b	1757	// Enable is Low
EDISON_NGUNJIRI	0:0898e006947b	1758	}
EDISON_NGUNJIRI	0:0898e006947b	1759
EDISON_NGUNJIRI	0:0898e006947b	1760	// Write a command byte to the LCD controller
EDISON_NGUNJIRI	0:0898e006947b	1761	void TextLCD_Base::_writeCommand(int command) {
EDISON_NGUNJIRI	0:0898e006947b	1762
EDISON_NGUNJIRI	0:0898e006947b	1763	this->_setRS(false);
EDISON_NGUNJIRI	0:0898e006947b	1764	wait_us(1); // Data setup time for RS
EDISON_NGUNJIRI	0:0898e006947b	1765
EDISON_NGUNJIRI	0:0898e006947b	1766	this->_writeByte(command);
EDISON_NGUNJIRI	0:0898e006947b	1767	wait_us(40); // most instructions take 40us
EDISON_NGUNJIRI	0:0898e006947b	1768	}
EDISON_NGUNJIRI	0:0898e006947b	1769
EDISON_NGUNJIRI	0:0898e006947b	1770	// Write a data byte to the LCD controller
EDISON_NGUNJIRI	0:0898e006947b	1771	void TextLCD_Base::_writeData(int data) {
EDISON_NGUNJIRI	0:0898e006947b	1772
EDISON_NGUNJIRI	0:0898e006947b	1773	this->_setRS(true);
EDISON_NGUNJIRI	0:0898e006947b	1774	wait_us(1); // Data setup time for RS
EDISON_NGUNJIRI	0:0898e006947b	1775
EDISON_NGUNJIRI	0:0898e006947b	1776	this->_writeByte(data);
EDISON_NGUNJIRI	0:0898e006947b	1777	wait_us(40); // data writes take 40us
EDISON_NGUNJIRI	0:0898e006947b	1778	}
EDISON_NGUNJIRI	0:0898e006947b	1779
EDISON_NGUNJIRI	0:0898e006947b	1780
EDISON_NGUNJIRI	0:0898e006947b	1781	// This replaces the original _address() method.
EDISON_NGUNJIRI	0:0898e006947b	1782	// It is confusing since it returns the memoryaddress or-ed with the set memorycommand 0x80.
EDISON_NGUNJIRI	0:0898e006947b	1783	// Left it in here for compatibility with older code. New applications should use getAddress() instead.
EDISON_NGUNJIRI	0:0898e006947b	1784	int TextLCD_Base::_address(int column, int row) {
EDISON_NGUNJIRI	0:0898e006947b	1785	return 0x80 \| getAddress(column, row);
EDISON_NGUNJIRI	0:0898e006947b	1786	}
EDISON_NGUNJIRI	0:0898e006947b	1787
EDISON_NGUNJIRI	0:0898e006947b	1788
EDISON_NGUNJIRI	0:0898e006947b	1789	// This is new method to return the memory address based on row, column and displaytype.
EDISON_NGUNJIRI	0:0898e006947b	1790	//
EDISON_NGUNJIRI	0:0898e006947b	1791	/** Return the memoryaddress of screen column and row location
EDISON_NGUNJIRI	0:0898e006947b	1792	*
EDISON_NGUNJIRI	0:0898e006947b	1793	* @param column The horizontal position from the left, indexed from 0
EDISON_NGUNJIRI	0:0898e006947b	1794	* @param row The vertical position from the top, indexed from 0
EDISON_NGUNJIRI	0:0898e006947b	1795	* @return The memoryaddress of screen column and row location
EDISON_NGUNJIRI	0:0898e006947b	1796	*
EDISON_NGUNJIRI	0:0898e006947b	1797	*/
EDISON_NGUNJIRI	0:0898e006947b	1798	int TextLCD_Base::getAddress(int column, int row) {
EDISON_NGUNJIRI	0:0898e006947b	1799
EDISON_NGUNJIRI	0:0898e006947b	1800	switch (_addr_mode) {
EDISON_NGUNJIRI	0:0898e006947b	1801
EDISON_NGUNJIRI	0:0898e006947b	1802	case LCD_T_A:
EDISON_NGUNJIRI	0:0898e006947b	1803	//Default addressing mode for 1, 2 and 4 rows (except 40x4)
EDISON_NGUNJIRI	0:0898e006947b	1804	//The two available rows are split and stacked on top of eachother. Addressing for 3rd and 4th line continues where lines 1 and 2 were split.
EDISON_NGUNJIRI	0:0898e006947b	1805	//Displays top rows when less than four are used.
EDISON_NGUNJIRI	0:0898e006947b	1806	switch (row) {
EDISON_NGUNJIRI	0:0898e006947b	1807	case 0:
EDISON_NGUNJIRI	0:0898e006947b	1808	return 0x00 + column;
EDISON_NGUNJIRI	0:0898e006947b	1809	case 1:
EDISON_NGUNJIRI	0:0898e006947b	1810	return 0x40 + column;
EDISON_NGUNJIRI	0:0898e006947b	1811	case 2:
EDISON_NGUNJIRI	0:0898e006947b	1812	return 0x00 + _nr_cols + column;
EDISON_NGUNJIRI	0:0898e006947b	1813	case 3:
EDISON_NGUNJIRI	0:0898e006947b	1814	return 0x40 + _nr_cols + column;
EDISON_NGUNJIRI	0:0898e006947b	1815	// Should never get here.
EDISON_NGUNJIRI	0:0898e006947b	1816	// default:
EDISON_NGUNJIRI	0:0898e006947b	1817	// return 0x00;
EDISON_NGUNJIRI	0:0898e006947b	1818	}
EDISON_NGUNJIRI	0:0898e006947b	1819
EDISON_NGUNJIRI	0:0898e006947b	1820	case LCD_T_B:
EDISON_NGUNJIRI	0:0898e006947b	1821	// LCD8x2B is a special layout of LCD16x1
EDISON_NGUNJIRI	0:0898e006947b	1822	if (row==0)
EDISON_NGUNJIRI	0:0898e006947b	1823	return 0x00 + column;
EDISON_NGUNJIRI	0:0898e006947b	1824	else
EDISON_NGUNJIRI	0:0898e006947b	1825	// return _nr_cols + column;
EDISON_NGUNJIRI	0:0898e006947b	1826	return 0x08 + column;
EDISON_NGUNJIRI	0:0898e006947b	1827
EDISON_NGUNJIRI	0:0898e006947b	1828	case LCD_T_C:
EDISON_NGUNJIRI	0:0898e006947b	1829	// LCD16x1C is a special layout of LCD8x2
EDISON_NGUNJIRI	0:0898e006947b	1830	// LCD32x1C is a special layout of LCD16x2
EDISON_NGUNJIRI	0:0898e006947b	1831	// LCD40x1C is a special layout of LCD20x2
EDISON_NGUNJIRI	0:0898e006947b	1832	#if(0)
EDISON_NGUNJIRI	0:0898e006947b	1833	if (column < 8)
EDISON_NGUNJIRI	0:0898e006947b	1834	return 0x00 + column;
EDISON_NGUNJIRI	0:0898e006947b	1835	else
EDISON_NGUNJIRI	0:0898e006947b	1836	return 0x40 + (column - 8);
EDISON_NGUNJIRI	0:0898e006947b	1837	#else
EDISON_NGUNJIRI	0:0898e006947b	1838	if (column < (_nr_cols >> 1))
EDISON_NGUNJIRI	0:0898e006947b	1839	return 0x00 + column;
EDISON_NGUNJIRI	0:0898e006947b	1840	else
EDISON_NGUNJIRI	0:0898e006947b	1841	return 0x40 + (column - (_nr_cols >> 1));
EDISON_NGUNJIRI	0:0898e006947b	1842	#endif
EDISON_NGUNJIRI	0:0898e006947b	1843
EDISON_NGUNJIRI	0:0898e006947b	1844	case LCD_T_D:
EDISON_NGUNJIRI	0:0898e006947b	1845	//Alternate addressing mode for 3 and 4 row displays (except 40x4). Used by PCF21XX, KS0073, KS0078, SSD1803
EDISON_NGUNJIRI	0:0898e006947b	1846	//The 4 available rows start at a hardcoded address.
EDISON_NGUNJIRI	0:0898e006947b	1847	//Displays top rows when less than four are used.
EDISON_NGUNJIRI	0:0898e006947b	1848	switch (row) {
EDISON_NGUNJIRI	0:0898e006947b	1849	case 0:
EDISON_NGUNJIRI	0:0898e006947b	1850	return 0x00 + column;
EDISON_NGUNJIRI	0:0898e006947b	1851	case 1:
EDISON_NGUNJIRI	0:0898e006947b	1852	return 0x20 + column;
EDISON_NGUNJIRI	0:0898e006947b	1853	case 2:
EDISON_NGUNJIRI	0:0898e006947b	1854	return 0x40 + column;
EDISON_NGUNJIRI	0:0898e006947b	1855	case 3:
EDISON_NGUNJIRI	0:0898e006947b	1856	return 0x60 + column;
EDISON_NGUNJIRI	0:0898e006947b	1857	// Should never get here.
EDISON_NGUNJIRI	0:0898e006947b	1858	// default:
EDISON_NGUNJIRI	0:0898e006947b	1859	// return 0x00;
EDISON_NGUNJIRI	0:0898e006947b	1860	}
EDISON_NGUNJIRI	0:0898e006947b	1861
EDISON_NGUNJIRI	0:0898e006947b	1862	case LCD_T_D1:
EDISON_NGUNJIRI	0:0898e006947b	1863	//Alternate addressing mode for 3 row displays. Used by PCF21XX, KS0073, KS0078, SSD1803
EDISON_NGUNJIRI	0:0898e006947b	1864	//The 4 available rows start at a hardcoded address.
EDISON_NGUNJIRI	0:0898e006947b	1865	//Skips top row of 4 row display and starts display at row 1
EDISON_NGUNJIRI	0:0898e006947b	1866	switch (row) {
EDISON_NGUNJIRI	0:0898e006947b	1867	case 0:
EDISON_NGUNJIRI	0:0898e006947b	1868	return 0x20 + column;
EDISON_NGUNJIRI	0:0898e006947b	1869	case 1:
EDISON_NGUNJIRI	0:0898e006947b	1870	return 0x40 + column;
EDISON_NGUNJIRI	0:0898e006947b	1871	case 2:
EDISON_NGUNJIRI	0:0898e006947b	1872	return 0x60 + column;
EDISON_NGUNJIRI	0:0898e006947b	1873	// Should never get here.
EDISON_NGUNJIRI	0:0898e006947b	1874	// default:
EDISON_NGUNJIRI	0:0898e006947b	1875	// return 0x00;
EDISON_NGUNJIRI	0:0898e006947b	1876	}
EDISON_NGUNJIRI	0:0898e006947b	1877
EDISON_NGUNJIRI	0:0898e006947b	1878	case LCD_T_E:
EDISON_NGUNJIRI	0:0898e006947b	1879	// LCD40x4 is a special case since it has 2 controllers.
EDISON_NGUNJIRI	0:0898e006947b	1880	// Each controller is configured as 40x2 (Type A)
EDISON_NGUNJIRI	0:0898e006947b	1881	if (row<2) {
EDISON_NGUNJIRI	0:0898e006947b	1882	// Test to see if we need to switch between controllers
EDISON_NGUNJIRI	0:0898e006947b	1883	if (_ctrl_idx != _LCDCtrl_0) {
EDISON_NGUNJIRI	0:0898e006947b	1884
EDISON_NGUNJIRI	0:0898e006947b	1885	// Second LCD controller Cursor Off
EDISON_NGUNJIRI	0:0898e006947b	1886	_setCursorAndDisplayMode(_currentMode, CurOff_BlkOff);
EDISON_NGUNJIRI	0:0898e006947b	1887
EDISON_NGUNJIRI	0:0898e006947b	1888	// Select primary controller
EDISON_NGUNJIRI	0:0898e006947b	1889	_ctrl_idx = _LCDCtrl_0;
EDISON_NGUNJIRI	0:0898e006947b	1890
EDISON_NGUNJIRI	0:0898e006947b	1891	// Restore cursormode on primary LCD controller
EDISON_NGUNJIRI	0:0898e006947b	1892	_setCursorAndDisplayMode(_currentMode, _currentCursor);
EDISON_NGUNJIRI	0:0898e006947b	1893	}
EDISON_NGUNJIRI	0:0898e006947b	1894
EDISON_NGUNJIRI	0:0898e006947b	1895	return 0x00 + (row * 0x40) + column;
EDISON_NGUNJIRI	0:0898e006947b	1896	}
EDISON_NGUNJIRI	0:0898e006947b	1897	else {
EDISON_NGUNJIRI	0:0898e006947b	1898
EDISON_NGUNJIRI	0:0898e006947b	1899	// Test to see if we need to switch between controllers
EDISON_NGUNJIRI	0:0898e006947b	1900	if (_ctrl_idx != _LCDCtrl_1) {
EDISON_NGUNJIRI	0:0898e006947b	1901	// Primary LCD controller Cursor Off
EDISON_NGUNJIRI	0:0898e006947b	1902	_setCursorAndDisplayMode(_currentMode, CurOff_BlkOff);
EDISON_NGUNJIRI	0:0898e006947b	1903
EDISON_NGUNJIRI	0:0898e006947b	1904	// Select secondary controller
EDISON_NGUNJIRI	0:0898e006947b	1905	_ctrl_idx = _LCDCtrl_1;
EDISON_NGUNJIRI	0:0898e006947b	1906
EDISON_NGUNJIRI	0:0898e006947b	1907	// Restore cursormode on secondary LCD controller
EDISON_NGUNJIRI	0:0898e006947b	1908	_setCursorAndDisplayMode(_currentMode, _currentCursor);
EDISON_NGUNJIRI	0:0898e006947b	1909	}
EDISON_NGUNJIRI	0:0898e006947b	1910
EDISON_NGUNJIRI	0:0898e006947b	1911	return 0x00 + ((row-2) * 0x40) + column;
EDISON_NGUNJIRI	0:0898e006947b	1912	}
EDISON_NGUNJIRI	0:0898e006947b	1913
EDISON_NGUNJIRI	0:0898e006947b	1914	case LCD_T_F:
EDISON_NGUNJIRI	0:0898e006947b	1915	//Alternate addressing mode for 3 row displays.
EDISON_NGUNJIRI	0:0898e006947b	1916	//The first half of 3rd row continues from 1st row, the second half continues from 2nd row.
EDISON_NGUNJIRI	0:0898e006947b	1917	switch (row) {
EDISON_NGUNJIRI	0:0898e006947b	1918	case 0:
EDISON_NGUNJIRI	0:0898e006947b	1919	return 0x00 + column;
EDISON_NGUNJIRI	0:0898e006947b	1920	case 1:
EDISON_NGUNJIRI	0:0898e006947b	1921	return 0x40 + column;
EDISON_NGUNJIRI	0:0898e006947b	1922	case 2:
EDISON_NGUNJIRI	0:0898e006947b	1923	if (column < (_nr_cols >> 1)) // check first or second half of line
EDISON_NGUNJIRI	0:0898e006947b	1924	return (0x00 + _nr_cols + column);
EDISON_NGUNJIRI	0:0898e006947b	1925	else
EDISON_NGUNJIRI	0:0898e006947b	1926	return (0x40 + _nr_cols + (column - (_nr_cols >> 1)));
EDISON_NGUNJIRI	0:0898e006947b	1927	// Should never get here.
EDISON_NGUNJIRI	0:0898e006947b	1928	// default:
EDISON_NGUNJIRI	0:0898e006947b	1929	// return 0x00;
EDISON_NGUNJIRI	0:0898e006947b	1930	}
EDISON_NGUNJIRI	0:0898e006947b	1931
EDISON_NGUNJIRI	0:0898e006947b	1932	case LCD_T_G:
EDISON_NGUNJIRI	0:0898e006947b	1933	//Alternate addressing mode for 3 row displays. Used by ST7036
EDISON_NGUNJIRI	0:0898e006947b	1934	switch (row) {
EDISON_NGUNJIRI	0:0898e006947b	1935	case 0:
EDISON_NGUNJIRI	0:0898e006947b	1936	return 0x00 + column;
EDISON_NGUNJIRI	0:0898e006947b	1937	case 1:
EDISON_NGUNJIRI	0:0898e006947b	1938	return 0x10 + column;
EDISON_NGUNJIRI	0:0898e006947b	1939	case 2:
EDISON_NGUNJIRI	0:0898e006947b	1940	return 0x20 + column;
EDISON_NGUNJIRI	0:0898e006947b	1941	// Should never get here.
EDISON_NGUNJIRI	0:0898e006947b	1942	// default:
EDISON_NGUNJIRI	0:0898e006947b	1943	// return 0x00;
EDISON_NGUNJIRI	0:0898e006947b	1944	}
EDISON_NGUNJIRI	0:0898e006947b	1945
EDISON_NGUNJIRI	0:0898e006947b	1946	// Should never get here.
EDISON_NGUNJIRI	0:0898e006947b	1947	default:
EDISON_NGUNJIRI	0:0898e006947b	1948	return 0x00;
EDISON_NGUNJIRI	0:0898e006947b	1949
EDISON_NGUNJIRI	0:0898e006947b	1950	} // switch _addr_mode
EDISON_NGUNJIRI	0:0898e006947b	1951	}
EDISON_NGUNJIRI	0:0898e006947b	1952
EDISON_NGUNJIRI	0:0898e006947b	1953
EDISON_NGUNJIRI	0:0898e006947b	1954	/** Set the memoryaddress of screen column and row location
EDISON_NGUNJIRI	0:0898e006947b	1955	*
EDISON_NGUNJIRI	0:0898e006947b	1956	* @param column The horizontal position from the left, indexed from 0
EDISON_NGUNJIRI	0:0898e006947b	1957	* @param row The vertical position from the top, indexed from 0
EDISON_NGUNJIRI	0:0898e006947b	1958	*/
EDISON_NGUNJIRI	0:0898e006947b	1959	void TextLCD_Base::setAddress(int column, int row) {
EDISON_NGUNJIRI	0:0898e006947b	1960
EDISON_NGUNJIRI	0:0898e006947b	1961	// Sanity Check column
EDISON_NGUNJIRI	0:0898e006947b	1962	if (column < 0) {
EDISON_NGUNJIRI	0:0898e006947b	1963	_column = 0;
EDISON_NGUNJIRI	0:0898e006947b	1964	}
EDISON_NGUNJIRI	0:0898e006947b	1965	else if (column >= _nr_cols) {
EDISON_NGUNJIRI	0:0898e006947b	1966	_column = _nr_cols - 1;
EDISON_NGUNJIRI	0:0898e006947b	1967	} else _column = column;
EDISON_NGUNJIRI	0:0898e006947b	1968
EDISON_NGUNJIRI	0:0898e006947b	1969	// Sanity Check row
EDISON_NGUNJIRI	0:0898e006947b	1970	if (row < 0) {
EDISON_NGUNJIRI	0:0898e006947b	1971	_row = 0;
EDISON_NGUNJIRI	0:0898e006947b	1972	}
EDISON_NGUNJIRI	0:0898e006947b	1973	else if (row >= _nr_rows) {
EDISON_NGUNJIRI	0:0898e006947b	1974	_row = _nr_rows - 1;
EDISON_NGUNJIRI	0:0898e006947b	1975	} else _row = row;
EDISON_NGUNJIRI	0:0898e006947b	1976
EDISON_NGUNJIRI	0:0898e006947b	1977
EDISON_NGUNJIRI	0:0898e006947b	1978	// Compute the memory address
EDISON_NGUNJIRI	0:0898e006947b	1979	// For LCD40x4: switch controllers if needed
EDISON_NGUNJIRI	0:0898e006947b	1980	// switch cursor if needed
EDISON_NGUNJIRI	0:0898e006947b	1981	int addr = getAddress(_column, _row);
EDISON_NGUNJIRI	0:0898e006947b	1982
EDISON_NGUNJIRI	0:0898e006947b	1983	_writeCommand(0x80 \| addr);
EDISON_NGUNJIRI	0:0898e006947b	1984	}
EDISON_NGUNJIRI	0:0898e006947b	1985
EDISON_NGUNJIRI	0:0898e006947b	1986
EDISON_NGUNJIRI	0:0898e006947b	1987	/** Return the number of columns
EDISON_NGUNJIRI	0:0898e006947b	1988	*
EDISON_NGUNJIRI	0:0898e006947b	1989	* @return The number of columns
EDISON_NGUNJIRI	0:0898e006947b	1990	*
EDISON_NGUNJIRI	0:0898e006947b	1991	* Note: some configurations are commented out because they have not yet been tested due to lack of hardware
EDISON_NGUNJIRI	0:0898e006947b	1992	*/
EDISON_NGUNJIRI	0:0898e006947b	1993	int TextLCD_Base::columns() {
EDISON_NGUNJIRI	0:0898e006947b	1994
EDISON_NGUNJIRI	0:0898e006947b	1995	// Columns encoded in b7..b0
EDISON_NGUNJIRI	0:0898e006947b	1996	//return (_type & 0xFF);
EDISON_NGUNJIRI	0:0898e006947b	1997	return _nr_cols;
EDISON_NGUNJIRI	0:0898e006947b	1998	}
EDISON_NGUNJIRI	0:0898e006947b	1999
EDISON_NGUNJIRI	0:0898e006947b	2000	/** Return the number of rows
EDISON_NGUNJIRI	0:0898e006947b	2001	*
EDISON_NGUNJIRI	0:0898e006947b	2002	* @return The number of rows
EDISON_NGUNJIRI	0:0898e006947b	2003	*
EDISON_NGUNJIRI	0:0898e006947b	2004	* Note: some configurations are commented out because they have not yet been tested due to lack of hardware
EDISON_NGUNJIRI	0:0898e006947b	2005	*/
EDISON_NGUNJIRI	0:0898e006947b	2006	int TextLCD_Base::rows() {
EDISON_NGUNJIRI	0:0898e006947b	2007
EDISON_NGUNJIRI	0:0898e006947b	2008	// Rows encoded in b15..b8
EDISON_NGUNJIRI	0:0898e006947b	2009	//return ((_type >> 8) & 0xFF);
EDISON_NGUNJIRI	0:0898e006947b	2010	return _nr_rows;
EDISON_NGUNJIRI	0:0898e006947b	2011	}
EDISON_NGUNJIRI	0:0898e006947b	2012
EDISON_NGUNJIRI	0:0898e006947b	2013	/** Set the Cursormode
EDISON_NGUNJIRI	0:0898e006947b	2014	*
EDISON_NGUNJIRI	0:0898e006947b	2015	* @param cursorMode The Cursor mode (CurOff_BlkOff, CurOn_BlkOff, CurOff_BlkOn, CurOn_BlkOn)
EDISON_NGUNJIRI	0:0898e006947b	2016	*/
EDISON_NGUNJIRI	0:0898e006947b	2017	void TextLCD_Base::setCursor(LCDCursor cursorMode) {
EDISON_NGUNJIRI	0:0898e006947b	2018
EDISON_NGUNJIRI	0:0898e006947b	2019	// Save new cursor mode, needed when 2 controllers are in use or when display is switched off/on
EDISON_NGUNJIRI	0:0898e006947b	2020	_currentCursor = cursorMode;
EDISON_NGUNJIRI	0:0898e006947b	2021
EDISON_NGUNJIRI	0:0898e006947b	2022	// Configure only current LCD controller
EDISON_NGUNJIRI	0:0898e006947b	2023	_setCursorAndDisplayMode(_currentMode, _currentCursor);
EDISON_NGUNJIRI	0:0898e006947b	2024	}
EDISON_NGUNJIRI	0:0898e006947b	2025
EDISON_NGUNJIRI	0:0898e006947b	2026	/** Set the Displaymode
EDISON_NGUNJIRI	0:0898e006947b	2027	*
EDISON_NGUNJIRI	0:0898e006947b	2028	* @param displayMode The Display mode (DispOff, DispOn)
EDISON_NGUNJIRI	0:0898e006947b	2029	*/
EDISON_NGUNJIRI	0:0898e006947b	2030	void TextLCD_Base::setMode(LCDMode displayMode) {
EDISON_NGUNJIRI	0:0898e006947b	2031
EDISON_NGUNJIRI	0:0898e006947b	2032	// Save new displayMode, needed when 2 controllers are in use or when cursor is changed
EDISON_NGUNJIRI	0:0898e006947b	2033	_currentMode = displayMode;
EDISON_NGUNJIRI	0:0898e006947b	2034
EDISON_NGUNJIRI	0:0898e006947b	2035	#if (LCD_TWO_CTRL == 1)
EDISON_NGUNJIRI	0:0898e006947b	2036	// Select and configure second LCD controller when needed
EDISON_NGUNJIRI	0:0898e006947b	2037	if(_type==LCD40x4) {
EDISON_NGUNJIRI	0:0898e006947b	2038	if (_ctrl_idx==_LCDCtrl_0) {
EDISON_NGUNJIRI	0:0898e006947b	2039	// Configure primary LCD controller
EDISON_NGUNJIRI	0:0898e006947b	2040	_setCursorAndDisplayMode(_currentMode, _currentCursor);
EDISON_NGUNJIRI	0:0898e006947b	2041
EDISON_NGUNJIRI	0:0898e006947b	2042	// Select 2nd controller
EDISON_NGUNJIRI	0:0898e006947b	2043	_ctrl_idx=_LCDCtrl_1;
EDISON_NGUNJIRI	0:0898e006947b	2044
EDISON_NGUNJIRI	0:0898e006947b	2045	// Configure secondary LCD controller
EDISON_NGUNJIRI	0:0898e006947b	2046	_setCursorAndDisplayMode(_currentMode, CurOff_BlkOff);
EDISON_NGUNJIRI	0:0898e006947b	2047
EDISON_NGUNJIRI	0:0898e006947b	2048	// Restore current controller
EDISON_NGUNJIRI	0:0898e006947b	2049	_ctrl_idx=_LCDCtrl_0;
EDISON_NGUNJIRI	0:0898e006947b	2050	}
EDISON_NGUNJIRI	0:0898e006947b	2051	else {
EDISON_NGUNJIRI	0:0898e006947b	2052	// Select primary controller
EDISON_NGUNJIRI	0:0898e006947b	2053	_ctrl_idx=_LCDCtrl_0;
EDISON_NGUNJIRI	0:0898e006947b	2054
EDISON_NGUNJIRI	0:0898e006947b	2055	// Configure primary LCD controller
EDISON_NGUNJIRI	0:0898e006947b	2056	_setCursorAndDisplayMode(_currentMode, CurOff_BlkOff);
EDISON_NGUNJIRI	0:0898e006947b	2057
EDISON_NGUNJIRI	0:0898e006947b	2058	// Restore current controller
EDISON_NGUNJIRI	0:0898e006947b	2059	_ctrl_idx=_LCDCtrl_1;
EDISON_NGUNJIRI	0:0898e006947b	2060
EDISON_NGUNJIRI	0:0898e006947b	2061	// Configure secondary LCD controller
EDISON_NGUNJIRI	0:0898e006947b	2062	_setCursorAndDisplayMode(_currentMode, _currentCursor);
EDISON_NGUNJIRI	0:0898e006947b	2063	}
EDISON_NGUNJIRI	0:0898e006947b	2064	}
EDISON_NGUNJIRI	0:0898e006947b	2065	else {
EDISON_NGUNJIRI	0:0898e006947b	2066	// Configure primary LCD controller
EDISON_NGUNJIRI	0:0898e006947b	2067	_setCursorAndDisplayMode(_currentMode, _currentCursor);
EDISON_NGUNJIRI	0:0898e006947b	2068	}
EDISON_NGUNJIRI	0:0898e006947b	2069	#else
EDISON_NGUNJIRI	0:0898e006947b	2070	// Support only one LCD controller
EDISON_NGUNJIRI	0:0898e006947b	2071	_setCursorAndDisplayMode(_currentMode, _currentCursor);
EDISON_NGUNJIRI	0:0898e006947b	2072
EDISON_NGUNJIRI	0:0898e006947b	2073	#endif
EDISON_NGUNJIRI	0:0898e006947b	2074	}
EDISON_NGUNJIRI	0:0898e006947b	2075
EDISON_NGUNJIRI	0:0898e006947b	2076	/** Low level method to restore the cursortype and display mode for current controller
EDISON_NGUNJIRI	0:0898e006947b	2077	*/
EDISON_NGUNJIRI	0:0898e006947b	2078	void TextLCD_Base::_setCursorAndDisplayMode(LCDMode displayMode, LCDCursor cursorType) {
EDISON_NGUNJIRI	0:0898e006947b	2079
EDISON_NGUNJIRI	0:0898e006947b	2080	// Configure current LCD controller
EDISON_NGUNJIRI	0:0898e006947b	2081	switch (_ctrl) {
EDISON_NGUNJIRI	0:0898e006947b	2082	case ST7070:
EDISON_NGUNJIRI	0:0898e006947b	2083	//ST7070 does not support Cursorblink. The P bit selects the font instead !
EDISON_NGUNJIRI	0:0898e006947b	2084	_writeCommand(0x08 \| displayMode \| (cursorType & 0x02));
EDISON_NGUNJIRI	0:0898e006947b	2085	break;
EDISON_NGUNJIRI	0:0898e006947b	2086	default:
EDISON_NGUNJIRI	0:0898e006947b	2087	_writeCommand(0x08 \| displayMode \| cursorType);
EDISON_NGUNJIRI	0:0898e006947b	2088	break;
EDISON_NGUNJIRI	0:0898e006947b	2089	} //switch
EDISON_NGUNJIRI	0:0898e006947b	2090	}
EDISON_NGUNJIRI	0:0898e006947b	2091
EDISON_NGUNJIRI	0:0898e006947b	2092	/** Set the Backlight mode
EDISON_NGUNJIRI	0:0898e006947b	2093	*
EDISON_NGUNJIRI	0:0898e006947b	2094	* @param backlightMode The Backlight mode (LightOff, LightOn)
EDISON_NGUNJIRI	0:0898e006947b	2095	*/
EDISON_NGUNJIRI	0:0898e006947b	2096	void TextLCD_Base::setBacklight(LCDBacklight backlightMode) {
EDISON_NGUNJIRI	0:0898e006947b	2097
EDISON_NGUNJIRI	0:0898e006947b	2098	#if (BACKLIGHT_INV==0)
EDISON_NGUNJIRI	0:0898e006947b	2099	// Positive Backlight control pin logic
EDISON_NGUNJIRI	0:0898e006947b	2100	if (backlightMode == LightOn) {
EDISON_NGUNJIRI	0:0898e006947b	2101	this->_setBL(true);
EDISON_NGUNJIRI	0:0898e006947b	2102	}
EDISON_NGUNJIRI	0:0898e006947b	2103	else {
EDISON_NGUNJIRI	0:0898e006947b	2104	this->_setBL(false);
EDISON_NGUNJIRI	0:0898e006947b	2105	}
EDISON_NGUNJIRI	0:0898e006947b	2106	#else
EDISON_NGUNJIRI	0:0898e006947b	2107	// Inverted Backlight control pin logic
EDISON_NGUNJIRI	0:0898e006947b	2108	if (backlightMode == LightOn) {
EDISON_NGUNJIRI	0:0898e006947b	2109	this->_setBL(false);
EDISON_NGUNJIRI	0:0898e006947b	2110	}
EDISON_NGUNJIRI	0:0898e006947b	2111	else {
EDISON_NGUNJIRI	0:0898e006947b	2112	this->_setBL(true);
EDISON_NGUNJIRI	0:0898e006947b	2113	}
EDISON_NGUNJIRI	0:0898e006947b	2114	#endif
EDISON_NGUNJIRI	0:0898e006947b	2115	}
EDISON_NGUNJIRI	0:0898e006947b	2116
EDISON_NGUNJIRI	0:0898e006947b	2117	/** Set User Defined Characters
EDISON_NGUNJIRI	0:0898e006947b	2118	*
EDISON_NGUNJIRI	0:0898e006947b	2119	* @param unsigned char c The Index of the UDC (0..7) for HD44780 or clones and (0..15) for some more advanced controllers
EDISON_NGUNJIRI	0:0898e006947b	2120	* @param char *udc_data The bitpatterns for the UDC (8 bytes of 5 significant bits for bitpattern and 3 bits for blinkmode (advanced types))
EDISON_NGUNJIRI	0:0898e006947b	2121	*/
EDISON_NGUNJIRI	0:0898e006947b	2122	void TextLCD_Base::setUDC(unsigned char c, char *udc_data) {
EDISON_NGUNJIRI	0:0898e006947b	2123
EDISON_NGUNJIRI	0:0898e006947b	2124	#if (LCD_TWO_CTRL == 1)
EDISON_NGUNJIRI	0:0898e006947b	2125	// Select and configure second LCD controller when needed
EDISON_NGUNJIRI	0:0898e006947b	2126	if(_type==LCD40x4) {
EDISON_NGUNJIRI	0:0898e006947b	2127	_LCDCtrl_Idx current_ctrl_idx = _ctrl_idx; // Temp save current controller
EDISON_NGUNJIRI	0:0898e006947b	2128
EDISON_NGUNJIRI	0:0898e006947b	2129	// Select primary controller
EDISON_NGUNJIRI	0:0898e006947b	2130	_ctrl_idx=_LCDCtrl_0;
EDISON_NGUNJIRI	0:0898e006947b	2131
EDISON_NGUNJIRI	0:0898e006947b	2132	// Configure primary LCD controller
EDISON_NGUNJIRI	0:0898e006947b	2133	_setUDC(c, udc_data);
EDISON_NGUNJIRI	0:0898e006947b	2134
EDISON_NGUNJIRI	0:0898e006947b	2135	// Select 2nd controller
EDISON_NGUNJIRI	0:0898e006947b	2136	_ctrl_idx=_LCDCtrl_1;
EDISON_NGUNJIRI	0:0898e006947b	2137
EDISON_NGUNJIRI	0:0898e006947b	2138	// Configure secondary LCD controller
EDISON_NGUNJIRI	0:0898e006947b	2139	_setUDC(c, udc_data);
EDISON_NGUNJIRI	0:0898e006947b	2140
EDISON_NGUNJIRI	0:0898e006947b	2141	// Restore current controller
EDISON_NGUNJIRI	0:0898e006947b	2142	_ctrl_idx=current_ctrl_idx;
EDISON_NGUNJIRI	0:0898e006947b	2143	}
EDISON_NGUNJIRI	0:0898e006947b	2144	else {
EDISON_NGUNJIRI	0:0898e006947b	2145	// Configure primary LCD controller
EDISON_NGUNJIRI	0:0898e006947b	2146	_setUDC(c, udc_data);
EDISON_NGUNJIRI	0:0898e006947b	2147	}
EDISON_NGUNJIRI	0:0898e006947b	2148	#else
EDISON_NGUNJIRI	0:0898e006947b	2149	// Support only one LCD controller
EDISON_NGUNJIRI	0:0898e006947b	2150	_setUDC(c, udc_data);
EDISON_NGUNJIRI	0:0898e006947b	2151	#endif
EDISON_NGUNJIRI	0:0898e006947b	2152	}
EDISON_NGUNJIRI	0:0898e006947b	2153
EDISON_NGUNJIRI	0:0898e006947b	2154	/** Low level method to store user defined characters for current controller
EDISON_NGUNJIRI	0:0898e006947b	2155	*
EDISON_NGUNJIRI	0:0898e006947b	2156	* @param unsigned char c The Index of the UDC (0..7) for HD44780 clones and (0..15) for some more advanced controllers
EDISON_NGUNJIRI	0:0898e006947b	2157	* @param char *udc_data The bitpatterns for the UDC (8 bytes of 5 significant bits for bitpattern and 3 bits for blinkmode (advanced types))
EDISON_NGUNJIRI	0:0898e006947b	2158	*/
EDISON_NGUNJIRI	0:0898e006947b	2159	void TextLCD_Base::_setUDC(unsigned char c, char *udc_data) {
EDISON_NGUNJIRI	0:0898e006947b	2160
EDISON_NGUNJIRI	0:0898e006947b	2161	switch (_ctrl) {
EDISON_NGUNJIRI	0:0898e006947b	2162	case PCF2103_3V3 : // Some UDCs may be used for Icons
EDISON_NGUNJIRI	0:0898e006947b	2163	case PCF2113_3V3 : // Some UDCs may be used for Icons
EDISON_NGUNJIRI	0:0898e006947b	2164	case PCF2116_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2165	case PCF2116_5V :
EDISON_NGUNJIRI	0:0898e006947b	2166	case PCF2119_3V3 : // Some UDCs may be used for Icons
EDISON_NGUNJIRI	0:0898e006947b	2167	case PCF2119R_3V3: // Some UDCs may be used for Icons
EDISON_NGUNJIRI	0:0898e006947b	2168	c = c & 0x0F; // mask down to valid range
EDISON_NGUNJIRI	0:0898e006947b	2169	break;
EDISON_NGUNJIRI	0:0898e006947b	2170
EDISON_NGUNJIRI	0:0898e006947b	2171	default:
EDISON_NGUNJIRI	0:0898e006947b	2172	c = c & 0x07; // mask down to valid range
EDISON_NGUNJIRI	0:0898e006947b	2173	break;
EDISON_NGUNJIRI	0:0898e006947b	2174	} //switch _ctrl
EDISON_NGUNJIRI	0:0898e006947b	2175
EDISON_NGUNJIRI	0:0898e006947b	2176	// Select DD RAM for current LCD controller
EDISON_NGUNJIRI	0:0898e006947b	2177	// This is needed to correctly set Bit 6 of the addresspointer for controllers that support 16 UDCs
EDISON_NGUNJIRI	0:0898e006947b	2178	_writeCommand(0x80 \| ((c << 3) & 0x40)) ;
EDISON_NGUNJIRI	0:0898e006947b	2179
EDISON_NGUNJIRI	0:0898e006947b	2180	// Select CG RAM for current LCD controller
EDISON_NGUNJIRI	0:0898e006947b	2181	_writeCommand(0x40 \| ((c << 3) & 0x3F)); //Set CG-RAM address, (note that Bit 6 is retained and can not be set by this command !)
EDISON_NGUNJIRI	0:0898e006947b	2182	//8 sequential locations needed per UDC
EDISON_NGUNJIRI	0:0898e006947b	2183	// Store UDC pattern
EDISON_NGUNJIRI	0:0898e006947b	2184	for (int i=0; i<8; i++) {
EDISON_NGUNJIRI	0:0898e006947b	2185	_writeData(*udc_data++);
EDISON_NGUNJIRI	0:0898e006947b	2186	}
EDISON_NGUNJIRI	0:0898e006947b	2187
EDISON_NGUNJIRI	0:0898e006947b	2188	//Select DD RAM again for current LCD controller and restore the addresspointer
EDISON_NGUNJIRI	0:0898e006947b	2189	int addr = getAddress(_column, _row);
EDISON_NGUNJIRI	0:0898e006947b	2190	_writeCommand(0x80 \| addr);
EDISON_NGUNJIRI	0:0898e006947b	2191	}
EDISON_NGUNJIRI	0:0898e006947b	2192
EDISON_NGUNJIRI	0:0898e006947b	2193	#if(LCD_BLINK == 1)
EDISON_NGUNJIRI	0:0898e006947b	2194	/** Set UDC Blink and Icon blink
EDISON_NGUNJIRI	0:0898e006947b	2195	* setUDCBlink method is supported by some compatible devices (eg SSD1803)
EDISON_NGUNJIRI	0:0898e006947b	2196	*
EDISON_NGUNJIRI	0:0898e006947b	2197	* @param blinkMode The Blink mode (BlinkOff, BlinkOn)
EDISON_NGUNJIRI	0:0898e006947b	2198	*/
EDISON_NGUNJIRI	0:0898e006947b	2199	void TextLCD_Base::setUDCBlink(LCDBlink blinkMode){
EDISON_NGUNJIRI	0:0898e006947b	2200	// Blinking UDCs (and icons) are enabled when a specific controlbit (BE) is set.
EDISON_NGUNJIRI	0:0898e006947b	2201	// The blinking pixels in the UDC and icons can be controlled by setting additional bits in the UDC or icon bitpattern.
EDISON_NGUNJIRI	0:0898e006947b	2202	// UDCs are defined by an 8 byte bitpattern. The P0..P4 form the character pattern.
EDISON_NGUNJIRI	0:0898e006947b	2203	// P7 P6 P5 P4 P3 P2 P1 P0
EDISON_NGUNJIRI	0:0898e006947b	2204	// 0 B1 B0 x 0 1 1 1 0
EDISON_NGUNJIRI	0:0898e006947b	2205	// 1 B1 B0 x 1 0 0 0 1
EDISON_NGUNJIRI	0:0898e006947b	2206	// .............
EDISON_NGUNJIRI	0:0898e006947b	2207	// 7 B1 B0 x 1 0 0 0 1
EDISON_NGUNJIRI	0:0898e006947b	2208	//
EDISON_NGUNJIRI	0:0898e006947b	2209	// Bit 6 and Bit 7 in the pattern will control the blinking mode when Blink is enabled through BE.
EDISON_NGUNJIRI	0:0898e006947b	2210	// B1 B0 Mode
EDISON_NGUNJIRI	0:0898e006947b	2211	// 0 0 No Blinking in this row of the UDC
EDISON_NGUNJIRI	0:0898e006947b	2212	// 0 1 Enabled pixels in P4 will blink
EDISON_NGUNJIRI	0:0898e006947b	2213	// 1 x Enabled pixels in P0..P4 will blink
EDISON_NGUNJIRI	0:0898e006947b	2214	//
EDISON_NGUNJIRI	0:0898e006947b	2215	// Note: the PCF2103 and PCF2113 use UDCs to set Icons
EDISON_NGUNJIRI	0:0898e006947b	2216	// 3 x 8 rows x 5 bits = 120 bits Icons for Normal pattern (UDC 0..2) and
EDISON_NGUNJIRI	0:0898e006947b	2217	// 3 x 8 rows x 5 bits = 120 bits Icons for Blink pattern (UDC 4..6)
EDISON_NGUNJIRI	0:0898e006947b	2218	// Note: the PCF2119 uses UDCs to set Icons
EDISON_NGUNJIRI	0:0898e006947b	2219	// 4 x 8 rows x 5 bits = 160 bits Icons for Normal pattern (UDC 0..3) and
EDISON_NGUNJIRI	0:0898e006947b	2220	// 4 x 8 rows x 5 bits = 160 bits Icons for Blink pattern (UDC 4..7)
EDISON_NGUNJIRI	0:0898e006947b	2221	switch (blinkMode) {
EDISON_NGUNJIRI	0:0898e006947b	2222	case BlinkOn:
EDISON_NGUNJIRI	0:0898e006947b	2223	// Controllers that support UDC/Icon Blink
EDISON_NGUNJIRI	0:0898e006947b	2224	switch (_ctrl) {
EDISON_NGUNJIRI	0:0898e006947b	2225	case KS0073 :
EDISON_NGUNJIRI	0:0898e006947b	2226	case KS0078 :
EDISON_NGUNJIRI	0:0898e006947b	2227	case HD66712 :
EDISON_NGUNJIRI	0:0898e006947b	2228	_function_1 \|= 0x02; // Enable UDC/Icon Blink
EDISON_NGUNJIRI	0:0898e006947b	2229	_writeCommand(0x20 \| _function_1); // Function set 0 0 1 DL N RE(1) BE 0/LP (Ext Regs)
EDISON_NGUNJIRI	0:0898e006947b	2230
EDISON_NGUNJIRI	0:0898e006947b	2231	_writeCommand(0x20 \| _function); // Function set 0 0 1 DL N RE(0) DH REV (Std Regs)
EDISON_NGUNJIRI	0:0898e006947b	2232	break; // case KS0073, KS0078, HD66712 Controller
EDISON_NGUNJIRI	0:0898e006947b	2233
EDISON_NGUNJIRI	0:0898e006947b	2234	case US2066_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2235	case SSD1803_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2236	_function_1 \|= 0x04; // Enable UDC/Icon Blink
EDISON_NGUNJIRI	0:0898e006947b	2237	_writeCommand(0x20 \| _function_1); // Set function, 0 0 1 DL N BE RE(1) REV
EDISON_NGUNJIRI	0:0898e006947b	2238	// Select Ext Instr Set
EDISON_NGUNJIRI	0:0898e006947b	2239
EDISON_NGUNJIRI	0:0898e006947b	2240	_writeCommand(0x20 \| _function); // Set function, 0 0 1 DL N DH RE(0) IS=0 Select Instruction Set 0
EDISON_NGUNJIRI	0:0898e006947b	2241	// Select Std Instr set, Select IS=0
EDISON_NGUNJIRI	0:0898e006947b	2242	break; // case SSD1803, US2066
EDISON_NGUNJIRI	0:0898e006947b	2243
EDISON_NGUNJIRI	0:0898e006947b	2244	case PCF2103_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2245	case PCF2113_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2246	case PCF2119_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2247	case PCF2119R_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2248	// Enable Icon Blink
EDISON_NGUNJIRI	0:0898e006947b	2249	_writeCommand(0x20 \| _function \| 0x01); // Set function, Select Instr Set = 1
EDISON_NGUNJIRI	0:0898e006947b	2250	_writeCommand(0x08 \| 0x02); // ICON Conf 0000 1, IM=0 (Char mode), IB=1 (Icon blink), 0 (Instr. Set 1)
EDISON_NGUNJIRI	0:0898e006947b	2251	_writeCommand(0x20 \| _function); // Set function, Select Instr Set = 0
EDISON_NGUNJIRI	0:0898e006947b	2252
EDISON_NGUNJIRI	0:0898e006947b	2253	break;
EDISON_NGUNJIRI	0:0898e006947b	2254
EDISON_NGUNJIRI	0:0898e006947b	2255	default:
EDISON_NGUNJIRI	0:0898e006947b	2256	//Unsupported feature for other controllers
EDISON_NGUNJIRI	0:0898e006947b	2257	break;
EDISON_NGUNJIRI	0:0898e006947b	2258	} //switch _ctrl
EDISON_NGUNJIRI	0:0898e006947b	2259
EDISON_NGUNJIRI	0:0898e006947b	2260	break; // BlinkOn
EDISON_NGUNJIRI	0:0898e006947b	2261
EDISON_NGUNJIRI	0:0898e006947b	2262	case BlinkOff:
EDISON_NGUNJIRI	0:0898e006947b	2263	// Controllers that support UDC Blink
EDISON_NGUNJIRI	0:0898e006947b	2264	switch (_ctrl) {
EDISON_NGUNJIRI	0:0898e006947b	2265	case KS0073 :
EDISON_NGUNJIRI	0:0898e006947b	2266	case KS0078 :
EDISON_NGUNJIRI	0:0898e006947b	2267	case HD66712:
EDISON_NGUNJIRI	0:0898e006947b	2268	_function_1 &= ~0x02; // Disable UDC/Icon Blink
EDISON_NGUNJIRI	0:0898e006947b	2269	_writeCommand(0x20 \| _function_1); // Function set 0 0 1 DL N RE(1) BE 0/LP (Ext Regs)
EDISON_NGUNJIRI	0:0898e006947b	2270
EDISON_NGUNJIRI	0:0898e006947b	2271	_writeCommand(0x20 \| _function); // Function set 0 0 1 DL N RE(0) DH REV (Std Regs)
EDISON_NGUNJIRI	0:0898e006947b	2272	break; // case KS0073, KS0078, HD66712 Controller
EDISON_NGUNJIRI	0:0898e006947b	2273
EDISON_NGUNJIRI	0:0898e006947b	2274	case US2066_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2275	case SSD1803_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2276	_function_1 &= ~0x04; // Disable UDC/Icon Blink
EDISON_NGUNJIRI	0:0898e006947b	2277	_writeCommand(0x20 \| _function_1); // Set function, 0 0 1 DL N BE RE(1) REV
EDISON_NGUNJIRI	0:0898e006947b	2278	// Select Ext Instr Set
EDISON_NGUNJIRI	0:0898e006947b	2279
EDISON_NGUNJIRI	0:0898e006947b	2280	_writeCommand(0x20 \| _function); // Set function, 0 0 1 DL N DH RE(0) IS=0 Select Instruction Set 0
EDISON_NGUNJIRI	0:0898e006947b	2281	// Select Std Instr set, Select IS=0
EDISON_NGUNJIRI	0:0898e006947b	2282	break; // case SSD1803, US2066
EDISON_NGUNJIRI	0:0898e006947b	2283
EDISON_NGUNJIRI	0:0898e006947b	2284	case PCF2103_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2285	case PCF2113_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2286	case PCF2119_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2287	case PCF2119R_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2288	// Disable Icon Blink
EDISON_NGUNJIRI	0:0898e006947b	2289	_writeCommand(0x20 \| _function \| 0x01); // Set function, Select Instr Set = 1
EDISON_NGUNJIRI	0:0898e006947b	2290	_writeCommand(0x08); // ICON Conf 0000 1, IM=0 (Char mode), IB=1 (Icon blink), 0 (Instr. Set 1)
EDISON_NGUNJIRI	0:0898e006947b	2291	_writeCommand(0x20 \| _function); // Set function, Select Instr Set = 0
EDISON_NGUNJIRI	0:0898e006947b	2292
EDISON_NGUNJIRI	0:0898e006947b	2293	break;
EDISON_NGUNJIRI	0:0898e006947b	2294
EDISON_NGUNJIRI	0:0898e006947b	2295	default:
EDISON_NGUNJIRI	0:0898e006947b	2296	//Unsupported feature for other controllers
EDISON_NGUNJIRI	0:0898e006947b	2297	break;
EDISON_NGUNJIRI	0:0898e006947b	2298	} //switch _ctrl
EDISON_NGUNJIRI	0:0898e006947b	2299
EDISON_NGUNJIRI	0:0898e006947b	2300	break; //BlinkOff
EDISON_NGUNJIRI	0:0898e006947b	2301
EDISON_NGUNJIRI	0:0898e006947b	2302	default:
EDISON_NGUNJIRI	0:0898e006947b	2303	break;
EDISON_NGUNJIRI	0:0898e006947b	2304	} // blinkMode
EDISON_NGUNJIRI	0:0898e006947b	2305
EDISON_NGUNJIRI	0:0898e006947b	2306	} // setUDCBlink()
EDISON_NGUNJIRI	0:0898e006947b	2307	#endif
EDISON_NGUNJIRI	0:0898e006947b	2308
EDISON_NGUNJIRI	0:0898e006947b	2309	#if(LCD_CONTRAST == 1)
EDISON_NGUNJIRI	0:0898e006947b	2310	/** Set Contrast
EDISON_NGUNJIRI	0:0898e006947b	2311	* setContrast method is supported by some compatible devices (eg ST7032i) that have onboard LCD voltage generation
EDISON_NGUNJIRI	0:0898e006947b	2312	* Initial code for ST70XX imported from fork by JH1PJL
EDISON_NGUNJIRI	0:0898e006947b	2313	*
EDISON_NGUNJIRI	0:0898e006947b	2314	* @param unsigned char c contrast data (6 significant bits, valid range 0..63, Value 0 will disable the Vgen)
EDISON_NGUNJIRI	0:0898e006947b	2315	* @return none
EDISON_NGUNJIRI	0:0898e006947b	2316	*/
EDISON_NGUNJIRI	0:0898e006947b	2317	//@TODO Add support for 40x4 dual controller
EDISON_NGUNJIRI	0:0898e006947b	2318	void TextLCD_Base::setContrast(unsigned char c) {
EDISON_NGUNJIRI	0:0898e006947b	2319
EDISON_NGUNJIRI	0:0898e006947b	2320	// Function set mode stored during Init. Make sure we dont accidentally switch between 1-line and 2-line mode!
EDISON_NGUNJIRI	0:0898e006947b	2321	// Icon/Booster mode stored during Init. Make sure we dont accidentally change this!
EDISON_NGUNJIRI	0:0898e006947b	2322
EDISON_NGUNJIRI	0:0898e006947b	2323	_contrast = c & 0x3F; // Sanity check
EDISON_NGUNJIRI	0:0898e006947b	2324
EDISON_NGUNJIRI	0:0898e006947b	2325	switch (_ctrl) {
EDISON_NGUNJIRI	0:0898e006947b	2326	case PCF2113_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2327	case PCF2119_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2328	case PCF2119R_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2329	if (_contrast < 5) _contrast = 0; // See datasheet. Sanity check for PCF2113/PCF2119
EDISON_NGUNJIRI	0:0898e006947b	2330	if (_contrast > 55) _contrast = 55;
EDISON_NGUNJIRI	0:0898e006947b	2331
EDISON_NGUNJIRI	0:0898e006947b	2332	_writeCommand(0x20 \| _function \| 0x01); // Set function, Select Instruction Set = 1
EDISON_NGUNJIRI	0:0898e006947b	2333	_writeCommand(0x80 \| 0x00 \| (_contrast & 0x3F)); // VLCD_set (Instr. Set 1) V=0, VA=contrast
EDISON_NGUNJIRI	0:0898e006947b	2334	_writeCommand(0x80 \| 0x40 \| (_contrast & 0x3F)); // VLCD_set (Instr. Set 1) V=1, VB=contrast
EDISON_NGUNJIRI	0:0898e006947b	2335	_writeCommand(0x20 \| _function); // Select Instruction Set = 0
EDISON_NGUNJIRI	0:0898e006947b	2336	break;
EDISON_NGUNJIRI	0:0898e006947b	2337
EDISON_NGUNJIRI	0:0898e006947b	2338	case ST7032_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2339	case ST7032_5V :
EDISON_NGUNJIRI	0:0898e006947b	2340	case ST7036_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2341	// case ST7036_5V :
EDISON_NGUNJIRI	0:0898e006947b	2342	case SSD1803_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2343	case SPLC792A_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2344	_writeCommand(0x20 \| _function \| 0x01); // Select Instruction Set = 1
EDISON_NGUNJIRI	0:0898e006947b	2345	_writeCommand(0x70 \| (_contrast & 0x0F)); // Contrast Low bits
EDISON_NGUNJIRI	0:0898e006947b	2346	_writeCommand(0x50 \| _icon_power \| ((_contrast >> 4) & 0x03)); // Contrast High bits
EDISON_NGUNJIRI	0:0898e006947b	2347	_writeCommand(0x20 \| _function); // Select Instruction Set = 0
EDISON_NGUNJIRI	0:0898e006947b	2348	break;
EDISON_NGUNJIRI	0:0898e006947b	2349
EDISON_NGUNJIRI	0:0898e006947b	2350	case US2066_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2351	_writeCommand(0x20 \| _function_1); // Set function, 0 0 1 DL N BE RE(1) REV
EDISON_NGUNJIRI	0:0898e006947b	2352	// Select Extended Instruction Set
EDISON_NGUNJIRI	0:0898e006947b	2353
EDISON_NGUNJIRI	0:0898e006947b	2354	_writeCommand(0x79); // Function Select OLED: 0 1 1 1 1 0 0 1 (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	2355
EDISON_NGUNJIRI	0:0898e006947b	2356	_writeCommand(0x81); // Set Contrast Control: 1 0 0 0 0 0 0 1 (Ext Instr Set, OLED)
EDISON_NGUNJIRI	0:0898e006947b	2357	_writeCommand((_contrast << 2) \| 0x03); // Set Contrast Value: 8 bits. Use 6 bits for compatibility
EDISON_NGUNJIRI	0:0898e006947b	2358
EDISON_NGUNJIRI	0:0898e006947b	2359	_writeCommand(0x78); // Function Disable OLED: 0 1 1 1 1 0 0 0 (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	2360
EDISON_NGUNJIRI	0:0898e006947b	2361	_writeCommand(0x20 \| _function); // Set function, 0 0 1 DL N DH RE(0) IS=0 Select Instruction Set 0
EDISON_NGUNJIRI	0:0898e006947b	2362	// Select Std Instr set, Select IS=0
EDISON_NGUNJIRI	0:0898e006947b	2363	break;
EDISON_NGUNJIRI	0:0898e006947b	2364
EDISON_NGUNJIRI	0:0898e006947b	2365	//not yet tested on hardware
EDISON_NGUNJIRI	0:0898e006947b	2366	case PT6314 :
EDISON_NGUNJIRI	0:0898e006947b	2367	// Only 2 significant bits
EDISON_NGUNJIRI	0:0898e006947b	2368	// 0x00 = 100%
EDISON_NGUNJIRI	0:0898e006947b	2369	// 0x01 = 75%
EDISON_NGUNJIRI	0:0898e006947b	2370	// 0x02 = 50%
EDISON_NGUNJIRI	0:0898e006947b	2371	// 0x03 = 25%
EDISON_NGUNJIRI	0:0898e006947b	2372	_writeCommand(0x20 \| _function \| ((~_contrast) >> 4)); // Invert and shift to use 2 MSBs
EDISON_NGUNJIRI	0:0898e006947b	2373	break;
EDISON_NGUNJIRI	0:0898e006947b	2374
EDISON_NGUNJIRI	0:0898e006947b	2375	default:
EDISON_NGUNJIRI	0:0898e006947b	2376	//Unsupported feature for other controllers
EDISON_NGUNJIRI	0:0898e006947b	2377	break;
EDISON_NGUNJIRI	0:0898e006947b	2378	} // end switch
EDISON_NGUNJIRI	0:0898e006947b	2379	} // end setContrast()
EDISON_NGUNJIRI	0:0898e006947b	2380	#endif
EDISON_NGUNJIRI	0:0898e006947b	2381
EDISON_NGUNJIRI	0:0898e006947b	2382	#if(LCD_POWER == 1)
EDISON_NGUNJIRI	0:0898e006947b	2383	/** Set Power
EDISON_NGUNJIRI	0:0898e006947b	2384	* setPower method is supported by some compatible devices (eg SSD1803) that have power down modes
EDISON_NGUNJIRI	0:0898e006947b	2385	*
EDISON_NGUNJIRI	0:0898e006947b	2386	* @param bool powerOn Power on/off
EDISON_NGUNJIRI	0:0898e006947b	2387	* @return none
EDISON_NGUNJIRI	0:0898e006947b	2388	*/
EDISON_NGUNJIRI	0:0898e006947b	2389	//@TODO Add support for 40x4 dual controller
EDISON_NGUNJIRI	0:0898e006947b	2390	void TextLCD_Base::setPower(bool powerOn) {
EDISON_NGUNJIRI	0:0898e006947b	2391
EDISON_NGUNJIRI	0:0898e006947b	2392	if (powerOn) {
EDISON_NGUNJIRI	0:0898e006947b	2393	// Switch on
EDISON_NGUNJIRI	0:0898e006947b	2394	setMode(DispOn);
EDISON_NGUNJIRI	0:0898e006947b	2395
EDISON_NGUNJIRI	0:0898e006947b	2396	// Controllers that supports specific Power Down mode
EDISON_NGUNJIRI	0:0898e006947b	2397	switch (_ctrl) {
EDISON_NGUNJIRI	0:0898e006947b	2398
EDISON_NGUNJIRI	0:0898e006947b	2399	// case PCF2113_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2400	// case PCF2119_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2401	// case PCF2119R_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2402	// case ST7032_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2403	//@todo
EDISON_NGUNJIRI	0:0898e006947b	2404	// enable Booster Bon
EDISON_NGUNJIRI	0:0898e006947b	2405
EDISON_NGUNJIRI	0:0898e006947b	2406	case WS0010:
EDISON_NGUNJIRI	0:0898e006947b	2407	_writeCommand(0x17); // Char mode, DC/DC on
EDISON_NGUNJIRI	0:0898e006947b	2408	thread_sleep_for(10); // Wait 10ms to ensure powered up
EDISON_NGUNJIRI	0:0898e006947b	2409	break;
EDISON_NGUNJIRI	0:0898e006947b	2410
EDISON_NGUNJIRI	0:0898e006947b	2411	case KS0073:
EDISON_NGUNJIRI	0:0898e006947b	2412	case KS0078:
EDISON_NGUNJIRI	0:0898e006947b	2413	case SSD1803_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2414	// case SSD1803_5V :
EDISON_NGUNJIRI	0:0898e006947b	2415	_writeCommand(0x20 \| _function_1); // Select Ext Instr Set
EDISON_NGUNJIRI	0:0898e006947b	2416	_writeCommand(0x02); // Power On
EDISON_NGUNJIRI	0:0898e006947b	2417	_writeCommand(0x20 \| _function); // Select Std Instr Set
EDISON_NGUNJIRI	0:0898e006947b	2418	break;
EDISON_NGUNJIRI	0:0898e006947b	2419
EDISON_NGUNJIRI	0:0898e006947b	2420	default:
EDISON_NGUNJIRI	0:0898e006947b	2421	//Unsupported feature for other controllers
EDISON_NGUNJIRI	0:0898e006947b	2422	break;
EDISON_NGUNJIRI	0:0898e006947b	2423	} // end switch
EDISON_NGUNJIRI	0:0898e006947b	2424	}
EDISON_NGUNJIRI	0:0898e006947b	2425	else {
EDISON_NGUNJIRI	0:0898e006947b	2426	// Switch off
EDISON_NGUNJIRI	0:0898e006947b	2427	setMode(DispOff);
EDISON_NGUNJIRI	0:0898e006947b	2428
EDISON_NGUNJIRI	0:0898e006947b	2429	// Controllers that support specific Power Down mode
EDISON_NGUNJIRI	0:0898e006947b	2430	switch (_ctrl) {
EDISON_NGUNJIRI	0:0898e006947b	2431
EDISON_NGUNJIRI	0:0898e006947b	2432	// case PCF2113_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2433	// case PCF2119_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2434	// case PCF2119R_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2435	// case ST7032_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2436	//@todo
EDISON_NGUNJIRI	0:0898e006947b	2437	// disable Booster Bon
EDISON_NGUNJIRI	0:0898e006947b	2438
EDISON_NGUNJIRI	0:0898e006947b	2439	case WS0010:
EDISON_NGUNJIRI	0:0898e006947b	2440	_writeCommand(0x13); // Char mode, DC/DC off
EDISON_NGUNJIRI	0:0898e006947b	2441	break;
EDISON_NGUNJIRI	0:0898e006947b	2442
EDISON_NGUNJIRI	0:0898e006947b	2443	case KS0073:
EDISON_NGUNJIRI	0:0898e006947b	2444	case KS0078:
EDISON_NGUNJIRI	0:0898e006947b	2445	case SSD1803_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2446	// case SSD1803_5V :
EDISON_NGUNJIRI	0:0898e006947b	2447	_writeCommand(0x20 \| _function_1); // Select Ext Instr Set
EDISON_NGUNJIRI	0:0898e006947b	2448	_writeCommand(0x03); // Power Down
EDISON_NGUNJIRI	0:0898e006947b	2449	_writeCommand(0x20 \| _function); // Select Std Instr Set
EDISON_NGUNJIRI	0:0898e006947b	2450	break;
EDISON_NGUNJIRI	0:0898e006947b	2451
EDISON_NGUNJIRI	0:0898e006947b	2452	default:
EDISON_NGUNJIRI	0:0898e006947b	2453	//Unsupported feature for other controllers
EDISON_NGUNJIRI	0:0898e006947b	2454	break;
EDISON_NGUNJIRI	0:0898e006947b	2455	} // end switch
EDISON_NGUNJIRI	0:0898e006947b	2456	}
EDISON_NGUNJIRI	0:0898e006947b	2457	} // end setPower()
EDISON_NGUNJIRI	0:0898e006947b	2458	#endif
EDISON_NGUNJIRI	0:0898e006947b	2459
EDISON_NGUNJIRI	0:0898e006947b	2460	#if(LCD_ORIENT == 1)
EDISON_NGUNJIRI	0:0898e006947b	2461	/** Set Orient
EDISON_NGUNJIRI	0:0898e006947b	2462	* setOrient method is supported by some compatible devices (eg SSD1803, US2066) that have top/bottom view modes
EDISON_NGUNJIRI	0:0898e006947b	2463	*
EDISON_NGUNJIRI	0:0898e006947b	2464	* @param LCDOrient orient Orientation
EDISON_NGUNJIRI	0:0898e006947b	2465	* @return none
EDISON_NGUNJIRI	0:0898e006947b	2466	*/
EDISON_NGUNJIRI	0:0898e006947b	2467	void TextLCD_Base::setOrient(LCDOrient orient){
EDISON_NGUNJIRI	0:0898e006947b	2468
EDISON_NGUNJIRI	0:0898e006947b	2469	switch (orient) {
EDISON_NGUNJIRI	0:0898e006947b	2470
EDISON_NGUNJIRI	0:0898e006947b	2471	case Top:
EDISON_NGUNJIRI	0:0898e006947b	2472	switch (_ctrl) {
EDISON_NGUNJIRI	0:0898e006947b	2473	case PCF2103_3V3:
EDISON_NGUNJIRI	0:0898e006947b	2474	case PCF2116_3V3:
EDISON_NGUNJIRI	0:0898e006947b	2475	case PCF2116_5V:
EDISON_NGUNJIRI	0:0898e006947b	2476	_writeCommand(0x20 \| _function \| 0x01); // Set function, Select Instr Set = 1
EDISON_NGUNJIRI	0:0898e006947b	2477	_writeCommand(0x05); // Display Conf Set 0000 0, 1, P=0, Q=1 (Instr. Set 1)
EDISON_NGUNJIRI	0:0898e006947b	2478	_writeCommand(0x20 \| _function); // Set function, Select Instr Set = 0
EDISON_NGUNJIRI	0:0898e006947b	2479	break;
EDISON_NGUNJIRI	0:0898e006947b	2480
EDISON_NGUNJIRI	0:0898e006947b	2481	case PCF2119_3V3:
EDISON_NGUNJIRI	0:0898e006947b	2482	case PCF2119R_3V3:
EDISON_NGUNJIRI	0:0898e006947b	2483	_writeCommand(0x20 \| _function \| 0x01); // Set function, Select Instr Set = 1
EDISON_NGUNJIRI	0:0898e006947b	2484	_writeCommand(0x07); // Display Conf Set 0000 0, 1, P=1, Q=1 (Instr. Set 1)
EDISON_NGUNJIRI	0:0898e006947b	2485	_writeCommand(0x20 \| _function); // Set function, Select Instr Set = 0
EDISON_NGUNJIRI	0:0898e006947b	2486	break;
EDISON_NGUNJIRI	0:0898e006947b	2487
EDISON_NGUNJIRI	0:0898e006947b	2488	case SSD1803_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2489	// case SSD1803_5V :
EDISON_NGUNJIRI	0:0898e006947b	2490	case US2066_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2491	_writeCommand(0x20 \| _function_1); // Set function, 0 0 1 X N BE RE(1) REV
EDISON_NGUNJIRI	0:0898e006947b	2492	// Select Extended Instruction Set
EDISON_NGUNJIRI	0:0898e006947b	2493	// _writeCommand(0x06); // Set ext entry mode, 0 0 0 0 0 1 BDC=1 COM1-32, BDS=0 SEG100-1 "Bottom View" (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	2494	_writeCommand(0x05); // Set ext entry mode, 0 0 0 0 0 1 BDC=0 COM32-1, BDS=1 SEG1-100 "Top View" (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	2495
EDISON_NGUNJIRI	0:0898e006947b	2496	_writeCommand(0x20 \| _function); // Set function, 0 0 1 DL N DH RE(0) IS=0 Select Instruction Set 0
EDISON_NGUNJIRI	0:0898e006947b	2497	// Select Std Instr set, Select IS=0
EDISON_NGUNJIRI	0:0898e006947b	2498	break;
EDISON_NGUNJIRI	0:0898e006947b	2499
EDISON_NGUNJIRI	0:0898e006947b	2500	case ST7070:
EDISON_NGUNJIRI	0:0898e006947b	2501	_writeCommand(0x20 \| _function \| 0x04); // Set function, 0 0 1 DL, N, EXT=1, x, x (Select Instr Set = 1)
EDISON_NGUNJIRI	0:0898e006947b	2502
EDISON_NGUNJIRI	0:0898e006947b	2503	_writeCommand(0x40 \| 0x00); // COM/SEG directions 0 1 0 0 C1, C2, S1, S2 (Instr Set 1)
EDISON_NGUNJIRI	0:0898e006947b	2504	// C1=1: Com1-8 -> Com8-1; C2=1: Com9-16 -> Com16-9
EDISON_NGUNJIRI	0:0898e006947b	2505	// S1=1: Seg1-40 -> Seg40-1; S2=1: Seg41-80 -> Seg80-41
EDISON_NGUNJIRI	0:0898e006947b	2506	thread_sleep_for(5); // Wait to ensure completion or ST7070 fails to set Top/Bottom after reset..
EDISON_NGUNJIRI	0:0898e006947b	2507
EDISON_NGUNJIRI	0:0898e006947b	2508	_writeCommand(0x20 \| _function); // Set function, EXT=0 (Select Instr Set = 0)
EDISON_NGUNJIRI	0:0898e006947b	2509
EDISON_NGUNJIRI	0:0898e006947b	2510	break; // case ST7070 Controller
EDISON_NGUNJIRI	0:0898e006947b	2511
EDISON_NGUNJIRI	0:0898e006947b	2512	default:
EDISON_NGUNJIRI	0:0898e006947b	2513	//Unsupported feature for other controllers
EDISON_NGUNJIRI	0:0898e006947b	2514	break;
EDISON_NGUNJIRI	0:0898e006947b	2515
EDISON_NGUNJIRI	0:0898e006947b	2516	} // end switch _ctrl
EDISON_NGUNJIRI	0:0898e006947b	2517	break; // end Top
EDISON_NGUNJIRI	0:0898e006947b	2518
EDISON_NGUNJIRI	0:0898e006947b	2519	case Bottom:
EDISON_NGUNJIRI	0:0898e006947b	2520	switch (_ctrl) {
EDISON_NGUNJIRI	0:0898e006947b	2521	case PCF2103_3V3:
EDISON_NGUNJIRI	0:0898e006947b	2522	case PCF2116_3V3:
EDISON_NGUNJIRI	0:0898e006947b	2523	case PCF2116_5V:
EDISON_NGUNJIRI	0:0898e006947b	2524	_writeCommand(0x20 \| _function \| 0x01); // Set function, Select Instr Set = 1
EDISON_NGUNJIRI	0:0898e006947b	2525	_writeCommand(0x06); // Display Conf Set 0000 0, 1, P=1, Q=0 (Instr. Set 1)
EDISON_NGUNJIRI	0:0898e006947b	2526	_writeCommand(0x20 \| _function); // Set function, Select Instr Set = 0
EDISON_NGUNJIRI	0:0898e006947b	2527	break;
EDISON_NGUNJIRI	0:0898e006947b	2528
EDISON_NGUNJIRI	0:0898e006947b	2529	case PCF2119_3V3:
EDISON_NGUNJIRI	0:0898e006947b	2530	case PCF2119R_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2531	_writeCommand(0x20 \| _function \| 0x01); // Set function, Select Instr Set = 1
EDISON_NGUNJIRI	0:0898e006947b	2532	_writeCommand(0x04); // Display Conf Set 0000 0, 1, P=0, Q=0 (Instr. Set 1)
EDISON_NGUNJIRI	0:0898e006947b	2533	_writeCommand(0x20 \| _function); // Set function, Select Instr Set = 0
EDISON_NGUNJIRI	0:0898e006947b	2534	break;
EDISON_NGUNJIRI	0:0898e006947b	2535
EDISON_NGUNJIRI	0:0898e006947b	2536	case SSD1803_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2537	// case SSD1803_5V :
EDISON_NGUNJIRI	0:0898e006947b	2538	case US2066_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2539	_writeCommand(0x20 \| _function_1); // Set function, 0 0 1 X N BE RE(1) REV
EDISON_NGUNJIRI	0:0898e006947b	2540	// Select Extended Instruction Set
EDISON_NGUNJIRI	0:0898e006947b	2541	_writeCommand(0x06); // Set ext entry mode, 0 0 0 0 0 1 BDC=1 COM1-32, BDS=0 SEG100-1 "Bottom View" (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	2542	// _writeCommand(0x05); // Set ext entry mode, 0 0 0 0 0 1 BDC=0 COM32-1, BDS=1 SEG1-100 "Top View" (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	2543
EDISON_NGUNJIRI	0:0898e006947b	2544	_writeCommand(0x20 \| _function); // Set function, 0 0 1 DL N DH RE(0) IS=0 Select Instruction Set 0
EDISON_NGUNJIRI	0:0898e006947b	2545	// Select Std Instr set, Select IS=0
EDISON_NGUNJIRI	0:0898e006947b	2546	break;
EDISON_NGUNJIRI	0:0898e006947b	2547
EDISON_NGUNJIRI	0:0898e006947b	2548	case ST7070:
EDISON_NGUNJIRI	0:0898e006947b	2549	//Note: this does not result in correct top/bottom view.
EDISON_NGUNJIRI	0:0898e006947b	2550	//The left and right half of each row are reversed and the addressing of both rows is also incorrect:
EDISON_NGUNJIRI	0:0898e006947b	2551	//Top/bottomline when orientation is flipped:
EDISON_NGUNJIRI	0:0898e006947b	2552	// 0x48...0x4F 0x40...0x47
EDISON_NGUNJIRI	0:0898e006947b	2553	// 0x08...0x0F 0x00...0x07
EDISON_NGUNJIRI	0:0898e006947b	2554	_writeCommand(0x20 \| _function \| 0x04); // Set function, 0 0 1 DL N EXT=1 x x (Select Instr Set = 1)
EDISON_NGUNJIRI	0:0898e006947b	2555
EDISON_NGUNJIRI	0:0898e006947b	2556	_writeCommand(0x40 \| 0x0F); // COM/SEG directions 0 1 0 0 C1, C2, S1, S2 (Instr Set 1)
EDISON_NGUNJIRI	0:0898e006947b	2557	// C1=1: Com1-8 -> Com8-1; C2=1: Com9-16 -> Com16-9
EDISON_NGUNJIRI	0:0898e006947b	2558	// S1=1: Seg1-40 -> Seg40-1; S2=1: Seg41-80 -> Seg80-41
EDISON_NGUNJIRI	0:0898e006947b	2559	thread_sleep_for(5); // Wait to ensure completion or ST7070 fails to set Top/Bottom after reset..
EDISON_NGUNJIRI	0:0898e006947b	2560
EDISON_NGUNJIRI	0:0898e006947b	2561	_writeCommand(0x20 \| _function); // Set function, EXT=0 (Select Instr Set = 0)
EDISON_NGUNJIRI	0:0898e006947b	2562
EDISON_NGUNJIRI	0:0898e006947b	2563	break; // case ST7070 Controller
EDISON_NGUNJIRI	0:0898e006947b	2564
EDISON_NGUNJIRI	0:0898e006947b	2565	default:
EDISON_NGUNJIRI	0:0898e006947b	2566	//Unsupported feature for other controllers
EDISON_NGUNJIRI	0:0898e006947b	2567	break;
EDISON_NGUNJIRI	0:0898e006947b	2568
EDISON_NGUNJIRI	0:0898e006947b	2569	} // end switch _ctrl
EDISON_NGUNJIRI	0:0898e006947b	2570
EDISON_NGUNJIRI	0:0898e006947b	2571	break; // end Bottom
EDISON_NGUNJIRI	0:0898e006947b	2572	} // end switch orient
EDISON_NGUNJIRI	0:0898e006947b	2573	} // end setOrient()
EDISON_NGUNJIRI	0:0898e006947b	2574	#endif
EDISON_NGUNJIRI	0:0898e006947b	2575
EDISON_NGUNJIRI	0:0898e006947b	2576	#if(LCD_BIGFONT == 1)
EDISON_NGUNJIRI	0:0898e006947b	2577	/** Set Big Font
EDISON_NGUNJIRI	0:0898e006947b	2578	* setBigFont method is supported by some compatible devices (eg SSD1803, US2066)
EDISON_NGUNJIRI	0:0898e006947b	2579	*
EDISON_NGUNJIRI	0:0898e006947b	2580	* @param lines The selected Big Font lines (None, TopLine, CenterLine, BottomLine, TopBottomLine)
EDISON_NGUNJIRI	0:0898e006947b	2581	* Double height characters can be shown on lines 1+2, 2+3, 3+4 or 1+2 and 3+4
EDISON_NGUNJIRI	0:0898e006947b	2582	* Valid double height lines depend on the LCDs number of rows.
EDISON_NGUNJIRI	0:0898e006947b	2583	*/
EDISON_NGUNJIRI	0:0898e006947b	2584	void TextLCD_Base::setBigFont(LCDBigFont lines) {
EDISON_NGUNJIRI	0:0898e006947b	2585
EDISON_NGUNJIRI	0:0898e006947b	2586	switch (lines) {
EDISON_NGUNJIRI	0:0898e006947b	2587	case None:
EDISON_NGUNJIRI	0:0898e006947b	2588	switch (_ctrl) {
EDISON_NGUNJIRI	0:0898e006947b	2589	case SSD1803_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2590	case US2066_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2591	_writeCommand(0x20 \| _function_1); // Set function, 0 0 1 X N BE RE(1) REV
EDISON_NGUNJIRI	0:0898e006947b	2592	// Select Extended Instruction Set
EDISON_NGUNJIRI	0:0898e006947b	2593	_writeCommand(0x1C); // Double Height, 0 0 0 1 UD2=1, UD1=1, X, DH'=0 (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	2594	// Default
EDISON_NGUNJIRI	0:0898e006947b	2595	_function = _function & ~0x04; // Set function, 0 0 1 DL N DH=0 RE(0) IS=0 Select Instruction Set 0
EDISON_NGUNJIRI	0:0898e006947b	2596	_writeCommand(0x20 \| _function); // Set function, 0 0 1 DL N DH RE(0) IS=0 Select Instruction Set 0
EDISON_NGUNJIRI	0:0898e006947b	2597	// Select Std Instr set, Select IS=0
EDISON_NGUNJIRI	0:0898e006947b	2598	break; // end US2066
EDISON_NGUNJIRI	0:0898e006947b	2599
EDISON_NGUNJIRI	0:0898e006947b	2600	default:
EDISON_NGUNJIRI	0:0898e006947b	2601	break; // end default
EDISON_NGUNJIRI	0:0898e006947b	2602	} // end switch _ctrl
EDISON_NGUNJIRI	0:0898e006947b	2603	break; // end None
EDISON_NGUNJIRI	0:0898e006947b	2604
EDISON_NGUNJIRI	0:0898e006947b	2605	case TopLine:
EDISON_NGUNJIRI	0:0898e006947b	2606	if (_nr_rows < 2) return; //Sanity check
EDISON_NGUNJIRI	0:0898e006947b	2607
EDISON_NGUNJIRI	0:0898e006947b	2608	switch (_ctrl) {
EDISON_NGUNJIRI	0:0898e006947b	2609	case SSD1803_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2610	case US2066_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2611	_writeCommand(0x20 \| _function_1); // Set function, 0 0 1 X N BE RE(1) REV
EDISON_NGUNJIRI	0:0898e006947b	2612	// Select Extended Instruction Set
EDISON_NGUNJIRI	0:0898e006947b	2613	_writeCommand(0x1C); // Double Height, 0 0 0 1 UD2=1, UD1=1, X, DH'=0 (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	2614	// Default
EDISON_NGUNJIRI	0:0898e006947b	2615	_function = _function \| 0x04; // Set function, 0 0 1 DL N DH=1 RE(0) IS=0 Select Instruction Set 0
EDISON_NGUNJIRI	0:0898e006947b	2616	_writeCommand(0x20 \| _function); // Set function, 0 0 1 DL N DH RE(0) IS=0 Select Instruction Set 0
EDISON_NGUNJIRI	0:0898e006947b	2617	// Select Std Instr set, Select IS=0
EDISON_NGUNJIRI	0:0898e006947b	2618	break; // end US2066, SSD1803
EDISON_NGUNJIRI	0:0898e006947b	2619
EDISON_NGUNJIRI	0:0898e006947b	2620	default:
EDISON_NGUNJIRI	0:0898e006947b	2621	break; // end default
EDISON_NGUNJIRI	0:0898e006947b	2622	} // end switch _ctrl
EDISON_NGUNJIRI	0:0898e006947b	2623	break; // end TopLine
EDISON_NGUNJIRI	0:0898e006947b	2624
EDISON_NGUNJIRI	0:0898e006947b	2625	case CenterLine:
EDISON_NGUNJIRI	0:0898e006947b	2626	if (_nr_rows != 4) return; //Sanity check
EDISON_NGUNJIRI	0:0898e006947b	2627
EDISON_NGUNJIRI	0:0898e006947b	2628	switch (_ctrl) {
EDISON_NGUNJIRI	0:0898e006947b	2629	case SSD1803_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2630	case US2066_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2631	_writeCommand(0x20 \| _function_1); // Set function, 0 0 1 X N BE RE(1) REV
EDISON_NGUNJIRI	0:0898e006947b	2632	// Select Extended Instruction Set
EDISON_NGUNJIRI	0:0898e006947b	2633	_writeCommand(0x14); // Double Height, 0 0 0 1 UD2=0, UD1=1, X, DH'=0 (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	2634	// Default
EDISON_NGUNJIRI	0:0898e006947b	2635	_function = _function \| 0x04; // Set function, 0 0 1 DL N DH=1 RE(0) IS=0 Select Instruction Set 0
EDISON_NGUNJIRI	0:0898e006947b	2636	_writeCommand(0x20 \| _function); // Set function, 0 0 1 DL N DH RE(0) IS=0 Select Instruction Set 0
EDISON_NGUNJIRI	0:0898e006947b	2637	// Select Std Instr set, Select IS=0
EDISON_NGUNJIRI	0:0898e006947b	2638	break; // end US2066, SSD1803
EDISON_NGUNJIRI	0:0898e006947b	2639
EDISON_NGUNJIRI	0:0898e006947b	2640	default:
EDISON_NGUNJIRI	0:0898e006947b	2641	break; // end default
EDISON_NGUNJIRI	0:0898e006947b	2642	} // end switch _ctrl
EDISON_NGUNJIRI	0:0898e006947b	2643	break; // end CenterLine
EDISON_NGUNJIRI	0:0898e006947b	2644
EDISON_NGUNJIRI	0:0898e006947b	2645	case BottomLine:
EDISON_NGUNJIRI	0:0898e006947b	2646	if (_nr_rows < 3) return; //Sanity check
EDISON_NGUNJIRI	0:0898e006947b	2647
EDISON_NGUNJIRI	0:0898e006947b	2648	switch (_ctrl) {
EDISON_NGUNJIRI	0:0898e006947b	2649	case SSD1803_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2650	case US2066_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2651	_writeCommand(0x20 \| _function_1); // Set function, 0 0 1 X N BE RE(1) REV
EDISON_NGUNJIRI	0:0898e006947b	2652	// Select Extended Instruction Set
EDISON_NGUNJIRI	0:0898e006947b	2653	if (_nr_rows == 3) {
EDISON_NGUNJIRI	0:0898e006947b	2654	_writeCommand(0x14); // Double Height, 0 0 0 1 UD2=0, UD1=1, X, DH'=0 (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	2655	}
EDISON_NGUNJIRI	0:0898e006947b	2656	else {
EDISON_NGUNJIRI	0:0898e006947b	2657	_writeCommand(0x10); // Double Height, 0 0 0 1 UD2=0, UD1=0, X, DH'=0 (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	2658	}
EDISON_NGUNJIRI	0:0898e006947b	2659	_function = _function \| 0x04; // Set function, 0 0 1 DL N DH=1 RE(0) IS=0 Select Instruction Set 0
EDISON_NGUNJIRI	0:0898e006947b	2660	_writeCommand(0x20 \| _function); // Set function, 0 0 1 DL N DH RE(0) IS=0 Select Instruction Set 0
EDISON_NGUNJIRI	0:0898e006947b	2661	// Select Std Instr set, Select IS=0
EDISON_NGUNJIRI	0:0898e006947b	2662	break; // end US2066, SSD1803
EDISON_NGUNJIRI	0:0898e006947b	2663
EDISON_NGUNJIRI	0:0898e006947b	2664	default:
EDISON_NGUNJIRI	0:0898e006947b	2665	break; // end default
EDISON_NGUNJIRI	0:0898e006947b	2666	} // end switch _ctrl
EDISON_NGUNJIRI	0:0898e006947b	2667	break; // end BottomLine
EDISON_NGUNJIRI	0:0898e006947b	2668
EDISON_NGUNJIRI	0:0898e006947b	2669	case TopBottomLine:
EDISON_NGUNJIRI	0:0898e006947b	2670	if (_nr_rows != 4) return; //Sanity check
EDISON_NGUNJIRI	0:0898e006947b	2671
EDISON_NGUNJIRI	0:0898e006947b	2672	switch (_ctrl) {
EDISON_NGUNJIRI	0:0898e006947b	2673	case SSD1803_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2674	case US2066_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2675	_writeCommand(0x20 \| _function_1); // Set function, 0 0 1 X N BE RE(1) REV
EDISON_NGUNJIRI	0:0898e006947b	2676	// Select Extended Instruction Set
EDISON_NGUNJIRI	0:0898e006947b	2677	_writeCommand(0x18); // Double Height, 0 0 0 1 UD2=1, UD1=0, X, DH'=0 (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	2678	// Default
EDISON_NGUNJIRI	0:0898e006947b	2679	_function = _function \| 0x04; // Set function, 0 0 1 DL N DH=1 RE(0) IS=0 Select Instruction Set 0
EDISON_NGUNJIRI	0:0898e006947b	2680	_writeCommand(0x20 \| _function); // Set function, 0 0 1 DL N DH RE(0) IS=0 Select Instruction Set 0
EDISON_NGUNJIRI	0:0898e006947b	2681	// Select Std Instr set, Select IS=0
EDISON_NGUNJIRI	0:0898e006947b	2682	break; // end US2066, SSD1803
EDISON_NGUNJIRI	0:0898e006947b	2683
EDISON_NGUNJIRI	0:0898e006947b	2684	default:
EDISON_NGUNJIRI	0:0898e006947b	2685	break; // end default
EDISON_NGUNJIRI	0:0898e006947b	2686	} // end switch _ctrl
EDISON_NGUNJIRI	0:0898e006947b	2687	break; // end TopBottomLine
EDISON_NGUNJIRI	0:0898e006947b	2688
EDISON_NGUNJIRI	0:0898e006947b	2689	} // end switch lines
EDISON_NGUNJIRI	0:0898e006947b	2690
EDISON_NGUNJIRI	0:0898e006947b	2691	} // end setBigFont()
EDISON_NGUNJIRI	0:0898e006947b	2692	#endif
EDISON_NGUNJIRI	0:0898e006947b	2693
EDISON_NGUNJIRI	0:0898e006947b	2694
EDISON_NGUNJIRI	0:0898e006947b	2695	#if (LCD_FONTSEL == 1)
EDISON_NGUNJIRI	0:0898e006947b	2696	/** Set Font
EDISON_NGUNJIRI	0:0898e006947b	2697	* setFont method is supported by some compatible devices (eg SSD1803, US2066, ST7070)
EDISON_NGUNJIRI	0:0898e006947b	2698	*
EDISON_NGUNJIRI	0:0898e006947b	2699	* @param LCDFont font The selected Font
EDISON_NGUNJIRI	0:0898e006947b	2700	* @return none
EDISON_NGUNJIRI	0:0898e006947b	2701	*
EDISON_NGUNJIRI	0:0898e006947b	2702	* Note: most controllers support only one font and the hardware specific
EDISON_NGUNJIRI	0:0898e006947b	2703	* fonttable is encoded as part of the controller type number (eg PCF21XXC or PCF21XXR).
EDISON_NGUNJIRI	0:0898e006947b	2704	* Some controllers support multiple tables that can only be selected by logic levels on a few pins.
EDISON_NGUNJIRI	0:0898e006947b	2705	* Some controllers also support runtime fontable switching through a specific instruction
EDISON_NGUNJIRI	0:0898e006947b	2706	*/
EDISON_NGUNJIRI	0:0898e006947b	2707	void TextLCD_Base::setFont(LCDFont font) {
EDISON_NGUNJIRI	0:0898e006947b	2708
EDISON_NGUNJIRI	0:0898e006947b	2709	switch (font) {
EDISON_NGUNJIRI	0:0898e006947b	2710	case Font_RA: // UK/EU
EDISON_NGUNJIRI	0:0898e006947b	2711	switch (_ctrl) {
EDISON_NGUNJIRI	0:0898e006947b	2712	case SSD1803_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2713	case US2066_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2714	_writeCommand(0x20 \| _function_1); // Set function, 0 0 1 X N BE RE(1) REV
EDISON_NGUNJIRI	0:0898e006947b	2715	// Select Extended Instruction Set
EDISON_NGUNJIRI	0:0898e006947b	2716	_writeCommand(0x72); // ROM Select command, 0 1 1 1 0 0 1 0 (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	2717	_writeData(0x00); // ROM_0 Select data, 0 0 0 0 ROM2 ROM1 0 0 (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	2718
EDISON_NGUNJIRI	0:0898e006947b	2719	_writeCommand(0x20 \| _function); // Set function, 0 0 1 DL N DH RE(0) IS (Std Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	2720
EDISON_NGUNJIRI	0:0898e006947b	2721	_font = font; // Save active font
EDISON_NGUNJIRI	0:0898e006947b	2722	break; // end SSD1803, US2066
EDISON_NGUNJIRI	0:0898e006947b	2723
EDISON_NGUNJIRI	0:0898e006947b	2724	case ST7070:
EDISON_NGUNJIRI	0:0898e006947b	2725	//ST7070 does not support Cursorblink. The P bit selects the font instead !
EDISON_NGUNJIRI	0:0898e006947b	2726	_writeCommand(0x08 \| _currentMode \| (_currentCursor & 0x02));
EDISON_NGUNJIRI	0:0898e006947b	2727
EDISON_NGUNJIRI	0:0898e006947b	2728	_font = font; // Save active font
EDISON_NGUNJIRI	0:0898e006947b	2729	break; // end ST7070
EDISON_NGUNJIRI	0:0898e006947b	2730
EDISON_NGUNJIRI	0:0898e006947b	2731	default:
EDISON_NGUNJIRI	0:0898e006947b	2732	break; // end default
EDISON_NGUNJIRI	0:0898e006947b	2733	} // end switch _ctrl
EDISON_NGUNJIRI	0:0898e006947b	2734	break; // end Font_RA
EDISON_NGUNJIRI	0:0898e006947b	2735
EDISON_NGUNJIRI	0:0898e006947b	2736	case Font_RB: // UK/CYR
EDISON_NGUNJIRI	0:0898e006947b	2737	switch (_ctrl) {
EDISON_NGUNJIRI	0:0898e006947b	2738	case SSD1803_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2739	case US2066_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2740	_writeCommand(0x20 \| _function_1); // Set function, 0 0 1 X N BE RE(1) REV
EDISON_NGUNJIRI	0:0898e006947b	2741	// Select Extended Instruction Set
EDISON_NGUNJIRI	0:0898e006947b	2742	_writeCommand(0x72); // ROM Select command, 0 1 1 1 0 0 1 0 (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	2743	_writeData(0x04); // ROM_0 Select data, 0 0 0 0 ROM2 ROM1 0 0 (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	2744
EDISON_NGUNJIRI	0:0898e006947b	2745	_writeCommand(0x20 \| _function); // Set function, 0 0 1 DL N DH RE(0) IS (Std Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	2746
EDISON_NGUNJIRI	0:0898e006947b	2747	_font = font; // Save active font
EDISON_NGUNJIRI	0:0898e006947b	2748	break; // end SSD1803, US2066
EDISON_NGUNJIRI	0:0898e006947b	2749
EDISON_NGUNJIRI	0:0898e006947b	2750	case ST7070:
EDISON_NGUNJIRI	0:0898e006947b	2751	//ST7070 does not support Cursorblink. The P bit selects the font instead !
EDISON_NGUNJIRI	0:0898e006947b	2752	_writeCommand(0x08 \| _currentMode \| (_currentCursor & 0x02) \| 0x01);
EDISON_NGUNJIRI	0:0898e006947b	2753
EDISON_NGUNJIRI	0:0898e006947b	2754	_font = font; // Save active font
EDISON_NGUNJIRI	0:0898e006947b	2755	break; // end ST7070
EDISON_NGUNJIRI	0:0898e006947b	2756
EDISON_NGUNJIRI	0:0898e006947b	2757	default:
EDISON_NGUNJIRI	0:0898e006947b	2758	break; // end default
EDISON_NGUNJIRI	0:0898e006947b	2759	} // end switch _ctrl
EDISON_NGUNJIRI	0:0898e006947b	2760	break; // end Font_RB
EDISON_NGUNJIRI	0:0898e006947b	2761
EDISON_NGUNJIRI	0:0898e006947b	2762	case Font_0: //Font_O is pretty similar to ROM_C
EDISON_NGUNJIRI	0:0898e006947b	2763	case Font_RC: // UK/JAP
EDISON_NGUNJIRI	0:0898e006947b	2764	switch (_ctrl) {
EDISON_NGUNJIRI	0:0898e006947b	2765	case SSD1803_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2766	case US2066_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	2767	_writeCommand(0x20 \| _function_1); // Set function, 0 0 1 X N BE RE(1) REV
EDISON_NGUNJIRI	0:0898e006947b	2768	// Select Extended Instruction Set
EDISON_NGUNJIRI	0:0898e006947b	2769	_writeCommand(0x72); // ROM Select command, 0 1 1 1 0 0 1 0 (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	2770	_writeData(0x08); // ROM_0 Select data, 0 0 0 0 ROM2 ROM1 0 0 (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	2771
EDISON_NGUNJIRI	0:0898e006947b	2772	_writeCommand(0x20 \| _function); // Set function, 0 0 1 DL N DH RE(0) IS (Std Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	2773
EDISON_NGUNJIRI	0:0898e006947b	2774	_font = font; // Save active font
EDISON_NGUNJIRI	0:0898e006947b	2775	break; // end SSD1803, US2066
EDISON_NGUNJIRI	0:0898e006947b	2776
EDISON_NGUNJIRI	0:0898e006947b	2777	default:
EDISON_NGUNJIRI	0:0898e006947b	2778	break; // end default
EDISON_NGUNJIRI	0:0898e006947b	2779	} // end switch _ctrl
EDISON_NGUNJIRI	0:0898e006947b	2780	break; // end Font_RC
EDISON_NGUNJIRI	0:0898e006947b	2781	} // end switch font
EDISON_NGUNJIRI	0:0898e006947b	2782
EDISON_NGUNJIRI	0:0898e006947b	2783	//SSD1803 seems to screw up cursor position after selecting new font. Restore to make sure...
EDISON_NGUNJIRI	0:0898e006947b	2784	//Set next memoryaddress, make sure cursor blinks at next location
EDISON_NGUNJIRI	0:0898e006947b	2785	int addr = getAddress(_column, _row);
EDISON_NGUNJIRI	0:0898e006947b	2786	_writeCommand(0x80 \| addr);
EDISON_NGUNJIRI	0:0898e006947b	2787
EDISON_NGUNJIRI	0:0898e006947b	2788	}
EDISON_NGUNJIRI	0:0898e006947b	2789	#endif
EDISON_NGUNJIRI	0:0898e006947b	2790
EDISON_NGUNJIRI	0:0898e006947b	2791
EDISON_NGUNJIRI	0:0898e006947b	2792	#if(LCD_ICON==1)
EDISON_NGUNJIRI	0:0898e006947b	2793	/** Set Icons
EDISON_NGUNJIRI	0:0898e006947b	2794	*
EDISON_NGUNJIRI	0:0898e006947b	2795	* @param unsigned char idx The Index of the icon pattern (0..15) for KS0073 and similar controllers
EDISON_NGUNJIRI	0:0898e006947b	2796	* and Index (0..31) for PCF2103 and similar controllers
EDISON_NGUNJIRI	0:0898e006947b	2797	* @param unsigned char data The bitpattern for the icons (6 lsb for KS0073 bitpattern (5 lsb for KS0078) and 2 msb for blinkmode)
EDISON_NGUNJIRI	0:0898e006947b	2798	* The bitpattern for the PCF2103 icons is 5 lsb (UDC 0..2) and 5 lsb for blinkmode (UDC 4..6)
EDISON_NGUNJIRI	0:0898e006947b	2799	*/
EDISON_NGUNJIRI	0:0898e006947b	2800	void TextLCD_Base::setIcon(unsigned char idx, unsigned char data) {
EDISON_NGUNJIRI	0:0898e006947b	2801	// Blinking icons are enabled when a specific controlbit (BE) is set.
EDISON_NGUNJIRI	0:0898e006947b	2802	// The blinking pixels in the icons can be controlled by setting additional bits in the icon bitpattern.
EDISON_NGUNJIRI	0:0898e006947b	2803	// Icons are defined by a byte bitpattern. The P0..P5 form the Icon pattern for KS0073, and P0..P4 for KS0078
EDISON_NGUNJIRI	0:0898e006947b	2804	// P7 P6 P5 P4 P3 P2 P1 P0
EDISON_NGUNJIRI	0:0898e006947b	2805	// 0 B1 B0 0 0 1 1 1 0
EDISON_NGUNJIRI	0:0898e006947b	2806	// 1 B1 B0 1 1 0 0 0 1
EDISON_NGUNJIRI	0:0898e006947b	2807	// .............
EDISON_NGUNJIRI	0:0898e006947b	2808	// 15 B1 B0 1 1 0 0 0 1
EDISON_NGUNJIRI	0:0898e006947b	2809	//
EDISON_NGUNJIRI	0:0898e006947b	2810	// Bit 6 and Bit 7 in the pattern will control the blinking mode when Blink is enabled through BE.
EDISON_NGUNJIRI	0:0898e006947b	2811	// B1 B0 Mode
EDISON_NGUNJIRI	0:0898e006947b	2812	// 0 0 No Blinking for this icon row
EDISON_NGUNJIRI	0:0898e006947b	2813	// 0 1 Enabled pixels in P5 will blink
EDISON_NGUNJIRI	0:0898e006947b	2814	// 1 x Enabled pixels in P0..P5 will blink
EDISON_NGUNJIRI	0:0898e006947b	2815	//
EDISON_NGUNJIRI	0:0898e006947b	2816	// Note: the PCF2103 and PCF2113 use UDCs to set Icons
EDISON_NGUNJIRI	0:0898e006947b	2817	// 3 x 8 rows x 5 bits = 120 bits Icons for Normal pattern (UDC 0..2) and
EDISON_NGUNJIRI	0:0898e006947b	2818	// 3 x 8 rows x 5 bits = 120 bits Icons for Blink pattern (UDC 4..6)
EDISON_NGUNJIRI	0:0898e006947b	2819	// Note: the PCF2119 uses UDCs to set Icons
EDISON_NGUNJIRI	0:0898e006947b	2820	// 4 x 8 rows x 5 bits = 160 bits Icons for Normal pattern (UDC 0..3) and
EDISON_NGUNJIRI	0:0898e006947b	2821	// 4 x 8 rows x 5 bits = 160 bits Icons for Blink pattern (UDC 4..7)
EDISON_NGUNJIRI	0:0898e006947b	2822
EDISON_NGUNJIRI	0:0898e006947b	2823	switch (_ctrl) {
EDISON_NGUNJIRI	0:0898e006947b	2824	case KS0073:
EDISON_NGUNJIRI	0:0898e006947b	2825	case KS0078:
EDISON_NGUNJIRI	0:0898e006947b	2826	_writeCommand(0x20 \| _function_1); // Set function, 0 0 1 DL N RE(1) BE LP
EDISON_NGUNJIRI	0:0898e006947b	2827	// Select Extended Instruction Set
EDISON_NGUNJIRI	0:0898e006947b	2828	_writeCommand(0x40 \| (idx & 0x0F)); // Set Icon Address, mask Address to valid range (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	2829
EDISON_NGUNJIRI	0:0898e006947b	2830	_writeData(data); // Set Icon pattern (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	2831
EDISON_NGUNJIRI	0:0898e006947b	2832	_writeCommand(0x20 \| _function); // Set function, 0 0 1 DL N RE(0) DH REV Select Instruction Set 0
EDISON_NGUNJIRI	0:0898e006947b	2833	// Select Std Instr set, Select IS=0
EDISON_NGUNJIRI	0:0898e006947b	2834	break; // end KS0073, KS0078
EDISON_NGUNJIRI	0:0898e006947b	2835
EDISON_NGUNJIRI	0:0898e006947b	2836	case ST7032_3V3:
EDISON_NGUNJIRI	0:0898e006947b	2837	case ST7032_5V:
EDISON_NGUNJIRI	0:0898e006947b	2838	case SPLC792A_3V3:
EDISON_NGUNJIRI	0:0898e006947b	2839	_writeCommand(0x20 \| _function \| 0x01); // Set function, 0 0 1 DL N F 0 IS=1 Select Instr Set = 1
EDISON_NGUNJIRI	0:0898e006947b	2840	_writeCommand(0x40 \| (idx & 0x0F)); // Set Icon Address, mask Address to valid range (Instr Set 1)
EDISON_NGUNJIRI	0:0898e006947b	2841
EDISON_NGUNJIRI	0:0898e006947b	2842	_writeData(data & 0x1F); // Set Icon pattern, no blink support (Instr Set 1)
EDISON_NGUNJIRI	0:0898e006947b	2843
EDISON_NGUNJIRI	0:0898e006947b	2844	_writeCommand(0x20 \| _function); // Set function, 0 0 1 DL N RE(0) DH REV Select Instruction Set 0
EDISON_NGUNJIRI	0:0898e006947b	2845	// Select Std Instr set, Select IS=0
EDISON_NGUNJIRI	0:0898e006947b	2846	break; // end ST7032
EDISON_NGUNJIRI	0:0898e006947b	2847
EDISON_NGUNJIRI	0:0898e006947b	2848	case ST7036_3V3:
EDISON_NGUNJIRI	0:0898e006947b	2849	case ST7036_5V:
EDISON_NGUNJIRI	0:0898e006947b	2850	_writeCommand(0x20 \| _function \| 0x01); // Set function, 0 0 1 DL N DH IS2,IS1 = 01 (Select Instr Set = 1)
EDISON_NGUNJIRI	0:0898e006947b	2851	_writeCommand(0x40 \| (idx & 0x0F)); // Set Icon Address, mask Address to valid range (Instr Set 1)
EDISON_NGUNJIRI	0:0898e006947b	2852
EDISON_NGUNJIRI	0:0898e006947b	2853	_writeData(data & 0x1F); // Set Icon pattern, no blink support (Instr Set 1)
EDISON_NGUNJIRI	0:0898e006947b	2854
EDISON_NGUNJIRI	0:0898e006947b	2855	_writeCommand(0x20 \| _function); // Set function, IS2,IS1 = 00 (Select Instr Set = 0)
EDISON_NGUNJIRI	0:0898e006947b	2856	// Select Std Instr set, Select IS=0
EDISON_NGUNJIRI	0:0898e006947b	2857	break; // end ST7036
EDISON_NGUNJIRI	0:0898e006947b	2858
EDISON_NGUNJIRI	0:0898e006947b	2859	case SSD1803_3V3:
EDISON_NGUNJIRI	0:0898e006947b	2860	// case SSD1803_5V:
EDISON_NGUNJIRI	0:0898e006947b	2861	_writeCommand(0x20 \| _function \| 0x01); // Set function, 0 0 1 DL N DH RE(0) IS
EDISON_NGUNJIRI	0:0898e006947b	2862	// Select Instruction Set 1
EDISON_NGUNJIRI	0:0898e006947b	2863	_writeCommand(0x40 \| (idx & 0x0F)); // Set Icon Address, mask Address to valid range (Instr Set = 1)
EDISON_NGUNJIRI	0:0898e006947b	2864	_writeData(data); // Set Icon pattern (Instr Set = 1)
EDISON_NGUNJIRI	0:0898e006947b	2865
EDISON_NGUNJIRI	0:0898e006947b	2866	_writeCommand(0x20 \| _function); // Set function, 0 0 1 DL N DH RE(0) IS
EDISON_NGUNJIRI	0:0898e006947b	2867	// Select IS=0
EDISON_NGUNJIRI	0:0898e006947b	2868	break; // end SSD1803
EDISON_NGUNJIRI	0:0898e006947b	2869
EDISON_NGUNJIRI	0:0898e006947b	2870	case PCF2103_3V3:
EDISON_NGUNJIRI	0:0898e006947b	2871	case PCF2113_3V3:
EDISON_NGUNJIRI	0:0898e006947b	2872	case PCF2119_3V3:
EDISON_NGUNJIRI	0:0898e006947b	2873	case PCF2119R_3V3:
EDISON_NGUNJIRI	0:0898e006947b	2874	// Store UDC/Icon pattern for PCF2103 and PCF2113:
EDISON_NGUNJIRI	0:0898e006947b	2875	// 3 x 8 rows x 5 bits = 120 bits for Normal pattern (UDC 0..2) and
EDISON_NGUNJIRI	0:0898e006947b	2876	// 3 x 8 rows x 5 bits = 120 bits for Blink pattern (UDC 4..6)
EDISON_NGUNJIRI	0:0898e006947b	2877	// Store UDC/Icon pattern for PCF2119:
EDISON_NGUNJIRI	0:0898e006947b	2878	// 4 x 8 rows x 5 bits = 160 bits for Normal pattern (UDC 0..3) and
EDISON_NGUNJIRI	0:0898e006947b	2879	// 4 x 8 rows x 5 bits = 160 bits for Blink pattern (UDC 4..7)
EDISON_NGUNJIRI	0:0898e006947b	2880	_writeCommand(0x40 \| (idx & 0x3F)); //Set CG-RAM address, 8 sequential locations needed per UDC
EDISON_NGUNJIRI	0:0898e006947b	2881	_writeData(data); // Set Icon pattern (Instr Set = 1)
EDISON_NGUNJIRI	0:0898e006947b	2882	break; // case PCF2103_3V3 Controller
EDISON_NGUNJIRI	0:0898e006947b	2883
EDISON_NGUNJIRI	0:0898e006947b	2884	default:
EDISON_NGUNJIRI	0:0898e006947b	2885	break; // end default
EDISON_NGUNJIRI	0:0898e006947b	2886	} // end switch _ctrl
EDISON_NGUNJIRI	0:0898e006947b	2887
EDISON_NGUNJIRI	0:0898e006947b	2888	//Select DD RAM again for current LCD controller and restore the addresspointer
EDISON_NGUNJIRI	0:0898e006947b	2889	int addr = getAddress(_column, _row);
EDISON_NGUNJIRI	0:0898e006947b	2890	_writeCommand(0x80 \| addr);
EDISON_NGUNJIRI	0:0898e006947b	2891
EDISON_NGUNJIRI	0:0898e006947b	2892	} // end setIcon()
EDISON_NGUNJIRI	0:0898e006947b	2893
EDISON_NGUNJIRI	0:0898e006947b	2894	/** Clear Icons
EDISON_NGUNJIRI	0:0898e006947b	2895	*
EDISON_NGUNJIRI	0:0898e006947b	2896	* @param none
EDISON_NGUNJIRI	0:0898e006947b	2897	* @return none
EDISON_NGUNJIRI	0:0898e006947b	2898	*/
EDISON_NGUNJIRI	0:0898e006947b	2899	//@TODO Add support for 40x4 dual controller
EDISON_NGUNJIRI	0:0898e006947b	2900	void TextLCD_Base::clrIcon() {
EDISON_NGUNJIRI	0:0898e006947b	2901	// Icons are defined by a byte bitpattern. The P0..P5 form the Icon pattern for KS0073, and P0..P4 for KS0078
EDISON_NGUNJIRI	0:0898e006947b	2902	// P7 P6 P5 P4 P3 P2 P1 P0
EDISON_NGUNJIRI	0:0898e006947b	2903	// 0 B1 B0 0 0 0 0 0 0
EDISON_NGUNJIRI	0:0898e006947b	2904	// 1 B1 B0 0 0 0 0 0 0
EDISON_NGUNJIRI	0:0898e006947b	2905	// .............
EDISON_NGUNJIRI	0:0898e006947b	2906	// 15 B1 B0 0 0 0 0 0 0
EDISON_NGUNJIRI	0:0898e006947b	2907	//
EDISON_NGUNJIRI	0:0898e006947b	2908	// Bit 6 and Bit 7 in the pattern will control the blinking mode when Blink is enabled through BE.
EDISON_NGUNJIRI	0:0898e006947b	2909	// B1 B0 Mode
EDISON_NGUNJIRI	0:0898e006947b	2910	// 0 0 No Blinking for this icon row
EDISON_NGUNJIRI	0:0898e006947b	2911	// 0 1 Enabled pixels in P5 will blink
EDISON_NGUNJIRI	0:0898e006947b	2912	// 1 x Enabled pixels in P0..P5 will blink
EDISON_NGUNJIRI	0:0898e006947b	2913	//
EDISON_NGUNJIRI	0:0898e006947b	2914	// Note: the PCF2103 and PCF2113 use UDCs to set Icons
EDISON_NGUNJIRI	0:0898e006947b	2915	// 3 x 8 rows x 5 bits = 120 bits Icons for Normal pattern (UDC 0..2) and
EDISON_NGUNJIRI	0:0898e006947b	2916	// 3 x 8 rows x 5 bits = 120 bits Icons for Blink pattern (UDC 4..6)
EDISON_NGUNJIRI	0:0898e006947b	2917	// Note: the PCF2119 uses UDCs to set Icons
EDISON_NGUNJIRI	0:0898e006947b	2918	// 4 x 8 rows x 5 bits = 160 bits Icons for Normal pattern (UDC 0..3) and
EDISON_NGUNJIRI	0:0898e006947b	2919	// 4 x 8 rows x 5 bits = 160 bits Icons for Blink pattern (UDC 4..7)
EDISON_NGUNJIRI	0:0898e006947b	2920	int idx;
EDISON_NGUNJIRI	0:0898e006947b	2921
EDISON_NGUNJIRI	0:0898e006947b	2922	switch (_ctrl) {
EDISON_NGUNJIRI	0:0898e006947b	2923	case KS0073:
EDISON_NGUNJIRI	0:0898e006947b	2924	case KS0078:
EDISON_NGUNJIRI	0:0898e006947b	2925	_writeCommand(0x20 \| _function_1); // Set function, 0 0 1 DL N RE(1) BE LP
EDISON_NGUNJIRI	0:0898e006947b	2926	// Select Extended Instruction Set
EDISON_NGUNJIRI	0:0898e006947b	2927	for (idx=0; idx<16; idx++) {
EDISON_NGUNJIRI	0:0898e006947b	2928	_writeCommand(0x40 \| idx); // Set Icon Address, mask Address to valid range (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	2929	_writeData(0x00); // Clear Icon pattern (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	2930	}
EDISON_NGUNJIRI	0:0898e006947b	2931	_writeCommand(0x20 \| _function); // Set function, 0 0 1 DL N RE(0) DH REV Select Std Instruction Set
EDISON_NGUNJIRI	0:0898e006947b	2932	// Select Std Instr set
EDISON_NGUNJIRI	0:0898e006947b	2933	break; // end KS0073, KS0078
EDISON_NGUNJIRI	0:0898e006947b	2934
EDISON_NGUNJIRI	0:0898e006947b	2935	case ST7032_3V3:
EDISON_NGUNJIRI	0:0898e006947b	2936	case ST7032_5V:
EDISON_NGUNJIRI	0:0898e006947b	2937	case SPLC792A_3V3:
EDISON_NGUNJIRI	0:0898e006947b	2938	_writeCommand(0x20 \| _function \| 0x01); // Set function, 0 0 1 DL N F 0 IS=1 Select Instr Set = 1
EDISON_NGUNJIRI	0:0898e006947b	2939
EDISON_NGUNJIRI	0:0898e006947b	2940	for (idx=0; idx<16; idx++) {
EDISON_NGUNJIRI	0:0898e006947b	2941	_writeCommand(0x40 \| idx); // Set Icon Address, mask Address to valid range (Instr Set 1)
EDISON_NGUNJIRI	0:0898e006947b	2942	_writeData(0x00); // Clear Icon pattern (Instr Set 1)
EDISON_NGUNJIRI	0:0898e006947b	2943	}
EDISON_NGUNJIRI	0:0898e006947b	2944
EDISON_NGUNJIRI	0:0898e006947b	2945	_writeCommand(0x20 \| _function); // Set function, 0 0 1 DL N RE(0) DH REV Select Instruction Set 0
EDISON_NGUNJIRI	0:0898e006947b	2946	// Select Std Instr set, Select IS=0
EDISON_NGUNJIRI	0:0898e006947b	2947	break; // end ST7032
EDISON_NGUNJIRI	0:0898e006947b	2948
EDISON_NGUNJIRI	0:0898e006947b	2949	case ST7036_3V3:
EDISON_NGUNJIRI	0:0898e006947b	2950	case ST7036_5V:
EDISON_NGUNJIRI	0:0898e006947b	2951	_writeCommand(0x20 \| _function \| 0x01); // Set function, 0 0 1 DL N DH IS2,IS1 = 01 (Select Instr Set = 1)
EDISON_NGUNJIRI	0:0898e006947b	2952
EDISON_NGUNJIRI	0:0898e006947b	2953	for (idx=0; idx<16; idx++) {
EDISON_NGUNJIRI	0:0898e006947b	2954	_writeCommand(0x40 \| idx); // Set Icon Address, mask Address to valid range (Instr Set 1)
EDISON_NGUNJIRI	0:0898e006947b	2955	_writeData(0x00); // Clear Icon pattern (Instr Set 1)
EDISON_NGUNJIRI	0:0898e006947b	2956	}
EDISON_NGUNJIRI	0:0898e006947b	2957
EDISON_NGUNJIRI	0:0898e006947b	2958	_writeCommand(0x20 \| _function); // Set function, IS2,IS1 = 00 (Select Instr Set = 0)
EDISON_NGUNJIRI	0:0898e006947b	2959	// Select Std Instr set, Select IS=0
EDISON_NGUNJIRI	0:0898e006947b	2960	break; // end ST7036
EDISON_NGUNJIRI	0:0898e006947b	2961
EDISON_NGUNJIRI	0:0898e006947b	2962	case SSD1803_3V3:
EDISON_NGUNJIRI	0:0898e006947b	2963	// case SSD1803_5V:
EDISON_NGUNJIRI	0:0898e006947b	2964	_writeCommand(0x20 \| _function \| 0x01); // Set function, 0 0 1 DL N DH RE(0) IS
EDISON_NGUNJIRI	0:0898e006947b	2965	// Select Instruction Set 1
EDISON_NGUNJIRI	0:0898e006947b	2966	for (idx=0; idx<16; idx++) {
EDISON_NGUNJIRI	0:0898e006947b	2967	_writeCommand(0x40 \| idx); // Set Icon Address, mask Address to valid range (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	2968	_writeData(0x00); // Clear Icon pattern (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	2969	}
EDISON_NGUNJIRI	0:0898e006947b	2970	_writeCommand(0x20 \| _function); // Set function, 0 0 1 DL N DH RE(0) IS
EDISON_NGUNJIRI	0:0898e006947b	2971	// Select IS=0
EDISON_NGUNJIRI	0:0898e006947b	2972	break; // end SSD1803
EDISON_NGUNJIRI	0:0898e006947b	2973
EDISON_NGUNJIRI	0:0898e006947b	2974	case PCF2103_3V3:
EDISON_NGUNJIRI	0:0898e006947b	2975	case PCF2113_3V3:
EDISON_NGUNJIRI	0:0898e006947b	2976	// PCF2103 and PCF2113 use part of the UDC RAM to control Icons
EDISON_NGUNJIRI	0:0898e006947b	2977	// Select CG RAM
EDISON_NGUNJIRI	0:0898e006947b	2978
EDISON_NGUNJIRI	0:0898e006947b	2979	_writeCommand(0x40 \| (0 * 8)); //Set CG-RAM address, 8 sequential locations needed per UDC
EDISON_NGUNJIRI	0:0898e006947b	2980	// Store UDC/Icon pattern:
EDISON_NGUNJIRI	0:0898e006947b	2981	// 3 x 8 rows x 5 bits = 120 bits for Normal pattern (UDC 0..2) and
EDISON_NGUNJIRI	0:0898e006947b	2982	for (int i=0; i<(3 * 8); i++) {
EDISON_NGUNJIRI	0:0898e006947b	2983	// _writeData(0x1F); // All On
EDISON_NGUNJIRI	0:0898e006947b	2984	_writeData(0x00); // All Off
EDISON_NGUNJIRI	0:0898e006947b	2985	}
EDISON_NGUNJIRI	0:0898e006947b	2986
EDISON_NGUNJIRI	0:0898e006947b	2987	_writeCommand(0x40 \| (4 * 8)); //Set CG-RAM address, 8 sequential locations needed per UDC
EDISON_NGUNJIRI	0:0898e006947b	2988	// 3 x 8 rows x 5 bits = 120 bits for Blink pattern (UDC 4..6)
EDISON_NGUNJIRI	0:0898e006947b	2989	for (int i=0; i<(3 * 8); i++) {
EDISON_NGUNJIRI	0:0898e006947b	2990	// _writeData(0x1F); // All On
EDISON_NGUNJIRI	0:0898e006947b	2991	_writeData(0x00); // All Off
EDISON_NGUNJIRI	0:0898e006947b	2992	}
EDISON_NGUNJIRI	0:0898e006947b	2993	break; // case PCF2103_3V3 Controller
EDISON_NGUNJIRI	0:0898e006947b	2994
EDISON_NGUNJIRI	0:0898e006947b	2995	case PCF2119_3V3:
EDISON_NGUNJIRI	0:0898e006947b	2996	case PCF2119R_3V3:
EDISON_NGUNJIRI	0:0898e006947b	2997	// PCF2119 uses part of the UDC RAM to control Icons
EDISON_NGUNJIRI	0:0898e006947b	2998	// Select CG RAM
EDISON_NGUNJIRI	0:0898e006947b	2999
EDISON_NGUNJIRI	0:0898e006947b	3000	_writeCommand(0x40 \| (0 * 8)); //Set CG-RAM address, 8 sequential locations needed per UDC
EDISON_NGUNJIRI	0:0898e006947b	3001	// Store UDC/Icon pattern:
EDISON_NGUNJIRI	0:0898e006947b	3002	// 4 x 8 rows x 5 bits = 160 bits for Normal pattern (UDC 0..3) and
EDISON_NGUNJIRI	0:0898e006947b	3003	for (int i=0; i<(4 * 8); i++) {
EDISON_NGUNJIRI	0:0898e006947b	3004	// _writeData(0x1F); // All On
EDISON_NGUNJIRI	0:0898e006947b	3005	_writeData(0x00); // All Off
EDISON_NGUNJIRI	0:0898e006947b	3006	}
EDISON_NGUNJIRI	0:0898e006947b	3007
EDISON_NGUNJIRI	0:0898e006947b	3008	_writeCommand(0x40 \| (4 * 8)); //Set CG-RAM address, 8 sequential locations needed per UDC
EDISON_NGUNJIRI	0:0898e006947b	3009	// 4 x 8 rows x 5 bits = 160 bits for Blink pattern (UDC 4..7)
EDISON_NGUNJIRI	0:0898e006947b	3010	for (int i=0; i<(4 * 8); i++) {
EDISON_NGUNJIRI	0:0898e006947b	3011	// _writeData(0x1F); // All On
EDISON_NGUNJIRI	0:0898e006947b	3012	_writeData(0x00); // All Off
EDISON_NGUNJIRI	0:0898e006947b	3013	}
EDISON_NGUNJIRI	0:0898e006947b	3014	break; // case PCF2119_3V3 Controller
EDISON_NGUNJIRI	0:0898e006947b	3015
EDISON_NGUNJIRI	0:0898e006947b	3016	default:
EDISON_NGUNJIRI	0:0898e006947b	3017	break; // end default
EDISON_NGUNJIRI	0:0898e006947b	3018	} // end switch _ctrl
EDISON_NGUNJIRI	0:0898e006947b	3019
EDISON_NGUNJIRI	0:0898e006947b	3020	//Select DD RAM again for current LCD controller and restore the addresspointer
EDISON_NGUNJIRI	0:0898e006947b	3021	int addr = getAddress(_column, _row);
EDISON_NGUNJIRI	0:0898e006947b	3022	_writeCommand(0x80 \| addr);
EDISON_NGUNJIRI	0:0898e006947b	3023	} //end clrIcon()
EDISON_NGUNJIRI	0:0898e006947b	3024	#endif
EDISON_NGUNJIRI	0:0898e006947b	3025
EDISON_NGUNJIRI	0:0898e006947b	3026	#if(LCD_INVERT == 1)
EDISON_NGUNJIRI	0:0898e006947b	3027	/** Set Invert
EDISON_NGUNJIRI	0:0898e006947b	3028	* setInvert method is supported by some compatible devices (eg KS0073) to swap between black and white
EDISON_NGUNJIRI	0:0898e006947b	3029	*
EDISON_NGUNJIRI	0:0898e006947b	3030	* @param bool invertOn Invert on/off
EDISON_NGUNJIRI	0:0898e006947b	3031	* @return none
EDISON_NGUNJIRI	0:0898e006947b	3032	*/
EDISON_NGUNJIRI	0:0898e006947b	3033	//@TODO Add support for 40x4 dual controller
EDISON_NGUNJIRI	0:0898e006947b	3034	void TextLCD_Base::setInvert(bool invertOn) {
EDISON_NGUNJIRI	0:0898e006947b	3035
EDISON_NGUNJIRI	0:0898e006947b	3036	if (invertOn) {
EDISON_NGUNJIRI	0:0898e006947b	3037	// Controllers that support Invert
EDISON_NGUNJIRI	0:0898e006947b	3038	switch (_ctrl) {
EDISON_NGUNJIRI	0:0898e006947b	3039	case KS0073:
EDISON_NGUNJIRI	0:0898e006947b	3040	case KS0078:
EDISON_NGUNJIRI	0:0898e006947b	3041	_function = _function \| 0x01; // Enable Invert
EDISON_NGUNJIRI	0:0898e006947b	3042	_writeCommand(0x20 \| _function); // Activate Invert (Std Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	3043	break;
EDISON_NGUNJIRI	0:0898e006947b	3044	case SSD1803_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	3045	// case SSD1803_5V :
EDISON_NGUNJIRI	0:0898e006947b	3046	case US2066_3V3:
EDISON_NGUNJIRI	0:0898e006947b	3047	// case USS2066_5V:
EDISON_NGUNJIRI	0:0898e006947b	3048	_function_1 = _function_1 \| 0x01; // Enable Invert
EDISON_NGUNJIRI	0:0898e006947b	3049	// Set function, 0 0 1 DL N BE RE(1) REV (SSD1803)
EDISON_NGUNJIRI	0:0898e006947b	3050	// Set function, 0 0 1 X N BE RE(1) REV (US2066)
EDISON_NGUNJIRI	0:0898e006947b	3051	_writeCommand(0x20 \| _function_1); // Activate Invert (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	3052	_writeCommand(0x20 \| _function); // Return to Std Instr Set
EDISON_NGUNJIRI	0:0898e006947b	3053	break;
EDISON_NGUNJIRI	0:0898e006947b	3054	default:
EDISON_NGUNJIRI	0:0898e006947b	3055	//Unsupported feature for other controllers
EDISON_NGUNJIRI	0:0898e006947b	3056	break;
EDISON_NGUNJIRI	0:0898e006947b	3057	} // end switch
EDISON_NGUNJIRI	0:0898e006947b	3058	}
EDISON_NGUNJIRI	0:0898e006947b	3059	else {
EDISON_NGUNJIRI	0:0898e006947b	3060	// Controllers that support Invert
EDISON_NGUNJIRI	0:0898e006947b	3061	switch (_ctrl) {
EDISON_NGUNJIRI	0:0898e006947b	3062	case KS0073:
EDISON_NGUNJIRI	0:0898e006947b	3063	case KS0078:
EDISON_NGUNJIRI	0:0898e006947b	3064	_function = _function & ~0x01; // Disable Invert
EDISON_NGUNJIRI	0:0898e006947b	3065	_writeCommand(0x20 \| _function); // Disable Invert (Std Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	3066	break;
EDISON_NGUNJIRI	0:0898e006947b	3067	case SSD1803_3V3 :
EDISON_NGUNJIRI	0:0898e006947b	3068	// case SSD1803_5V :
EDISON_NGUNJIRI	0:0898e006947b	3069	case US2066_3V3:
EDISON_NGUNJIRI	0:0898e006947b	3070	// case USS2066_5V:
EDISON_NGUNJIRI	0:0898e006947b	3071	_function_1 = _function_1 & ~0x01; // Disable Invert
EDISON_NGUNJIRI	0:0898e006947b	3072	// Set function, 0 0 1 DL N BE RE(1) REV (SSD1803)
EDISON_NGUNJIRI	0:0898e006947b	3073	// Set function, 0 0 1 X N BE RE(1) REV (US2066)
EDISON_NGUNJIRI	0:0898e006947b	3074	_writeCommand(0x20 \| _function_1); // Activate Invert (Ext Instr Set)
EDISON_NGUNJIRI	0:0898e006947b	3075	_writeCommand(0x20 \| _function); // Return to Std Instr Set
EDISON_NGUNJIRI	0:0898e006947b	3076	break;
EDISON_NGUNJIRI	0:0898e006947b	3077
EDISON_NGUNJIRI	0:0898e006947b	3078	default:
EDISON_NGUNJIRI	0:0898e006947b	3079	//Unsupported feature for other controllers
EDISON_NGUNJIRI	0:0898e006947b	3080	break;
EDISON_NGUNJIRI	0:0898e006947b	3081	} // end switch
EDISON_NGUNJIRI	0:0898e006947b	3082	}
EDISON_NGUNJIRI	0:0898e006947b	3083	} // end setInvert()
EDISON_NGUNJIRI	0:0898e006947b	3084	#endif
EDISON_NGUNJIRI	0:0898e006947b	3085
EDISON_NGUNJIRI	0:0898e006947b	3086	//--------- End TextLCD_Base -----------
EDISON_NGUNJIRI	0:0898e006947b	3087
EDISON_NGUNJIRI	0:0898e006947b	3088
EDISON_NGUNJIRI	0:0898e006947b	3089	//--------- Start TextLCD Bus -----------
EDISON_NGUNJIRI	0:0898e006947b	3090
EDISON_NGUNJIRI	0:0898e006947b	3091	/* Create a TextLCD interface for using regular mbed pins
EDISON_NGUNJIRI	0:0898e006947b	3092	*
EDISON_NGUNJIRI	0:0898e006947b	3093	* @param rs Instruction/data control line
EDISON_NGUNJIRI	0:0898e006947b	3094	* @param e Enable line (clock)
EDISON_NGUNJIRI	0:0898e006947b	3095	* @param d4-d7 Data lines for using as a 4-bit interface
EDISON_NGUNJIRI	0:0898e006947b	3096	* @param type Sets the panel size/addressing mode (default = LCD16x2)
EDISON_NGUNJIRI	0:0898e006947b	3097	* @param bl Backlight control line (optional, default = NC)
EDISON_NGUNJIRI	0:0898e006947b	3098	* @param e2 Enable2 line (clock for second controller, LCD40x4 only)
EDISON_NGUNJIRI	0:0898e006947b	3099	* @param ctrl LCD controller (default = HD44780)
EDISON_NGUNJIRI	0:0898e006947b	3100	*/
EDISON_NGUNJIRI	0:0898e006947b	3101	TextLCD::TextLCD(PinName rs, PinName e,
EDISON_NGUNJIRI	0:0898e006947b	3102	PinName d4, PinName d5, PinName d6, PinName d7,
EDISON_NGUNJIRI	0:0898e006947b	3103	LCDType type, PinName bl, PinName e2, LCDCtrl ctrl) :
EDISON_NGUNJIRI	0:0898e006947b	3104	TextLCD_Base(type, ctrl),
EDISON_NGUNJIRI	0:0898e006947b	3105	_rs(rs), _e(e), _d(d4, d5, d6, d7) {
EDISON_NGUNJIRI	0:0898e006947b	3106
EDISON_NGUNJIRI	0:0898e006947b	3107	// The hardware Backlight pin is optional. Test and make sure whether it exists or not to prevent illegal access.
EDISON_NGUNJIRI	0:0898e006947b	3108	if (bl != NC) {
EDISON_NGUNJIRI	0:0898e006947b	3109	_bl = new DigitalOut(bl); //Construct new pin
EDISON_NGUNJIRI	0:0898e006947b	3110	_bl->write(0); //Deactivate
EDISON_NGUNJIRI	0:0898e006947b	3111	}
EDISON_NGUNJIRI	0:0898e006947b	3112	else {
EDISON_NGUNJIRI	0:0898e006947b	3113	// No Hardware Backlight pin
EDISON_NGUNJIRI	0:0898e006947b	3114	_bl = NULL; //Construct dummy pin
EDISON_NGUNJIRI	0:0898e006947b	3115	}
EDISON_NGUNJIRI	0:0898e006947b	3116
EDISON_NGUNJIRI	0:0898e006947b	3117	// The hardware Enable2 pin is only needed for LCD40x4. Test and make sure whether it exists or not to prevent illegal access.
EDISON_NGUNJIRI	0:0898e006947b	3118	if (e2 != NC) {
EDISON_NGUNJIRI	0:0898e006947b	3119	_e2 = new DigitalOut(e2); //Construct new pin
EDISON_NGUNJIRI	0:0898e006947b	3120	_e2->write(0); //Deactivate
EDISON_NGUNJIRI	0:0898e006947b	3121	}
EDISON_NGUNJIRI	0:0898e006947b	3122	else {
EDISON_NGUNJIRI	0:0898e006947b	3123	// No Hardware Enable pin
EDISON_NGUNJIRI	0:0898e006947b	3124	_e2 = NULL; //Construct dummy pin
EDISON_NGUNJIRI	0:0898e006947b	3125	}
EDISON_NGUNJIRI	0:0898e006947b	3126
EDISON_NGUNJIRI	0:0898e006947b	3127	_init(_LCD_DL_4); // Set Datalength to 4 bit for mbed bus interfaces
EDISON_NGUNJIRI	0:0898e006947b	3128	}
EDISON_NGUNJIRI	0:0898e006947b	3129
EDISON_NGUNJIRI	0:0898e006947b	3130	/** Destruct a TextLCD interface for using regular mbed pins
EDISON_NGUNJIRI	0:0898e006947b	3131	*
EDISON_NGUNJIRI	0:0898e006947b	3132	* @param none
EDISON_NGUNJIRI	0:0898e006947b	3133	* @return none
EDISON_NGUNJIRI	0:0898e006947b	3134	*/
EDISON_NGUNJIRI	0:0898e006947b	3135	TextLCD::~TextLCD() {
EDISON_NGUNJIRI	0:0898e006947b	3136	if (_bl != NULL) {delete _bl;} // BL pin
EDISON_NGUNJIRI	0:0898e006947b	3137	if (_e2 != NULL) {delete _e2;} // E2 pin
EDISON_NGUNJIRI	0:0898e006947b	3138	}
EDISON_NGUNJIRI	0:0898e006947b	3139
EDISON_NGUNJIRI	0:0898e006947b	3140	/** Set E pin (or E2 pin)
EDISON_NGUNJIRI	0:0898e006947b	3141	* Used for mbed pins, I2C bus expander or SPI shiftregister
EDISON_NGUNJIRI	0:0898e006947b	3142	* Default PinName value for E2 is NC, must be used as pointer to avoid issues with mbed lib and DigitalOut pins
EDISON_NGUNJIRI	0:0898e006947b	3143	* @param value true or false
EDISON_NGUNJIRI	0:0898e006947b	3144	* @return none
EDISON_NGUNJIRI	0:0898e006947b	3145	*/
EDISON_NGUNJIRI	0:0898e006947b	3146	void TextLCD::_setEnable(bool value) {
EDISON_NGUNJIRI	0:0898e006947b	3147
EDISON_NGUNJIRI	0:0898e006947b	3148	if(_ctrl_idx==_LCDCtrl_0) {
EDISON_NGUNJIRI	0:0898e006947b	3149	if (value) {
EDISON_NGUNJIRI	0:0898e006947b	3150	_e = 1; // Set E bit
EDISON_NGUNJIRI	0:0898e006947b	3151	}
EDISON_NGUNJIRI	0:0898e006947b	3152	else {
EDISON_NGUNJIRI	0:0898e006947b	3153	_e = 0; // Reset E bit
EDISON_NGUNJIRI	0:0898e006947b	3154	}
EDISON_NGUNJIRI	0:0898e006947b	3155	}
EDISON_NGUNJIRI	0:0898e006947b	3156	else {
EDISON_NGUNJIRI	0:0898e006947b	3157	if (value) {
EDISON_NGUNJIRI	0:0898e006947b	3158	if (_e2 != NULL) {_e2->write(1);} //Set E2 bit
EDISON_NGUNJIRI	0:0898e006947b	3159	}
EDISON_NGUNJIRI	0:0898e006947b	3160	else {
EDISON_NGUNJIRI	0:0898e006947b	3161	if (_e2 != NULL) {_e2->write(0);} //Reset E2 bit
EDISON_NGUNJIRI	0:0898e006947b	3162	}
EDISON_NGUNJIRI	0:0898e006947b	3163	}
EDISON_NGUNJIRI	0:0898e006947b	3164	}
EDISON_NGUNJIRI	0:0898e006947b	3165
EDISON_NGUNJIRI	0:0898e006947b	3166	// Set RS pin
EDISON_NGUNJIRI	0:0898e006947b	3167	// Used for mbed pins, I2C bus expander or SPI shiftregister
EDISON_NGUNJIRI	0:0898e006947b	3168	void TextLCD::_setRS(bool value) {
EDISON_NGUNJIRI	0:0898e006947b	3169
EDISON_NGUNJIRI	0:0898e006947b	3170	if (value) {
EDISON_NGUNJIRI	0:0898e006947b	3171	_rs = 1; // Set RS bit
EDISON_NGUNJIRI	0:0898e006947b	3172	}
EDISON_NGUNJIRI	0:0898e006947b	3173	else {
EDISON_NGUNJIRI	0:0898e006947b	3174	_rs = 0; // Reset RS bit
EDISON_NGUNJIRI	0:0898e006947b	3175	}
EDISON_NGUNJIRI	0:0898e006947b	3176	}
EDISON_NGUNJIRI	0:0898e006947b	3177
EDISON_NGUNJIRI	0:0898e006947b	3178	/** Set BL pin
EDISON_NGUNJIRI	0:0898e006947b	3179	* Used for mbed pins, I2C bus expander or SPI shiftregister
EDISON_NGUNJIRI	0:0898e006947b	3180	* Default PinName value is NC, must be used as pointer to avoid issues with mbed lib and DigitalOut pins
EDISON_NGUNJIRI	0:0898e006947b	3181	* @param value true or false
EDISON_NGUNJIRI	0:0898e006947b	3182	* @return none
EDISON_NGUNJIRI	0:0898e006947b	3183	*/
EDISON_NGUNJIRI	0:0898e006947b	3184	void TextLCD::_setBL(bool value) {
EDISON_NGUNJIRI	0:0898e006947b	3185
EDISON_NGUNJIRI	0:0898e006947b	3186	if (value) {
EDISON_NGUNJIRI	0:0898e006947b	3187	if (_bl != NULL) {_bl->write(1);} //Set BL bit
EDISON_NGUNJIRI	0:0898e006947b	3188	}
EDISON_NGUNJIRI	0:0898e006947b	3189	else {
EDISON_NGUNJIRI	0:0898e006947b	3190	if (_bl != NULL) {_bl->write(0);} //Reset BL bit
EDISON_NGUNJIRI	0:0898e006947b	3191	}
EDISON_NGUNJIRI	0:0898e006947b	3192	}
EDISON_NGUNJIRI	0:0898e006947b	3193
EDISON_NGUNJIRI	0:0898e006947b	3194	// Place the 4bit data on the databus
EDISON_NGUNJIRI	0:0898e006947b	3195	// Used for mbed pins, I2C bus expander or SPI shifregister
EDISON_NGUNJIRI	0:0898e006947b	3196	void TextLCD::_setData(int value) {
EDISON_NGUNJIRI	0:0898e006947b	3197	_d = value & 0x0F; // Write Databits
EDISON_NGUNJIRI	0:0898e006947b	3198	}
EDISON_NGUNJIRI	0:0898e006947b	3199
EDISON_NGUNJIRI	0:0898e006947b	3200	//----------- End TextLCD ---------------
EDISON_NGUNJIRI	0:0898e006947b	3201
EDISON_NGUNJIRI	0:0898e006947b	3202
EDISON_NGUNJIRI	0:0898e006947b	3203	//--------- Start TextLCD_I2C -----------
EDISON_NGUNJIRI	0:0898e006947b	3204	#if(LCD_I2C == 1) /* I2C Expander PCF8574/MCP23008 */
EDISON_NGUNJIRI	0:0898e006947b	3205	/** Create a TextLCD interface using an I2C PC8574 (or PCF8574A) or MCP23008 portexpander
EDISON_NGUNJIRI	0:0898e006947b	3206	*
EDISON_NGUNJIRI	0:0898e006947b	3207	* @param i2c I2C Bus
EDISON_NGUNJIRI	0:0898e006947b	3208	* @param deviceAddress I2C slave address (PCF8574, PCF8574A or MCP23008, default = 0x40)
EDISON_NGUNJIRI	0:0898e006947b	3209	* @param type Sets the panel size/addressing mode (default = LCD16x2)
EDISON_NGUNJIRI	0:0898e006947b	3210	* @param ctrl LCD controller (default = HD44780)
EDISON_NGUNJIRI	0:0898e006947b	3211	*/
EDISON_NGUNJIRI	0:0898e006947b	3212	TextLCD_I2C::TextLCD_I2C(I2C *i2c, char deviceAddress, LCDType type, LCDCtrl ctrl) :
EDISON_NGUNJIRI	0:0898e006947b	3213	TextLCD_Base(type, ctrl),
EDISON_NGUNJIRI	0:0898e006947b	3214	_i2c(i2c){
EDISON_NGUNJIRI	0:0898e006947b	3215
EDISON_NGUNJIRI	0:0898e006947b	3216	_slaveAddress = deviceAddress & 0xFE;
EDISON_NGUNJIRI	0:0898e006947b	3217
EDISON_NGUNJIRI	0:0898e006947b	3218	// Setup the I2C bus
EDISON_NGUNJIRI	0:0898e006947b	3219	// The max bitrate for PCF8574 is 100kbit, the max bitrate for MCP23008 is 400kbit,
EDISON_NGUNJIRI	0:0898e006947b	3220	_i2c->frequency(100000);
EDISON_NGUNJIRI	0:0898e006947b	3221
EDISON_NGUNJIRI	0:0898e006947b	3222	#if (MCP23008==1)
EDISON_NGUNJIRI	0:0898e006947b	3223	// MCP23008 portexpander Init
EDISON_NGUNJIRI	0:0898e006947b	3224	_writeRegister(IODIR, 0x00); // All pins are outputs
EDISON_NGUNJIRI	0:0898e006947b	3225	_writeRegister(IPOL, 0x00); // No reverse polarity on inputs
EDISON_NGUNJIRI	0:0898e006947b	3226	_writeRegister(GPINTEN, 0x00); // No interrupt on change of input pins
EDISON_NGUNJIRI	0:0898e006947b	3227	_writeRegister(DEFVAL, 0x00); // Default value to compare against for interrupts
EDISON_NGUNJIRI	0:0898e006947b	3228	_writeRegister(INTCON, 0x00); // No interrupt on changes, compare against previous pin value
EDISON_NGUNJIRI	0:0898e006947b	3229	_writeRegister(IOCON, 0x20); // b1=0 - Interrupt polarity active low
EDISON_NGUNJIRI	0:0898e006947b	3230	// b2=0 - Interrupt pin active driver output
EDISON_NGUNJIRI	0:0898e006947b	3231	// b4=0 - Slew rate enable on SDA
EDISON_NGUNJIRI	0:0898e006947b	3232	// b5=0 - Auto-increment on registeraddress
EDISON_NGUNJIRI	0:0898e006947b	3233	// b5=1 - No auto-increment on registeraddress => needed for performance improved I2C expander mode
EDISON_NGUNJIRI	0:0898e006947b	3234	_writeRegister(GPPU, 0x00); // No Pullup
EDISON_NGUNJIRI	0:0898e006947b	3235	// INTF // Interrupt flags read (Read-Only)
EDISON_NGUNJIRI	0:0898e006947b	3236	// INTCAP // Captured inputpins at time of interrupt (Read-Only)
EDISON_NGUNJIRI	0:0898e006947b	3237	// _writeRegister(GPIO, 0x00); // Output/Input pins
EDISON_NGUNJIRI	0:0898e006947b	3238	// _writeRegister(OLAT, 0x00); // Output Latch
EDISON_NGUNJIRI	0:0898e006947b	3239
EDISON_NGUNJIRI	0:0898e006947b	3240	// Init the portexpander bus
EDISON_NGUNJIRI	0:0898e006947b	3241	_lcd_bus = LCD_BUS_I2C_DEF;
EDISON_NGUNJIRI	0:0898e006947b	3242
EDISON_NGUNJIRI	0:0898e006947b	3243	// write the new data to the portexpander
EDISON_NGUNJIRI	0:0898e006947b	3244	_writeRegister(GPIO, _lcd_bus);
EDISON_NGUNJIRI	0:0898e006947b	3245	#else
EDISON_NGUNJIRI	0:0898e006947b	3246	// PCF8574 of PCF8574A portexpander
EDISON_NGUNJIRI	0:0898e006947b	3247
EDISON_NGUNJIRI	0:0898e006947b	3248	// Init the portexpander bus
EDISON_NGUNJIRI	0:0898e006947b	3249	_lcd_bus = LCD_BUS_I2C_DEF;
EDISON_NGUNJIRI	0:0898e006947b	3250
EDISON_NGUNJIRI	0:0898e006947b	3251	// write the new data to the portexpander
EDISON_NGUNJIRI	0:0898e006947b	3252	_i2c->write(_slaveAddress, &_lcd_bus, 1);
EDISON_NGUNJIRI	0:0898e006947b	3253	#endif
EDISON_NGUNJIRI	0:0898e006947b	3254
EDISON_NGUNJIRI	0:0898e006947b	3255	_init(_LCD_DL_4); // Set Datalength to 4 bit for all serial expander interfaces
EDISON_NGUNJIRI	0:0898e006947b	3256	}
EDISON_NGUNJIRI	0:0898e006947b	3257
EDISON_NGUNJIRI	0:0898e006947b	3258	// Set E bit (or E2 bit) in the databus shadowvalue
EDISON_NGUNJIRI	0:0898e006947b	3259	// Used for mbed I2C bus expander
EDISON_NGUNJIRI	0:0898e006947b	3260	void TextLCD_I2C::_setEnableBit(bool value) {
EDISON_NGUNJIRI	0:0898e006947b	3261
EDISON_NGUNJIRI	0:0898e006947b	3262	#if (LCD_TWO_CTRL == 1)
EDISON_NGUNJIRI	0:0898e006947b	3263	if(_ctrl_idx==_LCDCtrl_0) {
EDISON_NGUNJIRI	0:0898e006947b	3264	if (value) {
EDISON_NGUNJIRI	0:0898e006947b	3265	_lcd_bus \|= LCD_BUS_I2C_E; // Set E bit
EDISON_NGUNJIRI	0:0898e006947b	3266	}
EDISON_NGUNJIRI	0:0898e006947b	3267	else {
EDISON_NGUNJIRI	0:0898e006947b	3268	_lcd_bus &= ~LCD_BUS_I2C_E; // Reset E bit
EDISON_NGUNJIRI	0:0898e006947b	3269	}
EDISON_NGUNJIRI	0:0898e006947b	3270	}
EDISON_NGUNJIRI	0:0898e006947b	3271	else {
EDISON_NGUNJIRI	0:0898e006947b	3272	if (value) {
EDISON_NGUNJIRI	0:0898e006947b	3273	_lcd_bus \|= LCD_BUS_I2C_E2; // Set E2 bit
EDISON_NGUNJIRI	0:0898e006947b	3274	}
EDISON_NGUNJIRI	0:0898e006947b	3275	else {
EDISON_NGUNJIRI	0:0898e006947b	3276	_lcd_bus &= ~LCD_BUS_I2C_E2; // Reset E2bit
EDISON_NGUNJIRI	0:0898e006947b	3277	}
EDISON_NGUNJIRI	0:0898e006947b	3278	}
EDISON_NGUNJIRI	0:0898e006947b	3279	#else
EDISON_NGUNJIRI	0:0898e006947b	3280	// Support only one controller
EDISON_NGUNJIRI	0:0898e006947b	3281	if (value) {
EDISON_NGUNJIRI	0:0898e006947b	3282	_lcd_bus \|= LCD_BUS_I2C_E; // Set E bit
EDISON_NGUNJIRI	0:0898e006947b	3283	}
EDISON_NGUNJIRI	0:0898e006947b	3284	else {
EDISON_NGUNJIRI	0:0898e006947b	3285	_lcd_bus &= ~LCD_BUS_I2C_E; // Reset E bit
EDISON_NGUNJIRI	0:0898e006947b	3286	}
EDISON_NGUNJIRI	0:0898e006947b	3287
EDISON_NGUNJIRI	0:0898e006947b	3288	#endif
EDISON_NGUNJIRI	0:0898e006947b	3289	}
EDISON_NGUNJIRI	0:0898e006947b	3290
EDISON_NGUNJIRI	0:0898e006947b	3291	// Set E pin (or E2 pin)
EDISON_NGUNJIRI	0:0898e006947b	3292	// Used for mbed pins, I2C bus expander or SPI shiftregister
EDISON_NGUNJIRI	0:0898e006947b	3293	void TextLCD_I2C::_setEnable(bool value) {
EDISON_NGUNJIRI	0:0898e006947b	3294
EDISON_NGUNJIRI	0:0898e006947b	3295	// Place the E or E2 bit data on the databus shadowvalue
EDISON_NGUNJIRI	0:0898e006947b	3296	_setEnableBit(value);
EDISON_NGUNJIRI	0:0898e006947b	3297
EDISON_NGUNJIRI	0:0898e006947b	3298	#if (MCP23008==1)
EDISON_NGUNJIRI	0:0898e006947b	3299	// MCP23008 portexpander
EDISON_NGUNJIRI	0:0898e006947b	3300
EDISON_NGUNJIRI	0:0898e006947b	3301	// write the new data to the portexpander
EDISON_NGUNJIRI	0:0898e006947b	3302	_writeRegister(GPIO, _lcd_bus);
EDISON_NGUNJIRI	0:0898e006947b	3303	#else
EDISON_NGUNJIRI	0:0898e006947b	3304	// PCF8574 of PCF8574A portexpander
EDISON_NGUNJIRI	0:0898e006947b	3305
EDISON_NGUNJIRI	0:0898e006947b	3306	// write the new data to the I2C portexpander
EDISON_NGUNJIRI	0:0898e006947b	3307	_i2c->write(_slaveAddress, &_lcd_bus, 1);
EDISON_NGUNJIRI	0:0898e006947b	3308	#endif
EDISON_NGUNJIRI	0:0898e006947b	3309	}
EDISON_NGUNJIRI	0:0898e006947b	3310
EDISON_NGUNJIRI	0:0898e006947b	3311
EDISON_NGUNJIRI	0:0898e006947b	3312	// Set RS pin
EDISON_NGUNJIRI	0:0898e006947b	3313	// Used for mbed pins, I2C bus expander or SPI shiftregister
EDISON_NGUNJIRI	0:0898e006947b	3314	void TextLCD_I2C::_setRS(bool value) {
EDISON_NGUNJIRI	0:0898e006947b	3315
EDISON_NGUNJIRI	0:0898e006947b	3316	if (value) {
EDISON_NGUNJIRI	0:0898e006947b	3317	_lcd_bus \|= LCD_BUS_I2C_RS; // Set RS bit
EDISON_NGUNJIRI	0:0898e006947b	3318	}
EDISON_NGUNJIRI	0:0898e006947b	3319	else {
EDISON_NGUNJIRI	0:0898e006947b	3320	_lcd_bus &= ~LCD_BUS_I2C_RS; // Reset RS bit
EDISON_NGUNJIRI	0:0898e006947b	3321	}
EDISON_NGUNJIRI	0:0898e006947b	3322
EDISON_NGUNJIRI	0:0898e006947b	3323	#if (MCP23008==1)
EDISON_NGUNJIRI	0:0898e006947b	3324	// MCP23008 portexpander
EDISON_NGUNJIRI	0:0898e006947b	3325
EDISON_NGUNJIRI	0:0898e006947b	3326	// write the new data to the portexpander
EDISON_NGUNJIRI	0:0898e006947b	3327	_writeRegister(GPIO, _lcd_bus);
EDISON_NGUNJIRI	0:0898e006947b	3328	#else
EDISON_NGUNJIRI	0:0898e006947b	3329	// PCF8574 of PCF8574A portexpander
EDISON_NGUNJIRI	0:0898e006947b	3330
EDISON_NGUNJIRI	0:0898e006947b	3331	// write the new data to the I2C portexpander
EDISON_NGUNJIRI	0:0898e006947b	3332	_i2c->write(_slaveAddress, &_lcd_bus, 1);
EDISON_NGUNJIRI	0:0898e006947b	3333	#endif
EDISON_NGUNJIRI	0:0898e006947b	3334	}
EDISON_NGUNJIRI	0:0898e006947b	3335
EDISON_NGUNJIRI	0:0898e006947b	3336	// Set BL pin
EDISON_NGUNJIRI	0:0898e006947b	3337	// Used for mbed pins, I2C bus expander or SPI shiftregister
EDISON_NGUNJIRI	0:0898e006947b	3338	void TextLCD_I2C::_setBL(bool value) {
EDISON_NGUNJIRI	0:0898e006947b	3339
EDISON_NGUNJIRI	0:0898e006947b	3340	if (value) {
EDISON_NGUNJIRI	0:0898e006947b	3341	_lcd_bus \|= LCD_BUS_I2C_BL; // Set BL bit
EDISON_NGUNJIRI	0:0898e006947b	3342	}
EDISON_NGUNJIRI	0:0898e006947b	3343	else {
EDISON_NGUNJIRI	0:0898e006947b	3344	_lcd_bus &= ~LCD_BUS_I2C_BL; // Reset BL bit
EDISON_NGUNJIRI	0:0898e006947b	3345	}
EDISON_NGUNJIRI	0:0898e006947b	3346
EDISON_NGUNJIRI	0:0898e006947b	3347	#if (MCP23008==1)
EDISON_NGUNJIRI	0:0898e006947b	3348	// MCP23008 portexpander
EDISON_NGUNJIRI	0:0898e006947b	3349
EDISON_NGUNJIRI	0:0898e006947b	3350	// write the new data to the portexpander
EDISON_NGUNJIRI	0:0898e006947b	3351	_writeRegister(GPIO, _lcd_bus);
EDISON_NGUNJIRI	0:0898e006947b	3352	#else
EDISON_NGUNJIRI	0:0898e006947b	3353	// PCF8574 of PCF8574A portexpander
EDISON_NGUNJIRI	0:0898e006947b	3354
EDISON_NGUNJIRI	0:0898e006947b	3355	// write the new data to the I2C portexpander
EDISON_NGUNJIRI	0:0898e006947b	3356	_i2c->write(_slaveAddress, &_lcd_bus, 1);
EDISON_NGUNJIRI	0:0898e006947b	3357	#endif
EDISON_NGUNJIRI	0:0898e006947b	3358	}
EDISON_NGUNJIRI	0:0898e006947b	3359
EDISON_NGUNJIRI	0:0898e006947b	3360	#if(0)
EDISON_NGUNJIRI	0:0898e006947b	3361	// New optimized v018
EDISON_NGUNJIRI	0:0898e006947b	3362	// Test faster _writeByte 0.11s vs 0.27s for a 20x4 fillscreen (PCF8574), same as v018
EDISON_NGUNJIRI	0:0898e006947b	3363	// Place the 4bit data in the databus shadowvalue
EDISON_NGUNJIRI	0:0898e006947b	3364	// Used for mbed I2C bus expander
EDISON_NGUNJIRI	0:0898e006947b	3365	const char _LCD_DATA_BITS[16] = {
EDISON_NGUNJIRI	0:0898e006947b	3366	0x00,
EDISON_NGUNJIRI	0:0898e006947b	3367	( LCD_BUS_I2C_D4),
EDISON_NGUNJIRI	0:0898e006947b	3368	( LCD_BUS_I2C_D5 ),
EDISON_NGUNJIRI	0:0898e006947b	3369	( LCD_BUS_I2C_D5 \| LCD_BUS_I2C_D4),
EDISON_NGUNJIRI	0:0898e006947b	3370	( LCD_BUS_I2C_D6 ),
EDISON_NGUNJIRI	0:0898e006947b	3371	( LCD_BUS_I2C_D6 \| LCD_BUS_I2C_D4),
EDISON_NGUNJIRI	0:0898e006947b	3372	( LCD_BUS_I2C_D6 \| LCD_BUS_I2C_D5 ),
EDISON_NGUNJIRI	0:0898e006947b	3373	( LCD_BUS_I2C_D6 \| LCD_BUS_I2C_D5 \| LCD_BUS_I2C_D4),
EDISON_NGUNJIRI	0:0898e006947b	3374	(LCD_BUS_I2C_D7 ),
EDISON_NGUNJIRI	0:0898e006947b	3375	(LCD_BUS_I2C_D7 \| LCD_BUS_I2C_D4),
EDISON_NGUNJIRI	0:0898e006947b	3376	(LCD_BUS_I2C_D7 \| LCD_BUS_I2C_D5 ),
EDISON_NGUNJIRI	0:0898e006947b	3377	(LCD_BUS_I2C_D7 \| LCD_BUS_I2C_D5 \| LCD_BUS_I2C_D4),
EDISON_NGUNJIRI	0:0898e006947b	3378	(LCD_BUS_I2C_D7 \| LCD_BUS_I2C_D6 ),
EDISON_NGUNJIRI	0:0898e006947b	3379	(LCD_BUS_I2C_D7 \| LCD_BUS_I2C_D6 \| LCD_BUS_I2C_D4),
EDISON_NGUNJIRI	0:0898e006947b	3380	(LCD_BUS_I2C_D7 \| LCD_BUS_I2C_D6 \| LCD_BUS_I2C_D5 ),
EDISON_NGUNJIRI	0:0898e006947b	3381	(LCD_BUS_I2C_D7 \| LCD_BUS_I2C_D6 \| LCD_BUS_I2C_D5 \| LCD_BUS_I2C_D4)
EDISON_NGUNJIRI	0:0898e006947b	3382	};
EDISON_NGUNJIRI	0:0898e006947b	3383	void TextLCD_I2C::_setDataBits(int value) {
EDISON_NGUNJIRI	0:0898e006947b	3384
EDISON_NGUNJIRI	0:0898e006947b	3385	//Clear all databits
EDISON_NGUNJIRI	0:0898e006947b	3386	_lcd_bus &= ~LCD_BUS_I2C_MSK;
EDISON_NGUNJIRI	0:0898e006947b	3387
EDISON_NGUNJIRI	0:0898e006947b	3388	// Set bit by bit to support any mapping of expander portpins to LCD pins
EDISON_NGUNJIRI	0:0898e006947b	3389	_lcd_bus \|= _LCD_DATA_BITS[value & 0x0F];
EDISON_NGUNJIRI	0:0898e006947b	3390	}
EDISON_NGUNJIRI	0:0898e006947b	3391	#endif
EDISON_NGUNJIRI	0:0898e006947b	3392
EDISON_NGUNJIRI	0:0898e006947b	3393	// Test faster _writeByte 0.11s vs 0.27s for a 20x4 fillscreen (PCF8574)
EDISON_NGUNJIRI	0:0898e006947b	3394	// Place the 4bit data in the databus shadowvalue
EDISON_NGUNJIRI	0:0898e006947b	3395	// Used for mbed I2C bus expander
EDISON_NGUNJIRI	0:0898e006947b	3396	void TextLCD_I2C::_setDataBits(int value) {
EDISON_NGUNJIRI	0:0898e006947b	3397
EDISON_NGUNJIRI	0:0898e006947b	3398	//Clear all databits
EDISON_NGUNJIRI	0:0898e006947b	3399	_lcd_bus &= ~LCD_BUS_I2C_MSK;
EDISON_NGUNJIRI	0:0898e006947b	3400
EDISON_NGUNJIRI	0:0898e006947b	3401	// Set bit by bit to support any mapping of expander portpins to LCD pins
EDISON_NGUNJIRI	0:0898e006947b	3402	if (value & 0x01){
EDISON_NGUNJIRI	0:0898e006947b	3403	_lcd_bus \|= LCD_BUS_I2C_D4; // Set Databit
EDISON_NGUNJIRI	0:0898e006947b	3404	}
EDISON_NGUNJIRI	0:0898e006947b	3405
EDISON_NGUNJIRI	0:0898e006947b	3406	if (value & 0x02){
EDISON_NGUNJIRI	0:0898e006947b	3407	_lcd_bus \|= LCD_BUS_I2C_D5; // Set Databit
EDISON_NGUNJIRI	0:0898e006947b	3408	}
EDISON_NGUNJIRI	0:0898e006947b	3409
EDISON_NGUNJIRI	0:0898e006947b	3410	if (value & 0x04) {
EDISON_NGUNJIRI	0:0898e006947b	3411	_lcd_bus \|= LCD_BUS_I2C_D6; // Set Databit
EDISON_NGUNJIRI	0:0898e006947b	3412	}
EDISON_NGUNJIRI	0:0898e006947b	3413
EDISON_NGUNJIRI	0:0898e006947b	3414	if (value & 0x08) {
EDISON_NGUNJIRI	0:0898e006947b	3415	_lcd_bus \|= LCD_BUS_I2C_D7; // Set Databit
EDISON_NGUNJIRI	0:0898e006947b	3416	}
EDISON_NGUNJIRI	0:0898e006947b	3417	}
EDISON_NGUNJIRI	0:0898e006947b	3418
EDISON_NGUNJIRI	0:0898e006947b	3419
EDISON_NGUNJIRI	0:0898e006947b	3420	// Place the 4bit data on the databus
EDISON_NGUNJIRI	0:0898e006947b	3421	// Used for mbed pins, I2C bus expander or SPI shifregister
EDISON_NGUNJIRI	0:0898e006947b	3422	void TextLCD_I2C::_setData(int value) {
EDISON_NGUNJIRI	0:0898e006947b	3423
EDISON_NGUNJIRI	0:0898e006947b	3424	// Place the 4bit data on the databus shadowvalue
EDISON_NGUNJIRI	0:0898e006947b	3425	_setDataBits(value);
EDISON_NGUNJIRI	0:0898e006947b	3426
EDISON_NGUNJIRI	0:0898e006947b	3427	// Place the 4bit data on the databus
EDISON_NGUNJIRI	0:0898e006947b	3428	#if (MCP23008==1)
EDISON_NGUNJIRI	0:0898e006947b	3429	// MCP23008 portexpander
EDISON_NGUNJIRI	0:0898e006947b	3430
EDISON_NGUNJIRI	0:0898e006947b	3431	// write the new data to the portexpander
EDISON_NGUNJIRI	0:0898e006947b	3432	_writeRegister(GPIO, _lcd_bus);
EDISON_NGUNJIRI	0:0898e006947b	3433	#else
EDISON_NGUNJIRI	0:0898e006947b	3434	// PCF8574 of PCF8574A portexpander
EDISON_NGUNJIRI	0:0898e006947b	3435
EDISON_NGUNJIRI	0:0898e006947b	3436	// write the new data to the I2C portexpander
EDISON_NGUNJIRI	0:0898e006947b	3437	_i2c->write(_slaveAddress, &_lcd_bus, 1);
EDISON_NGUNJIRI	0:0898e006947b	3438	#endif
EDISON_NGUNJIRI	0:0898e006947b	3439	}
EDISON_NGUNJIRI	0:0898e006947b	3440
EDISON_NGUNJIRI	0:0898e006947b	3441	// Write data to MCP23008 I2C portexpander
EDISON_NGUNJIRI	0:0898e006947b	3442	// Used for mbed I2C bus expander
EDISON_NGUNJIRI	0:0898e006947b	3443	void TextLCD_I2C::_writeRegister (char reg, char value) {
EDISON_NGUNJIRI	0:0898e006947b	3444	char data[] = {reg, value};
EDISON_NGUNJIRI	0:0898e006947b	3445
EDISON_NGUNJIRI	0:0898e006947b	3446	_i2c->write(_slaveAddress, data, 2);
EDISON_NGUNJIRI	0:0898e006947b	3447	}
EDISON_NGUNJIRI	0:0898e006947b	3448
EDISON_NGUNJIRI	0:0898e006947b	3449	//New optimized
EDISON_NGUNJIRI	0:0898e006947b	3450	//Test faster _writeByte 0.11s vs 0.27s for a 20x4 fillscreen (PCF8574)
EDISON_NGUNJIRI	0:0898e006947b	3451	//Test faster _writeByte 0.14s vs 0.34s for a 20x4 fillscreen (MCP23008)
EDISON_NGUNJIRI	0:0898e006947b	3452
EDISON_NGUNJIRI	0:0898e006947b	3453	// Write a byte using I2C
EDISON_NGUNJIRI	0:0898e006947b	3454	void TextLCD_I2C::_writeByte(int value) {
EDISON_NGUNJIRI	0:0898e006947b	3455	char data[6];
EDISON_NGUNJIRI	0:0898e006947b	3456
EDISON_NGUNJIRI	0:0898e006947b	3457	#if (MCP23008==1)
EDISON_NGUNJIRI	0:0898e006947b	3458	// MCP23008 portexpander
EDISON_NGUNJIRI	0:0898e006947b	3459
EDISON_NGUNJIRI	0:0898e006947b	3460	data[0] = GPIO; // set registeraddres
EDISON_NGUNJIRI	0:0898e006947b	3461	// Note: auto-increment is disabled so all data will go to GPIO register
EDISON_NGUNJIRI	0:0898e006947b	3462
EDISON_NGUNJIRI	0:0898e006947b	3463	_setEnableBit(true); // set E
EDISON_NGUNJIRI	0:0898e006947b	3464	_setDataBits(value >> 4); // set data high
EDISON_NGUNJIRI	0:0898e006947b	3465	data[1] = _lcd_bus;
EDISON_NGUNJIRI	0:0898e006947b	3466
EDISON_NGUNJIRI	0:0898e006947b	3467	_setEnableBit(false); // clear E
EDISON_NGUNJIRI	0:0898e006947b	3468	data[2] = _lcd_bus;
EDISON_NGUNJIRI	0:0898e006947b	3469
EDISON_NGUNJIRI	0:0898e006947b	3470	_setEnableBit(true); // set E
EDISON_NGUNJIRI	0:0898e006947b	3471	_setDataBits(value); // set data low
EDISON_NGUNJIRI	0:0898e006947b	3472	data[3] = _lcd_bus;
EDISON_NGUNJIRI	0:0898e006947b	3473
EDISON_NGUNJIRI	0:0898e006947b	3474	_setEnableBit(false); // clear E
EDISON_NGUNJIRI	0:0898e006947b	3475	data[4] = _lcd_bus;
EDISON_NGUNJIRI	0:0898e006947b	3476
EDISON_NGUNJIRI	0:0898e006947b	3477	// write the packed data to the I2C portexpander
EDISON_NGUNJIRI	0:0898e006947b	3478	_i2c->write(_slaveAddress, data, 5);
EDISON_NGUNJIRI	0:0898e006947b	3479	#else
EDISON_NGUNJIRI	0:0898e006947b	3480	// PCF8574 of PCF8574A portexpander
EDISON_NGUNJIRI	0:0898e006947b	3481
EDISON_NGUNJIRI	0:0898e006947b	3482	_setEnableBit(true); // set E
EDISON_NGUNJIRI	0:0898e006947b	3483	_setDataBits(value >> 4); // set data high
EDISON_NGUNJIRI	0:0898e006947b	3484	data[0] = _lcd_bus;
EDISON_NGUNJIRI	0:0898e006947b	3485
EDISON_NGUNJIRI	0:0898e006947b	3486	_setEnableBit(false); // clear E
EDISON_NGUNJIRI	0:0898e006947b	3487	data[1] = _lcd_bus;
EDISON_NGUNJIRI	0:0898e006947b	3488
EDISON_NGUNJIRI	0:0898e006947b	3489	_setEnableBit(true); // set E
EDISON_NGUNJIRI	0:0898e006947b	3490	_setDataBits(value); // set data low
EDISON_NGUNJIRI	0:0898e006947b	3491	data[2] = _lcd_bus;
EDISON_NGUNJIRI	0:0898e006947b	3492
EDISON_NGUNJIRI	0:0898e006947b	3493	_setEnableBit(false); // clear E
EDISON_NGUNJIRI	0:0898e006947b	3494	data[3] = _lcd_bus;
EDISON_NGUNJIRI	0:0898e006947b	3495
EDISON_NGUNJIRI	0:0898e006947b	3496	// write the packed data to the I2C portexpander
EDISON_NGUNJIRI	0:0898e006947b	3497	_i2c->write(_slaveAddress, data, 4);
EDISON_NGUNJIRI	0:0898e006947b	3498	#endif
EDISON_NGUNJIRI	0:0898e006947b	3499	}
EDISON_NGUNJIRI	0:0898e006947b	3500
EDISON_NGUNJIRI	0:0898e006947b	3501	#endif /* I2C Expander PCF8574/MCP23008 */
EDISON_NGUNJIRI	0:0898e006947b	3502	//---------- End TextLCD_I2C ------------
EDISON_NGUNJIRI	0:0898e006947b	3503
EDISON_NGUNJIRI	0:0898e006947b	3504
EDISON_NGUNJIRI	0:0898e006947b	3505	//--------- Start TextLCD_SPI -----------
EDISON_NGUNJIRI	0:0898e006947b	3506	#if(LCD_SPI == 1) /* SPI Expander SN74595 */
EDISON_NGUNJIRI	0:0898e006947b	3507
EDISON_NGUNJIRI	0:0898e006947b	3508	/** Create a TextLCD interface using an SPI 74595 portexpander
EDISON_NGUNJIRI	0:0898e006947b	3509	*
EDISON_NGUNJIRI	0:0898e006947b	3510	* @param spi SPI Bus
EDISON_NGUNJIRI	0:0898e006947b	3511	* @param cs chip select pin (active low)
EDISON_NGUNJIRI	0:0898e006947b	3512	* @param type Sets the panel size/addressing mode (default = LCD16x2)
EDISON_NGUNJIRI	0:0898e006947b	3513	* @param ctrl LCD controller (default = HD44780)
EDISON_NGUNJIRI	0:0898e006947b	3514	*/
EDISON_NGUNJIRI	0:0898e006947b	3515	TextLCD_SPI::TextLCD_SPI(SPI *spi, PinName cs, LCDType type, LCDCtrl ctrl) :
EDISON_NGUNJIRI	0:0898e006947b	3516	TextLCD_Base(type, ctrl),
EDISON_NGUNJIRI	0:0898e006947b	3517	_spi(spi),
EDISON_NGUNJIRI	0:0898e006947b	3518	_cs(cs) {
EDISON_NGUNJIRI	0:0898e006947b	3519	// Init cs
EDISON_NGUNJIRI	0:0898e006947b	3520	_cs = 1;
EDISON_NGUNJIRI	0:0898e006947b	3521
EDISON_NGUNJIRI	0:0898e006947b	3522	// Setup the spi for 8 bit data, low steady state clock,
EDISON_NGUNJIRI	0:0898e006947b	3523	// rising edge capture, with a 500KHz or 1MHz clock rate
EDISON_NGUNJIRI	0:0898e006947b	3524	_spi->format(8,0);
EDISON_NGUNJIRI	0:0898e006947b	3525	_spi->frequency(500000);
EDISON_NGUNJIRI	0:0898e006947b	3526	//_spi.frequency(1000000);
EDISON_NGUNJIRI	0:0898e006947b	3527
EDISON_NGUNJIRI	0:0898e006947b	3528	thread_sleep_for(100); // Wait 100ms to ensure LCD powered up
EDISON_NGUNJIRI	0:0898e006947b	3529
EDISON_NGUNJIRI	0:0898e006947b	3530	// Init the portexpander bus
EDISON_NGUNJIRI	0:0898e006947b	3531	_lcd_bus = LCD_BUS_SPI_DEF;
EDISON_NGUNJIRI	0:0898e006947b	3532
EDISON_NGUNJIRI	0:0898e006947b	3533	// write the new data to the portexpander
EDISON_NGUNJIRI	0:0898e006947b	3534	_cs = 0;
EDISON_NGUNJIRI	0:0898e006947b	3535	_spi->write(_lcd_bus);
EDISON_NGUNJIRI	0:0898e006947b	3536	_cs = 1;
EDISON_NGUNJIRI	0:0898e006947b	3537
EDISON_NGUNJIRI	0:0898e006947b	3538	_init(_LCD_DL_4); // Set Datalength to 4 bit for all serial expander interfaces
EDISON_NGUNJIRI	0:0898e006947b	3539	}
EDISON_NGUNJIRI	0:0898e006947b	3540
EDISON_NGUNJIRI	0:0898e006947b	3541	// Set E pin (or E2 pin)
EDISON_NGUNJIRI	0:0898e006947b	3542	// Used for mbed pins, I2C bus expander or SPI shiftregister
EDISON_NGUNJIRI	0:0898e006947b	3543	void TextLCD_SPI::_setEnable(bool value) {
EDISON_NGUNJIRI	0:0898e006947b	3544
EDISON_NGUNJIRI	0:0898e006947b	3545	if(_ctrl_idx==_LCDCtrl_0) {
EDISON_NGUNJIRI	0:0898e006947b	3546	if (value) {
EDISON_NGUNJIRI	0:0898e006947b	3547	_lcd_bus \|= LCD_BUS_SPI_E; // Set E bit
EDISON_NGUNJIRI	0:0898e006947b	3548	}
EDISON_NGUNJIRI	0:0898e006947b	3549	else {
EDISON_NGUNJIRI	0:0898e006947b	3550	_lcd_bus &= ~LCD_BUS_SPI_E; // Reset E bit
EDISON_NGUNJIRI	0:0898e006947b	3551	}
EDISON_NGUNJIRI	0:0898e006947b	3552	}
EDISON_NGUNJIRI	0:0898e006947b	3553	else {
EDISON_NGUNJIRI	0:0898e006947b	3554	if (value) {
EDISON_NGUNJIRI	0:0898e006947b	3555	_lcd_bus \|= LCD_BUS_SPI_E2; // Set E2 bit
EDISON_NGUNJIRI	0:0898e006947b	3556	}
EDISON_NGUNJIRI	0:0898e006947b	3557	else {
EDISON_NGUNJIRI	0:0898e006947b	3558	_lcd_bus &= ~LCD_BUS_SPI_E2; // Reset E2 bit
EDISON_NGUNJIRI	0:0898e006947b	3559	}
EDISON_NGUNJIRI	0:0898e006947b	3560	}
EDISON_NGUNJIRI	0:0898e006947b	3561
EDISON_NGUNJIRI	0:0898e006947b	3562	// write the new data to the SPI portexpander
EDISON_NGUNJIRI	0:0898e006947b	3563	_cs = 0;
EDISON_NGUNJIRI	0:0898e006947b	3564	_spi->write(_lcd_bus);
EDISON_NGUNJIRI	0:0898e006947b	3565	_cs = 1;
EDISON_NGUNJIRI	0:0898e006947b	3566	}
EDISON_NGUNJIRI	0:0898e006947b	3567
EDISON_NGUNJIRI	0:0898e006947b	3568	// Set RS pin
EDISON_NGUNJIRI	0:0898e006947b	3569	// Used for mbed pins, I2C bus expander or SPI shiftregister and SPI_N
EDISON_NGUNJIRI	0:0898e006947b	3570	void TextLCD_SPI::_setRS(bool value) {
EDISON_NGUNJIRI	0:0898e006947b	3571
EDISON_NGUNJIRI	0:0898e006947b	3572	if (value) {
EDISON_NGUNJIRI	0:0898e006947b	3573	_lcd_bus \|= LCD_BUS_SPI_RS; // Set RS bit
EDISON_NGUNJIRI	0:0898e006947b	3574	}
EDISON_NGUNJIRI	0:0898e006947b	3575	else {
EDISON_NGUNJIRI	0:0898e006947b	3576	_lcd_bus &= ~LCD_BUS_SPI_RS; // Reset RS bit
EDISON_NGUNJIRI	0:0898e006947b	3577	}
EDISON_NGUNJIRI	0:0898e006947b	3578
EDISON_NGUNJIRI	0:0898e006947b	3579	// write the new data to the SPI portexpander
EDISON_NGUNJIRI	0:0898e006947b	3580	_cs = 0;
EDISON_NGUNJIRI	0:0898e006947b	3581	_spi->write(_lcd_bus);
EDISON_NGUNJIRI	0:0898e006947b	3582	_cs = 1;
EDISON_NGUNJIRI	0:0898e006947b	3583	}
EDISON_NGUNJIRI	0:0898e006947b	3584
EDISON_NGUNJIRI	0:0898e006947b	3585	// Set BL pin
EDISON_NGUNJIRI	0:0898e006947b	3586	// Used for mbed pins, I2C bus expander or SPI shiftregister
EDISON_NGUNJIRI	0:0898e006947b	3587	void TextLCD_SPI::_setBL(bool value) {
EDISON_NGUNJIRI	0:0898e006947b	3588
EDISON_NGUNJIRI	0:0898e006947b	3589	if (value) {
EDISON_NGUNJIRI	0:0898e006947b	3590	_lcd_bus \|= LCD_BUS_SPI_BL; // Set BL bit
EDISON_NGUNJIRI	0:0898e006947b	3591	}
EDISON_NGUNJIRI	0:0898e006947b	3592	else {
EDISON_NGUNJIRI	0:0898e006947b	3593	_lcd_bus &= ~LCD_BUS_SPI_BL; // Reset BL bit
EDISON_NGUNJIRI	0:0898e006947b	3594	}
EDISON_NGUNJIRI	0:0898e006947b	3595
EDISON_NGUNJIRI	0:0898e006947b	3596	// write the new data to the SPI portexpander
EDISON_NGUNJIRI	0:0898e006947b	3597	_cs = 0;
EDISON_NGUNJIRI	0:0898e006947b	3598	_spi->write(_lcd_bus);
EDISON_NGUNJIRI	0:0898e006947b	3599	_cs = 1;
EDISON_NGUNJIRI	0:0898e006947b	3600	}
EDISON_NGUNJIRI	0:0898e006947b	3601
EDISON_NGUNJIRI	0:0898e006947b	3602	// Place the 4bit data on the databus
EDISON_NGUNJIRI	0:0898e006947b	3603	// Used for mbed pins, I2C bus expander or SPI shiftregister
EDISON_NGUNJIRI	0:0898e006947b	3604	void TextLCD_SPI::_setData(int value) {
EDISON_NGUNJIRI	0:0898e006947b	3605
EDISON_NGUNJIRI	0:0898e006947b	3606	// Set bit by bit to support any mapping of expander portpins to LCD pins
EDISON_NGUNJIRI	0:0898e006947b	3607	if (value & 0x01) {
EDISON_NGUNJIRI	0:0898e006947b	3608	_lcd_bus \|= LCD_BUS_SPI_D4; // Set Databit
EDISON_NGUNJIRI	0:0898e006947b	3609	}
EDISON_NGUNJIRI	0:0898e006947b	3610	else {
EDISON_NGUNJIRI	0:0898e006947b	3611	_lcd_bus &= ~LCD_BUS_SPI_D4; // Reset Databit
EDISON_NGUNJIRI	0:0898e006947b	3612	}
EDISON_NGUNJIRI	0:0898e006947b	3613
EDISON_NGUNJIRI	0:0898e006947b	3614	if (value & 0x02) {
EDISON_NGUNJIRI	0:0898e006947b	3615	_lcd_bus \|= LCD_BUS_SPI_D5; // Set Databit
EDISON_NGUNJIRI	0:0898e006947b	3616	}
EDISON_NGUNJIRI	0:0898e006947b	3617	else {
EDISON_NGUNJIRI	0:0898e006947b	3618	_lcd_bus &= ~LCD_BUS_SPI_D5; // Reset Databit
EDISON_NGUNJIRI	0:0898e006947b	3619	}
EDISON_NGUNJIRI	0:0898e006947b	3620
EDISON_NGUNJIRI	0:0898e006947b	3621	if (value & 0x04) {
EDISON_NGUNJIRI	0:0898e006947b	3622	_lcd_bus \|= LCD_BUS_SPI_D6; // Set Databit
EDISON_NGUNJIRI	0:0898e006947b	3623	}
EDISON_NGUNJIRI	0:0898e006947b	3624	else {
EDISON_NGUNJIRI	0:0898e006947b	3625	_lcd_bus &= ~LCD_BUS_SPI_D6; // Reset Databit
EDISON_NGUNJIRI	0:0898e006947b	3626	}
EDISON_NGUNJIRI	0:0898e006947b	3627
EDISON_NGUNJIRI	0:0898e006947b	3628	if (value & 0x08) {
EDISON_NGUNJIRI	0:0898e006947b	3629	_lcd_bus \|= LCD_BUS_SPI_D7; // Set Databit
EDISON_NGUNJIRI	0:0898e006947b	3630	}
EDISON_NGUNJIRI	0:0898e006947b	3631	else {
EDISON_NGUNJIRI	0:0898e006947b	3632	_lcd_bus &= ~LCD_BUS_SPI_D7; // Reset Databit
EDISON_NGUNJIRI	0:0898e006947b	3633	}
EDISON_NGUNJIRI	0:0898e006947b	3634
EDISON_NGUNJIRI	0:0898e006947b	3635	// write the new data to the SPI portexpander
EDISON_NGUNJIRI	0:0898e006947b	3636	_cs = 0;
EDISON_NGUNJIRI	0:0898e006947b	3637	_spi->write(_lcd_bus);
EDISON_NGUNJIRI	0:0898e006947b	3638	_cs = 1;
EDISON_NGUNJIRI	0:0898e006947b	3639	}
EDISON_NGUNJIRI	0:0898e006947b	3640
EDISON_NGUNJIRI	0:0898e006947b	3641	#endif /* SPI Expander SN74595 */
EDISON_NGUNJIRI	0:0898e006947b	3642	//---------- End TextLCD_SPI ------------
EDISON_NGUNJIRI	0:0898e006947b	3643
EDISON_NGUNJIRI	0:0898e006947b	3644
EDISON_NGUNJIRI	0:0898e006947b	3645	//--------- Start TextLCD_I2C_N ---------
EDISON_NGUNJIRI	0:0898e006947b	3646	#if(LCD_I2C_N == 1) /* Native I2C */
EDISON_NGUNJIRI	0:0898e006947b	3647
EDISON_NGUNJIRI	0:0898e006947b	3648	/** Create a TextLCD interface using a controller with native I2C interface
EDISON_NGUNJIRI	0:0898e006947b	3649	*
EDISON_NGUNJIRI	0:0898e006947b	3650	* @param i2c I2C Bus
EDISON_NGUNJIRI	0:0898e006947b	3651	* @param deviceAddress I2C slave address (default = 0x7C)
EDISON_NGUNJIRI	0:0898e006947b	3652	* @param type Sets the panel size/addressing mode (default = LCD16x2)
EDISON_NGUNJIRI	0:0898e006947b	3653	* @param bl Backlight control line (optional, default = NC)
EDISON_NGUNJIRI	0:0898e006947b	3654	* @param ctrl LCD controller (default = ST7032_3V3)
EDISON_NGUNJIRI	0:0898e006947b	3655	*/
EDISON_NGUNJIRI	0:0898e006947b	3656	TextLCD_I2C_N::TextLCD_I2C_N(I2C *i2c, char deviceAddress, LCDType type, PinName bl, LCDCtrl ctrl) :
EDISON_NGUNJIRI	0:0898e006947b	3657	TextLCD_Base(type, ctrl),
EDISON_NGUNJIRI	0:0898e006947b	3658
EDISON_NGUNJIRI	0:0898e006947b	3659	_i2c(i2c){
EDISON_NGUNJIRI	0:0898e006947b	3660
EDISON_NGUNJIRI	0:0898e006947b	3661	_slaveAddress = deviceAddress & 0xFE;
EDISON_NGUNJIRI	0:0898e006947b	3662
EDISON_NGUNJIRI	0:0898e006947b	3663	// Setup the I2C bus
EDISON_NGUNJIRI	0:0898e006947b	3664	// The max bitrate for ST7032i is 400kbit, lets stick to default here
EDISON_NGUNJIRI	0:0898e006947b	3665	_i2c->frequency(100000);
EDISON_NGUNJIRI	0:0898e006947b	3666
EDISON_NGUNJIRI	0:0898e006947b	3667
EDISON_NGUNJIRI	0:0898e006947b	3668	// The hardware Backlight pin is optional. Test and make sure whether it exists or not to prevent illegal access.
EDISON_NGUNJIRI	0:0898e006947b	3669	if (bl != NC) {
EDISON_NGUNJIRI	0:0898e006947b	3670	_bl = new DigitalOut(bl); //Construct new pin
EDISON_NGUNJIRI	0:0898e006947b	3671	_bl->write(0); //Deactivate
EDISON_NGUNJIRI	0:0898e006947b	3672	}
EDISON_NGUNJIRI	0:0898e006947b	3673	else {
EDISON_NGUNJIRI	0:0898e006947b	3674	// No Hardware Backlight pin
EDISON_NGUNJIRI	0:0898e006947b	3675	_bl = NULL; //Construct dummy pin
EDISON_NGUNJIRI	0:0898e006947b	3676	}
EDISON_NGUNJIRI	0:0898e006947b	3677
EDISON_NGUNJIRI	0:0898e006947b	3678	//Sanity check
EDISON_NGUNJIRI	0:0898e006947b	3679	if (_ctrl & LCD_C_I2C) {
EDISON_NGUNJIRI	0:0898e006947b	3680	_init(_LCD_DL_8); // Set Datalength to 8 bit for all native serial interfaces
EDISON_NGUNJIRI	0:0898e006947b	3681	}
EDISON_NGUNJIRI	0:0898e006947b	3682	else {
EDISON_NGUNJIRI	0:0898e006947b	3683	error("Error: LCD Controller type does not support native I2C interface\n\r");
EDISON_NGUNJIRI	0:0898e006947b	3684	}
EDISON_NGUNJIRI	0:0898e006947b	3685	}
EDISON_NGUNJIRI	0:0898e006947b	3686
EDISON_NGUNJIRI	0:0898e006947b	3687	TextLCD_I2C_N::~TextLCD_I2C_N() {
EDISON_NGUNJIRI	0:0898e006947b	3688	if (_bl != NULL) {delete _bl;} // BL pin
EDISON_NGUNJIRI	0:0898e006947b	3689	}
EDISON_NGUNJIRI	0:0898e006947b	3690
EDISON_NGUNJIRI	0:0898e006947b	3691	// Not used in this mode
EDISON_NGUNJIRI	0:0898e006947b	3692	void TextLCD_I2C_N::_setEnable(bool value) {
EDISON_NGUNJIRI	0:0898e006947b	3693	}
EDISON_NGUNJIRI	0:0898e006947b	3694
EDISON_NGUNJIRI	0:0898e006947b	3695	// Set RS pin
EDISON_NGUNJIRI	0:0898e006947b	3696	// Used for mbed pins, I2C bus expander or SPI shiftregister and native I2C or SPI
EDISON_NGUNJIRI	0:0898e006947b	3697	void TextLCD_I2C_N::_setRS(bool value) {
EDISON_NGUNJIRI	0:0898e006947b	3698	// The controlbyte defines the meaning of the next byte. This next byte can either be data or command.
EDISON_NGUNJIRI	0:0898e006947b	3699	// Start Slaveaddress+RW b7 b6 b5 b4 b3 b2 b1 b0 b7...........b0 Stop
EDISON_NGUNJIRI	0:0898e006947b	3700	// Co RS RW 0 0 0 0 0 command or data
EDISON_NGUNJIRI	0:0898e006947b	3701	//
EDISON_NGUNJIRI	0:0898e006947b	3702	// C0=1 indicates that another controlbyte will follow after the next data or command byte
EDISON_NGUNJIRI	0:0898e006947b	3703	// RS=1 means that next byte is data, RS=0 means that next byte is command
EDISON_NGUNJIRI	0:0898e006947b	3704	// RW=0 means write to controller. RW=1 means that controller will be read from after the next command.
EDISON_NGUNJIRI	0:0898e006947b	3705	// Many native I2C controllers dont support this option and it is not used by this lib.
EDISON_NGUNJIRI	0:0898e006947b	3706	//
EDISON_NGUNJIRI	0:0898e006947b	3707
EDISON_NGUNJIRI	0:0898e006947b	3708	if (value) {
EDISON_NGUNJIRI	0:0898e006947b	3709	_controlbyte = 0x40; // Next byte is data, No more control bytes will follow
EDISON_NGUNJIRI	0:0898e006947b	3710	}
EDISON_NGUNJIRI	0:0898e006947b	3711	else {
EDISON_NGUNJIRI	0:0898e006947b	3712	_controlbyte = 0x00; // Next byte is command, No more control bytes will follow
EDISON_NGUNJIRI	0:0898e006947b	3713	}
EDISON_NGUNJIRI	0:0898e006947b	3714	}
EDISON_NGUNJIRI	0:0898e006947b	3715
EDISON_NGUNJIRI	0:0898e006947b	3716	// Set BL pin
EDISON_NGUNJIRI	0:0898e006947b	3717	void TextLCD_I2C_N::_setBL(bool value) {
EDISON_NGUNJIRI	0:0898e006947b	3718	if (_bl) {
EDISON_NGUNJIRI	0:0898e006947b	3719	_bl->write(value);
EDISON_NGUNJIRI	0:0898e006947b	3720	}
EDISON_NGUNJIRI	0:0898e006947b	3721	}
EDISON_NGUNJIRI	0:0898e006947b	3722
EDISON_NGUNJIRI	0:0898e006947b	3723	// Not used in this mode
EDISON_NGUNJIRI	0:0898e006947b	3724	void TextLCD_I2C_N::_setData(int value) {
EDISON_NGUNJIRI	0:0898e006947b	3725	}
EDISON_NGUNJIRI	0:0898e006947b	3726
EDISON_NGUNJIRI	0:0898e006947b	3727	// Write a byte using I2C
EDISON_NGUNJIRI	0:0898e006947b	3728	void TextLCD_I2C_N::_writeByte(char value) {
EDISON_NGUNJIRI	0:0898e006947b	3729	// The controlbyte defines the meaning of the next byte. This next byte can either be data or command.
EDISON_NGUNJIRI	0:0898e006947b	3730	// Start Slaveaddress+RW b7 b6 b5 b4 b3 b2 b1 b0 b7...........b0 Stop
EDISON_NGUNJIRI	0:0898e006947b	3731	// Co RS RW 0 0 0 0 0 command or data
EDISON_NGUNJIRI	0:0898e006947b	3732	//
EDISON_NGUNJIRI	0:0898e006947b	3733	// C0=1 indicates that another controlbyte will follow after the next data or command byte
EDISON_NGUNJIRI	0:0898e006947b	3734	// RS=1 means that next byte is data, RS=0 means that next byte is command
EDISON_NGUNJIRI	0:0898e006947b	3735	// RW=0 means write to controller. RW=1 means that controller will be read from after the next command.
EDISON_NGUNJIRI	0:0898e006947b	3736	// Many native I2C controllers dont support this option and it is not used by this lib.
EDISON_NGUNJIRI	0:0898e006947b	3737	//
EDISON_NGUNJIRI	0:0898e006947b	3738	char data[] = {_controlbyte, value};
EDISON_NGUNJIRI	0:0898e006947b	3739
EDISON_NGUNJIRI	0:0898e006947b	3740	#if(LCD_I2C_ACK==1)
EDISON_NGUNJIRI	0:0898e006947b	3741	//Controllers that support ACK
EDISON_NGUNJIRI	0:0898e006947b	3742	_i2c->write(_slaveAddress, data, 2);
EDISON_NGUNJIRI	0:0898e006947b	3743	#else
EDISON_NGUNJIRI	0:0898e006947b	3744	//Controllers that dont support ACK
EDISON_NGUNJIRI	0:0898e006947b	3745	//Note: This may be issue with some mbed platforms that dont fully/correctly support I2C byte operations.
EDISON_NGUNJIRI	0:0898e006947b	3746	_i2c->start();
EDISON_NGUNJIRI	0:0898e006947b	3747	_i2c->write(_slaveAddress);
EDISON_NGUNJIRI	0:0898e006947b	3748	_i2c->write(data[0]);
EDISON_NGUNJIRI	0:0898e006947b	3749	_i2c->write(data[1]);
EDISON_NGUNJIRI	0:0898e006947b	3750	_i2c->stop();
EDISON_NGUNJIRI	0:0898e006947b	3751	#endif
EDISON_NGUNJIRI	0:0898e006947b	3752	}
EDISON_NGUNJIRI	0:0898e006947b	3753	#endif /* Native I2C */
EDISON_NGUNJIRI	0:0898e006947b	3754	//-------- End TextLCD_I2C_N ------------
EDISON_NGUNJIRI	0:0898e006947b	3755
EDISON_NGUNJIRI	0:0898e006947b	3756
EDISON_NGUNJIRI	0:0898e006947b	3757	//--------- Start TextLCD_SPI_N ---------
EDISON_NGUNJIRI	0:0898e006947b	3758	#if(LCD_SPI_N == 1) /* Native SPI bus */
EDISON_NGUNJIRI	0:0898e006947b	3759	/** Create a TextLCD interface using a controller with a native SPI4 interface
EDISON_NGUNJIRI	0:0898e006947b	3760	*
EDISON_NGUNJIRI	0:0898e006947b	3761	* @param spi SPI Bus
EDISON_NGUNJIRI	0:0898e006947b	3762	* @param cs chip select pin (active low)
EDISON_NGUNJIRI	0:0898e006947b	3763	* @param rs Instruction/data control line
EDISON_NGUNJIRI	0:0898e006947b	3764	* @param type Sets the panel size/addressing mode (default = LCD16x2)
EDISON_NGUNJIRI	0:0898e006947b	3765	* @param bl Backlight control line (optional, default = NC)
EDISON_NGUNJIRI	0:0898e006947b	3766	* @param ctrl LCD controller (default = ST7032_3V3)
EDISON_NGUNJIRI	0:0898e006947b	3767	*/
EDISON_NGUNJIRI	0:0898e006947b	3768	TextLCD_SPI_N::TextLCD_SPI_N(SPI *spi, PinName cs, PinName rs, LCDType type, PinName bl, LCDCtrl ctrl) :
EDISON_NGUNJIRI	0:0898e006947b	3769	TextLCD_Base(type, ctrl),
EDISON_NGUNJIRI	0:0898e006947b	3770	_spi(spi),
EDISON_NGUNJIRI	0:0898e006947b	3771	_cs(cs),
EDISON_NGUNJIRI	0:0898e006947b	3772	_rs(rs) {
EDISON_NGUNJIRI	0:0898e006947b	3773
EDISON_NGUNJIRI	0:0898e006947b	3774	// Init CS
EDISON_NGUNJIRI	0:0898e006947b	3775	_cs = 1;
EDISON_NGUNJIRI	0:0898e006947b	3776
EDISON_NGUNJIRI	0:0898e006947b	3777	// Setup the spi for 8 bit data, high steady state clock,
EDISON_NGUNJIRI	0:0898e006947b	3778	// rising edge capture, with a 500KHz or 1MHz clock rate
EDISON_NGUNJIRI	0:0898e006947b	3779	// _spi->format(8,3);
EDISON_NGUNJIRI	0:0898e006947b	3780	// _spi->frequency(500000);
EDISON_NGUNJIRI	0:0898e006947b	3781	// _spi->frequency(1000000);
EDISON_NGUNJIRI	0:0898e006947b	3782
EDISON_NGUNJIRI	0:0898e006947b	3783	// Setup the spi for 8 bit data, low steady state clock,
EDISON_NGUNJIRI	0:0898e006947b	3784	// rising edge capture, with a 500KHz or 1MHz clock rate
EDISON_NGUNJIRI	0:0898e006947b	3785	_spi->format(8,0);
EDISON_NGUNJIRI	0:0898e006947b	3786	// _spi->frequency(500000);
EDISON_NGUNJIRI	0:0898e006947b	3787	_spi->frequency(1000000);
EDISON_NGUNJIRI	0:0898e006947b	3788
EDISON_NGUNJIRI	0:0898e006947b	3789	// The hardware Backlight pin is optional. Test and make sure whether it exists or not to prevent illegal access.
EDISON_NGUNJIRI	0:0898e006947b	3790	if (bl != NC) {
EDISON_NGUNJIRI	0:0898e006947b	3791	_bl = new DigitalOut(bl); //Construct new pin
EDISON_NGUNJIRI	0:0898e006947b	3792	_bl->write(0); //Deactivate
EDISON_NGUNJIRI	0:0898e006947b	3793	}
EDISON_NGUNJIRI	0:0898e006947b	3794	else {
EDISON_NGUNJIRI	0:0898e006947b	3795	// No Hardware Backlight pin
EDISON_NGUNJIRI	0:0898e006947b	3796	_bl = NULL; //Construct dummy pin
EDISON_NGUNJIRI	0:0898e006947b	3797	}
EDISON_NGUNJIRI	0:0898e006947b	3798
EDISON_NGUNJIRI	0:0898e006947b	3799	//Sanity check
EDISON_NGUNJIRI	0:0898e006947b	3800	if (_ctrl & LCD_C_SPI4) {
EDISON_NGUNJIRI	0:0898e006947b	3801	_init(_LCD_DL_8); // Set Datalength to 8 bit for all native serial interfaces
EDISON_NGUNJIRI	0:0898e006947b	3802	// ST7070 must set datalength to 8 bits!
EDISON_NGUNJIRI	0:0898e006947b	3803	}
EDISON_NGUNJIRI	0:0898e006947b	3804	else {
EDISON_NGUNJIRI	0:0898e006947b	3805	error("Error: LCD Controller type does not support native SPI4 interface\n\r");
EDISON_NGUNJIRI	0:0898e006947b	3806	}
EDISON_NGUNJIRI	0:0898e006947b	3807	}
EDISON_NGUNJIRI	0:0898e006947b	3808
EDISON_NGUNJIRI	0:0898e006947b	3809	TextLCD_SPI_N::~TextLCD_SPI_N() {
EDISON_NGUNJIRI	0:0898e006947b	3810	if (_bl != NULL) {delete _bl;} // BL pin
EDISON_NGUNJIRI	0:0898e006947b	3811	}
EDISON_NGUNJIRI	0:0898e006947b	3812
EDISON_NGUNJIRI	0:0898e006947b	3813	// Not used in this mode
EDISON_NGUNJIRI	0:0898e006947b	3814	void TextLCD_SPI_N::_setEnable(bool value) {
EDISON_NGUNJIRI	0:0898e006947b	3815	}
EDISON_NGUNJIRI	0:0898e006947b	3816
EDISON_NGUNJIRI	0:0898e006947b	3817	// Set RS pin
EDISON_NGUNJIRI	0:0898e006947b	3818	// Used for mbed pins, I2C bus expander or SPI shiftregister, SPI_N
EDISON_NGUNJIRI	0:0898e006947b	3819	void TextLCD_SPI_N::_setRS(bool value) {
EDISON_NGUNJIRI	0:0898e006947b	3820	_rs = value;
EDISON_NGUNJIRI	0:0898e006947b	3821	}
EDISON_NGUNJIRI	0:0898e006947b	3822
EDISON_NGUNJIRI	0:0898e006947b	3823	// Set BL pin
EDISON_NGUNJIRI	0:0898e006947b	3824	void TextLCD_SPI_N::_setBL(bool value) {
EDISON_NGUNJIRI	0:0898e006947b	3825	if (_bl) {
EDISON_NGUNJIRI	0:0898e006947b	3826	_bl->write(value);
EDISON_NGUNJIRI	0:0898e006947b	3827	}
EDISON_NGUNJIRI	0:0898e006947b	3828	}
EDISON_NGUNJIRI	0:0898e006947b	3829
EDISON_NGUNJIRI	0:0898e006947b	3830	// Not used in this mode
EDISON_NGUNJIRI	0:0898e006947b	3831	void TextLCD_SPI_N::_setData(int value) {
EDISON_NGUNJIRI	0:0898e006947b	3832	}
EDISON_NGUNJIRI	0:0898e006947b	3833
EDISON_NGUNJIRI	0:0898e006947b	3834	// Write a byte using SPI
EDISON_NGUNJIRI	0:0898e006947b	3835	void TextLCD_SPI_N::_writeByte(int value) {
EDISON_NGUNJIRI	0:0898e006947b	3836	_cs = 0;
EDISON_NGUNJIRI	0:0898e006947b	3837	wait_us(1);
EDISON_NGUNJIRI	0:0898e006947b	3838	_spi->write(value);
EDISON_NGUNJIRI	0:0898e006947b	3839	wait_us(1);
EDISON_NGUNJIRI	0:0898e006947b	3840	_cs = 1;
EDISON_NGUNJIRI	0:0898e006947b	3841	}
EDISON_NGUNJIRI	0:0898e006947b	3842	#endif /* Native SPI bus */
EDISON_NGUNJIRI	0:0898e006947b	3843	//-------- End TextLCD_SPI_N ------------
EDISON_NGUNJIRI	0:0898e006947b	3844
EDISON_NGUNJIRI	0:0898e006947b	3845
EDISON_NGUNJIRI	0:0898e006947b	3846	//-------- Start TextLCD_SPI_N_3_8 --------
EDISON_NGUNJIRI	0:0898e006947b	3847	#if(LCD_SPI_N_3_8 == 1) /* Native SPI bus */
EDISON_NGUNJIRI	0:0898e006947b	3848
EDISON_NGUNJIRI	0:0898e006947b	3849	/** Create a TextLCD interface using a controller with a native SPI3 8 bits interface
EDISON_NGUNJIRI	0:0898e006947b	3850	* This mode is supported by ST7070. Note that implementation in TexTLCD is not very efficient due to
EDISON_NGUNJIRI	0:0898e006947b	3851	* structure of the TextLCD library: each databyte is written separately and requires a separate 'count command' set to 1 byte.
EDISON_NGUNJIRI	0:0898e006947b	3852	*
EDISON_NGUNJIRI	0:0898e006947b	3853	* @param spi SPI Bus
EDISON_NGUNJIRI	0:0898e006947b	3854	* @param cs chip select pin (active low)
EDISON_NGUNJIRI	0:0898e006947b	3855	* @param type Sets the panel size/addressing mode (default = LCD16x2)
EDISON_NGUNJIRI	0:0898e006947b	3856	* @param bl Backlight control line (optional, default = NC)
EDISON_NGUNJIRI	0:0898e006947b	3857	* @param ctrl LCD controller (default = ST7070)
EDISON_NGUNJIRI	0:0898e006947b	3858	*/
EDISON_NGUNJIRI	0:0898e006947b	3859	TextLCD_SPI_N_3_8::TextLCD_SPI_N_3_8(SPI *spi, PinName cs, LCDType type, PinName bl, LCDCtrl ctrl) :
EDISON_NGUNJIRI	0:0898e006947b	3860	TextLCD_Base(type, ctrl),
EDISON_NGUNJIRI	0:0898e006947b	3861	_spi(spi),
EDISON_NGUNJIRI	0:0898e006947b	3862	_cs(cs) {
EDISON_NGUNJIRI	0:0898e006947b	3863
EDISON_NGUNJIRI	0:0898e006947b	3864	// Init CS
EDISON_NGUNJIRI	0:0898e006947b	3865	_cs = 1;
EDISON_NGUNJIRI	0:0898e006947b	3866
EDISON_NGUNJIRI	0:0898e006947b	3867	// Setup the spi for 8 bit data, high steady state clock,
EDISON_NGUNJIRI	0:0898e006947b	3868	// rising edge capture, with a 500KHz or 1MHz clock rate
EDISON_NGUNJIRI	0:0898e006947b	3869	// _spi->format(8,3);
EDISON_NGUNJIRI	0:0898e006947b	3870	// _spi->frequency(500000);
EDISON_NGUNJIRI	0:0898e006947b	3871	// _spi->frequency(1000000);
EDISON_NGUNJIRI	0:0898e006947b	3872
EDISON_NGUNJIRI	0:0898e006947b	3873	// Setup the spi for 8 bit data, low steady state clock,
EDISON_NGUNJIRI	0:0898e006947b	3874	// rising edge capture, with a 500KHz or 1MHz clock rate
EDISON_NGUNJIRI	0:0898e006947b	3875	_spi->format(8,0);
EDISON_NGUNJIRI	0:0898e006947b	3876	// _spi->frequency(500000);
EDISON_NGUNJIRI	0:0898e006947b	3877	_spi->frequency(1000000);
EDISON_NGUNJIRI	0:0898e006947b	3878
EDISON_NGUNJIRI	0:0898e006947b	3879
EDISON_NGUNJIRI	0:0898e006947b	3880	// The hardware Backlight pin is optional. Test and make sure whether it exists or not to prevent illegal access.
EDISON_NGUNJIRI	0:0898e006947b	3881	if (bl != NC) {
EDISON_NGUNJIRI	0:0898e006947b	3882	_bl = new DigitalOut(bl); //Construct new pin
EDISON_NGUNJIRI	0:0898e006947b	3883	_bl->write(0); //Deactivate
EDISON_NGUNJIRI	0:0898e006947b	3884	}
EDISON_NGUNJIRI	0:0898e006947b	3885	else {
EDISON_NGUNJIRI	0:0898e006947b	3886	// No Hardware Backlight pin
EDISON_NGUNJIRI	0:0898e006947b	3887	_bl = NULL; //Construct dummy pin
EDISON_NGUNJIRI	0:0898e006947b	3888	}
EDISON_NGUNJIRI	0:0898e006947b	3889
EDISON_NGUNJIRI	0:0898e006947b	3890	//Sanity check
EDISON_NGUNJIRI	0:0898e006947b	3891	if (_ctrl & LCD_C_SPI3_8) {
EDISON_NGUNJIRI	0:0898e006947b	3892	_init(_LCD_DL_8); // Set Datalength to 8 bit for all native serial interfaces
EDISON_NGUNJIRI	0:0898e006947b	3893	}
EDISON_NGUNJIRI	0:0898e006947b	3894	else {
EDISON_NGUNJIRI	0:0898e006947b	3895	error("Error: LCD Controller type does not support native SPI3 8 bits interface\n\r");
EDISON_NGUNJIRI	0:0898e006947b	3896	}
EDISON_NGUNJIRI	0:0898e006947b	3897	}
EDISON_NGUNJIRI	0:0898e006947b	3898
EDISON_NGUNJIRI	0:0898e006947b	3899	TextLCD_SPI_N_3_8::~TextLCD_SPI_N_3_8() {
EDISON_NGUNJIRI	0:0898e006947b	3900	if (_bl != NULL) {delete _bl;} // BL pin
EDISON_NGUNJIRI	0:0898e006947b	3901	}
EDISON_NGUNJIRI	0:0898e006947b	3902
EDISON_NGUNJIRI	0:0898e006947b	3903	// Not used in this mode
EDISON_NGUNJIRI	0:0898e006947b	3904	void TextLCD_SPI_N_3_8::_setEnable(bool value) {
EDISON_NGUNJIRI	0:0898e006947b	3905	}
EDISON_NGUNJIRI	0:0898e006947b	3906
EDISON_NGUNJIRI	0:0898e006947b	3907	// Used for mbed pins, I2C bus expander or SPI shiftregister, SPI_N
EDISON_NGUNJIRI	0:0898e006947b	3908	// RS=1 means that next byte is data, RS=0 means that next byte is command
EDISON_NGUNJIRI	0:0898e006947b	3909	void TextLCD_SPI_N_3_8::_setRS(bool value) {
EDISON_NGUNJIRI	0:0898e006947b	3910
EDISON_NGUNJIRI	0:0898e006947b	3911	if (value) {
EDISON_NGUNJIRI	0:0898e006947b	3912	_controlbyte = 0x01; // Next byte is data, No more control bytes will follow
EDISON_NGUNJIRI	0:0898e006947b	3913	}
EDISON_NGUNJIRI	0:0898e006947b	3914	else {
EDISON_NGUNJIRI	0:0898e006947b	3915	_controlbyte = 0x00; // Next byte is command, No more control bytes will follow
EDISON_NGUNJIRI	0:0898e006947b	3916	}
EDISON_NGUNJIRI	0:0898e006947b	3917	}
EDISON_NGUNJIRI	0:0898e006947b	3918
EDISON_NGUNJIRI	0:0898e006947b	3919	// Set BL pin
EDISON_NGUNJIRI	0:0898e006947b	3920	void TextLCD_SPI_N_3_8::_setBL(bool value) {
EDISON_NGUNJIRI	0:0898e006947b	3921	if (_bl) {
EDISON_NGUNJIRI	0:0898e006947b	3922	_bl->write(value);
EDISON_NGUNJIRI	0:0898e006947b	3923	}
EDISON_NGUNJIRI	0:0898e006947b	3924	}
EDISON_NGUNJIRI	0:0898e006947b	3925
EDISON_NGUNJIRI	0:0898e006947b	3926	// Not used in this mode
EDISON_NGUNJIRI	0:0898e006947b	3927	void TextLCD_SPI_N_3_8::_setData(int value) {
EDISON_NGUNJIRI	0:0898e006947b	3928	}
EDISON_NGUNJIRI	0:0898e006947b	3929
EDISON_NGUNJIRI	0:0898e006947b	3930	// Write a byte using SPI3 8 bits mode (ST7070)
EDISON_NGUNJIRI	0:0898e006947b	3931	void TextLCD_SPI_N_3_8::_writeByte(int value) {
EDISON_NGUNJIRI	0:0898e006947b	3932
EDISON_NGUNJIRI	0:0898e006947b	3933	if (_controlbyte == 0x00) { // Byte is command
EDISON_NGUNJIRI	0:0898e006947b	3934	_cs = 0;
EDISON_NGUNJIRI	0:0898e006947b	3935	wait_us(1);
EDISON_NGUNJIRI	0:0898e006947b	3936	_spi->write(value);
EDISON_NGUNJIRI	0:0898e006947b	3937	wait_us(1);
EDISON_NGUNJIRI	0:0898e006947b	3938	_cs = 1;
EDISON_NGUNJIRI	0:0898e006947b	3939	}
EDISON_NGUNJIRI	0:0898e006947b	3940	else { // Byte is data
EDISON_NGUNJIRI	0:0898e006947b	3941	// Select Extended Instr Set
EDISON_NGUNJIRI	0:0898e006947b	3942	_cs = 0;
EDISON_NGUNJIRI	0:0898e006947b	3943	wait_us(1);
EDISON_NGUNJIRI	0:0898e006947b	3944	_spi->write(0x20 \| _function \| 0x04); // Set function, 0 0 1 DL N EXT=1 x x (Select Instr Set = 1));
EDISON_NGUNJIRI	0:0898e006947b	3945	wait_us(1);
EDISON_NGUNJIRI	0:0898e006947b	3946	_cs = 1;
EDISON_NGUNJIRI	0:0898e006947b	3947
EDISON_NGUNJIRI	0:0898e006947b	3948	wait_us(40); // Wait until command has finished...
EDISON_NGUNJIRI	0:0898e006947b	3949
EDISON_NGUNJIRI	0:0898e006947b	3950	// Set Count to 1 databyte
EDISON_NGUNJIRI	0:0898e006947b	3951	_cs = 0;
EDISON_NGUNJIRI	0:0898e006947b	3952	wait_us(1);
EDISON_NGUNJIRI	0:0898e006947b	3953	_spi->write(0x80); // Set display data length, 1 L6 L5 L4 L3 L2 L1 L0 (Instr Set = 1)
EDISON_NGUNJIRI	0:0898e006947b	3954	wait_us(1);
EDISON_NGUNJIRI	0:0898e006947b	3955	_cs = 1;
EDISON_NGUNJIRI	0:0898e006947b	3956
EDISON_NGUNJIRI	0:0898e006947b	3957	wait_us(40);
EDISON_NGUNJIRI	0:0898e006947b	3958
EDISON_NGUNJIRI	0:0898e006947b	3959	// Write 1 databyte
EDISON_NGUNJIRI	0:0898e006947b	3960	_cs = 0;
EDISON_NGUNJIRI	0:0898e006947b	3961	wait_us(1);
EDISON_NGUNJIRI	0:0898e006947b	3962	_spi->write(value); // Write data (Instr Set = 1)
EDISON_NGUNJIRI	0:0898e006947b	3963	wait_us(1);
EDISON_NGUNJIRI	0:0898e006947b	3964	_cs = 1;
EDISON_NGUNJIRI	0:0898e006947b	3965
EDISON_NGUNJIRI	0:0898e006947b	3966	wait_us(40);
EDISON_NGUNJIRI	0:0898e006947b	3967
EDISON_NGUNJIRI	0:0898e006947b	3968	// Select Standard Instr Set
EDISON_NGUNJIRI	0:0898e006947b	3969	_cs = 0;
EDISON_NGUNJIRI	0:0898e006947b	3970	wait_us(1);
EDISON_NGUNJIRI	0:0898e006947b	3971	_spi->write(0x20 \| _function); // Set function, 0 0 1 DL N EXT=0 x x (Select Instr Set = 0));
EDISON_NGUNJIRI	0:0898e006947b	3972	wait_us(1);
EDISON_NGUNJIRI	0:0898e006947b	3973	_cs = 1;
EDISON_NGUNJIRI	0:0898e006947b	3974	}
EDISON_NGUNJIRI	0:0898e006947b	3975	}
EDISON_NGUNJIRI	0:0898e006947b	3976	#endif /* Native SPI bus */
EDISON_NGUNJIRI	0:0898e006947b	3977	//------- End TextLCD_SPI_N_3_8 -----------
EDISON_NGUNJIRI	0:0898e006947b	3978
EDISON_NGUNJIRI	0:0898e006947b	3979
EDISON_NGUNJIRI	0:0898e006947b	3980	//-------- Start TextLCD_SPI_N_3_9 --------
EDISON_NGUNJIRI	0:0898e006947b	3981	#if(LCD_SPI_N_3_9 == 1) /* Native SPI bus */
EDISON_NGUNJIRI	0:0898e006947b	3982	//Code checked out on logic analyser. Not yet tested on hardware..
EDISON_NGUNJIRI	0:0898e006947b	3983
EDISON_NGUNJIRI	0:0898e006947b	3984	/** Create a TextLCD interface using a controller with a native SPI3 9 bits interface
EDISON_NGUNJIRI	0:0898e006947b	3985	*
EDISON_NGUNJIRI	0:0898e006947b	3986	* @param spi SPI Bus
EDISON_NGUNJIRI	0:0898e006947b	3987	* @param cs chip select pin (active low)
EDISON_NGUNJIRI	0:0898e006947b	3988	* @param type Sets the panel size/addressing mode (default = LCD16x2)
EDISON_NGUNJIRI	0:0898e006947b	3989	* @param bl Backlight control line (optional, default = NC)
EDISON_NGUNJIRI	0:0898e006947b	3990	* @param ctrl LCD controller (default = AIP31068)
EDISON_NGUNJIRI	0:0898e006947b	3991	*/
EDISON_NGUNJIRI	0:0898e006947b	3992	TextLCD_SPI_N_3_9::TextLCD_SPI_N_3_9(SPI *spi, PinName cs, LCDType type, PinName bl, LCDCtrl ctrl) :
EDISON_NGUNJIRI	0:0898e006947b	3993	TextLCD_Base(type, ctrl),
EDISON_NGUNJIRI	0:0898e006947b	3994	_spi(spi),
EDISON_NGUNJIRI	0:0898e006947b	3995	_cs(cs) {
EDISON_NGUNJIRI	0:0898e006947b	3996
EDISON_NGUNJIRI	0:0898e006947b	3997	// Init CS
EDISON_NGUNJIRI	0:0898e006947b	3998	_cs = 1;
EDISON_NGUNJIRI	0:0898e006947b	3999
EDISON_NGUNJIRI	0:0898e006947b	4000	// Setup the spi for 9 bit data, high steady state clock,
EDISON_NGUNJIRI	0:0898e006947b	4001	// rising edge capture, with a 500KHz or 1MHz clock rate
EDISON_NGUNJIRI	0:0898e006947b	4002	_spi->format(9,3);
EDISON_NGUNJIRI	0:0898e006947b	4003	_spi->frequency(1000000);
EDISON_NGUNJIRI	0:0898e006947b	4004
EDISON_NGUNJIRI	0:0898e006947b	4005	// The hardware Backlight pin is optional. Test and make sure whether it exists or not to prevent illegal access.
EDISON_NGUNJIRI	0:0898e006947b	4006	if (bl != NC) {
EDISON_NGUNJIRI	0:0898e006947b	4007	_bl = new DigitalOut(bl); //Construct new pin
EDISON_NGUNJIRI	0:0898e006947b	4008	_bl->write(0); //Deactivate
EDISON_NGUNJIRI	0:0898e006947b	4009	}
EDISON_NGUNJIRI	0:0898e006947b	4010	else {
EDISON_NGUNJIRI	0:0898e006947b	4011	// No Hardware Backlight pin
EDISON_NGUNJIRI	0:0898e006947b	4012	_bl = NULL; //Construct dummy pin
EDISON_NGUNJIRI	0:0898e006947b	4013	}
EDISON_NGUNJIRI	0:0898e006947b	4014
EDISON_NGUNJIRI	0:0898e006947b	4015	//Sanity check
EDISON_NGUNJIRI	0:0898e006947b	4016	if (_ctrl & LCD_C_SPI3_9) {
EDISON_NGUNJIRI	0:0898e006947b	4017	_init(_LCD_DL_8); // Set Datalength to 8 bit for all native serial interfaces
EDISON_NGUNJIRI	0:0898e006947b	4018	}
EDISON_NGUNJIRI	0:0898e006947b	4019	else {
EDISON_NGUNJIRI	0:0898e006947b	4020	error("Error: LCD Controller type does not support native SPI3 9 bits interface\n\r");
EDISON_NGUNJIRI	0:0898e006947b	4021	}
EDISON_NGUNJIRI	0:0898e006947b	4022	}
EDISON_NGUNJIRI	0:0898e006947b	4023
EDISON_NGUNJIRI	0:0898e006947b	4024	TextLCD_SPI_N_3_9::~TextLCD_SPI_N_3_9() {
EDISON_NGUNJIRI	0:0898e006947b	4025	if (_bl != NULL) {delete _bl;} // BL pin
EDISON_NGUNJIRI	0:0898e006947b	4026	}
EDISON_NGUNJIRI	0:0898e006947b	4027
EDISON_NGUNJIRI	0:0898e006947b	4028	// Not used in this mode
EDISON_NGUNJIRI	0:0898e006947b	4029	void TextLCD_SPI_N_3_9::_setEnable(bool value) {
EDISON_NGUNJIRI	0:0898e006947b	4030	}
EDISON_NGUNJIRI	0:0898e006947b	4031
EDISON_NGUNJIRI	0:0898e006947b	4032	// Set RS pin
EDISON_NGUNJIRI	0:0898e006947b	4033	// Used for mbed pins, I2C bus expander or SPI shiftregister
EDISON_NGUNJIRI	0:0898e006947b	4034	void TextLCD_SPI_N_3_9::_setRS(bool value) {
EDISON_NGUNJIRI	0:0898e006947b	4035	// The controlbits define the meaning of the next byte. This next byte can either be data or command.
EDISON_NGUNJIRI	0:0898e006947b	4036	// b8 b7...........b0
EDISON_NGUNJIRI	0:0898e006947b	4037	// RS command or data
EDISON_NGUNJIRI	0:0898e006947b	4038	//
EDISON_NGUNJIRI	0:0898e006947b	4039	// RS=1 means that next byte is data, RS=0 means that next byte is command
EDISON_NGUNJIRI	0:0898e006947b	4040	//
EDISON_NGUNJIRI	0:0898e006947b	4041
EDISON_NGUNJIRI	0:0898e006947b	4042	if (value) {
EDISON_NGUNJIRI	0:0898e006947b	4043	_controlbyte = 0x01; // Next byte is data
EDISON_NGUNJIRI	0:0898e006947b	4044	}
EDISON_NGUNJIRI	0:0898e006947b	4045	else {
EDISON_NGUNJIRI	0:0898e006947b	4046	_controlbyte = 0x00; // Next byte is command
EDISON_NGUNJIRI	0:0898e006947b	4047	}
EDISON_NGUNJIRI	0:0898e006947b	4048	}
EDISON_NGUNJIRI	0:0898e006947b	4049
EDISON_NGUNJIRI	0:0898e006947b	4050	// Set BL pin
EDISON_NGUNJIRI	0:0898e006947b	4051	void TextLCD_SPI_N_3_9::_setBL(bool value) {
EDISON_NGUNJIRI	0:0898e006947b	4052	if (_bl) {
EDISON_NGUNJIRI	0:0898e006947b	4053	_bl->write(value);
EDISON_NGUNJIRI	0:0898e006947b	4054	}
EDISON_NGUNJIRI	0:0898e006947b	4055	}
EDISON_NGUNJIRI	0:0898e006947b	4056
EDISON_NGUNJIRI	0:0898e006947b	4057	// Not used in this mode
EDISON_NGUNJIRI	0:0898e006947b	4058	void TextLCD_SPI_N_3_9::_setData(int value) {
EDISON_NGUNJIRI	0:0898e006947b	4059	}
EDISON_NGUNJIRI	0:0898e006947b	4060
EDISON_NGUNJIRI	0:0898e006947b	4061	// Write a byte using SPI3 9 bits mode
EDISON_NGUNJIRI	0:0898e006947b	4062	void TextLCD_SPI_N_3_9::_writeByte(int value) {
EDISON_NGUNJIRI	0:0898e006947b	4063	_cs = 0;
EDISON_NGUNJIRI	0:0898e006947b	4064	wait_us(1);
EDISON_NGUNJIRI	0:0898e006947b	4065	_spi->write( (_controlbyte << 8) \| (value & 0xFF));
EDISON_NGUNJIRI	0:0898e006947b	4066	wait_us(1);
EDISON_NGUNJIRI	0:0898e006947b	4067	_cs = 1;
EDISON_NGUNJIRI	0:0898e006947b	4068	}
EDISON_NGUNJIRI	0:0898e006947b	4069	#endif /* Native SPI bus */
EDISON_NGUNJIRI	0:0898e006947b	4070	//------- End TextLCD_SPI_N_3_9 -----------
EDISON_NGUNJIRI	0:0898e006947b	4071
EDISON_NGUNJIRI	0:0898e006947b	4072
EDISON_NGUNJIRI	0:0898e006947b	4073	//------- Start TextLCD_SPI_N_3_10 --------
EDISON_NGUNJIRI	0:0898e006947b	4074	#if(LCD_SPI_N_3_10 == 1) /* Native SPI bus */
EDISON_NGUNJIRI	0:0898e006947b	4075
EDISON_NGUNJIRI	0:0898e006947b	4076	/** Create a TextLCD interface using a controller with a native SPI3 10 bits interface
EDISON_NGUNJIRI	0:0898e006947b	4077	*
EDISON_NGUNJIRI	0:0898e006947b	4078	* @param spi SPI Bus
EDISON_NGUNJIRI	0:0898e006947b	4079	* @param cs chip select pin (active low)
EDISON_NGUNJIRI	0:0898e006947b	4080	* @param type Sets the panel size/addressing mode (default = LCD16x2)
EDISON_NGUNJIRI	0:0898e006947b	4081	* @param bl Backlight control line (optional, default = NC)
EDISON_NGUNJIRI	0:0898e006947b	4082	* @param ctrl LCD controller (default = AIP31068)
EDISON_NGUNJIRI	0:0898e006947b	4083	*/
EDISON_NGUNJIRI	0:0898e006947b	4084	TextLCD_SPI_N_3_10::TextLCD_SPI_N_3_10(SPI *spi, PinName cs, LCDType type, PinName bl, LCDCtrl ctrl) :
EDISON_NGUNJIRI	0:0898e006947b	4085	TextLCD_Base(type, ctrl),
EDISON_NGUNJIRI	0:0898e006947b	4086	_spi(spi),
EDISON_NGUNJIRI	0:0898e006947b	4087	_cs(cs) {
EDISON_NGUNJIRI	0:0898e006947b	4088
EDISON_NGUNJIRI	0:0898e006947b	4089	// Init CS
EDISON_NGUNJIRI	0:0898e006947b	4090	_cs = 1;
EDISON_NGUNJIRI	0:0898e006947b	4091
EDISON_NGUNJIRI	0:0898e006947b	4092	// Setup the spi for 10 bit data, low steady state clock,
EDISON_NGUNJIRI	0:0898e006947b	4093	// rising edge capture, with a 500KHz or 1MHz clock rate
EDISON_NGUNJIRI	0:0898e006947b	4094	_spi->format(10,0);
EDISON_NGUNJIRI	0:0898e006947b	4095	_spi->frequency(1000000);
EDISON_NGUNJIRI	0:0898e006947b	4096
EDISON_NGUNJIRI	0:0898e006947b	4097	// The hardware Backlight pin is optional. Test and make sure whether it exists or not to prevent illegal access.
EDISON_NGUNJIRI	0:0898e006947b	4098	if (bl != NC) {
EDISON_NGUNJIRI	0:0898e006947b	4099	_bl = new DigitalOut(bl); //Construct new pin
EDISON_NGUNJIRI	0:0898e006947b	4100	_bl->write(0); //Deactivate
EDISON_NGUNJIRI	0:0898e006947b	4101	}
EDISON_NGUNJIRI	0:0898e006947b	4102	else {
EDISON_NGUNJIRI	0:0898e006947b	4103	// No Hardware Backlight pin
EDISON_NGUNJIRI	0:0898e006947b	4104	_bl = NULL; //Construct dummy pin
EDISON_NGUNJIRI	0:0898e006947b	4105	}
EDISON_NGUNJIRI	0:0898e006947b	4106
EDISON_NGUNJIRI	0:0898e006947b	4107	//Sanity check
EDISON_NGUNJIRI	0:0898e006947b	4108	if (_ctrl & LCD_C_SPI3_10) {
EDISON_NGUNJIRI	0:0898e006947b	4109	_init(_LCD_DL_8); // Set Datalength to 8 bit for all native serial interfaces
EDISON_NGUNJIRI	0:0898e006947b	4110	}
EDISON_NGUNJIRI	0:0898e006947b	4111	else {
EDISON_NGUNJIRI	0:0898e006947b	4112	error("Error: LCD Controller type does not support native SPI3 10 bits interface\n\r");
EDISON_NGUNJIRI	0:0898e006947b	4113	}
EDISON_NGUNJIRI	0:0898e006947b	4114	}
EDISON_NGUNJIRI	0:0898e006947b	4115
EDISON_NGUNJIRI	0:0898e006947b	4116	TextLCD_SPI_N_3_10::~TextLCD_SPI_N_3_10() {
EDISON_NGUNJIRI	0:0898e006947b	4117	if (_bl != NULL) {delete _bl;} // BL pin
EDISON_NGUNJIRI	0:0898e006947b	4118	}
EDISON_NGUNJIRI	0:0898e006947b	4119
EDISON_NGUNJIRI	0:0898e006947b	4120	// Not used in this mode
EDISON_NGUNJIRI	0:0898e006947b	4121	void TextLCD_SPI_N_3_10::_setEnable(bool value) {
EDISON_NGUNJIRI	0:0898e006947b	4122	}
EDISON_NGUNJIRI	0:0898e006947b	4123
EDISON_NGUNJIRI	0:0898e006947b	4124	// Set RS pin
EDISON_NGUNJIRI	0:0898e006947b	4125	// Used for mbed pins, I2C bus expander or SPI shiftregister
EDISON_NGUNJIRI	0:0898e006947b	4126	void TextLCD_SPI_N_3_10::_setRS(bool value) {
EDISON_NGUNJIRI	0:0898e006947b	4127	// The controlbits define the meaning of the next byte. This next byte can either be data or command.
EDISON_NGUNJIRI	0:0898e006947b	4128	// b9 b8 b7...........b0
EDISON_NGUNJIRI	0:0898e006947b	4129	// RS RW command or data
EDISON_NGUNJIRI	0:0898e006947b	4130	//
EDISON_NGUNJIRI	0:0898e006947b	4131	// RS=1 means that next byte is data, RS=0 means that next byte is command
EDISON_NGUNJIRI	0:0898e006947b	4132	// RW=0 means that next byte is writen, RW=1 means that next byte is read (not used in this lib)
EDISON_NGUNJIRI	0:0898e006947b	4133	//
EDISON_NGUNJIRI	0:0898e006947b	4134
EDISON_NGUNJIRI	0:0898e006947b	4135	if (value) {
EDISON_NGUNJIRI	0:0898e006947b	4136	_controlbyte = 0x02; // Next byte is data
EDISON_NGUNJIRI	0:0898e006947b	4137	}
EDISON_NGUNJIRI	0:0898e006947b	4138	else {
EDISON_NGUNJIRI	0:0898e006947b	4139	_controlbyte = 0x00; // Next byte is command
EDISON_NGUNJIRI	0:0898e006947b	4140	}
EDISON_NGUNJIRI	0:0898e006947b	4141	}
EDISON_NGUNJIRI	0:0898e006947b	4142
EDISON_NGUNJIRI	0:0898e006947b	4143	// Set BL pin
EDISON_NGUNJIRI	0:0898e006947b	4144	void TextLCD_SPI_N_3_10::_setBL(bool value) {
EDISON_NGUNJIRI	0:0898e006947b	4145	if (_bl) {
EDISON_NGUNJIRI	0:0898e006947b	4146	_bl->write(value);
EDISON_NGUNJIRI	0:0898e006947b	4147	}
EDISON_NGUNJIRI	0:0898e006947b	4148	}
EDISON_NGUNJIRI	0:0898e006947b	4149
EDISON_NGUNJIRI	0:0898e006947b	4150	// Not used in this mode
EDISON_NGUNJIRI	0:0898e006947b	4151	void TextLCD_SPI_N_3_10::_setData(int value) {
EDISON_NGUNJIRI	0:0898e006947b	4152	}
EDISON_NGUNJIRI	0:0898e006947b	4153
EDISON_NGUNJIRI	0:0898e006947b	4154	// Write a byte using SPI3 10 bits mode
EDISON_NGUNJIRI	0:0898e006947b	4155	void TextLCD_SPI_N_3_10::_writeByte(int value) {
EDISON_NGUNJIRI	0:0898e006947b	4156	_cs = 0;
EDISON_NGUNJIRI	0:0898e006947b	4157	wait_us(1);
EDISON_NGUNJIRI	0:0898e006947b	4158	_spi->write( (_controlbyte << 8) \| (value & 0xFF));
EDISON_NGUNJIRI	0:0898e006947b	4159	wait_us(1);
EDISON_NGUNJIRI	0:0898e006947b	4160	_cs = 1;
EDISON_NGUNJIRI	0:0898e006947b	4161	}
EDISON_NGUNJIRI	0:0898e006947b	4162	#endif /* Native SPI bus */
EDISON_NGUNJIRI	0:0898e006947b	4163	//------- End TextLCD_SPI_N_3_10 ----------
EDISON_NGUNJIRI	0:0898e006947b	4164
EDISON_NGUNJIRI	0:0898e006947b	4165
EDISON_NGUNJIRI	0:0898e006947b	4166	//------- Start TextLCD_SPI_N_3_16 --------
EDISON_NGUNJIRI	0:0898e006947b	4167	#if(LCD_SPI_N_3_16 == 1) /* Native SPI bus */
EDISON_NGUNJIRI	0:0898e006947b	4168
EDISON_NGUNJIRI	0:0898e006947b	4169	/** Create a TextLCD interface using a controller with a native SPI3 16 bits interface
EDISON_NGUNJIRI	0:0898e006947b	4170	*
EDISON_NGUNJIRI	0:0898e006947b	4171	* @param spi SPI Bus
EDISON_NGUNJIRI	0:0898e006947b	4172	* @param cs chip select pin (active low)
EDISON_NGUNJIRI	0:0898e006947b	4173	* @param type Sets the panel size/addressing mode (default = LCD16x2)
EDISON_NGUNJIRI	0:0898e006947b	4174	* @param bl Backlight control line (optional, default = NC)
EDISON_NGUNJIRI	0:0898e006947b	4175	* @param ctrl LCD controller (default = PT6314)
EDISON_NGUNJIRI	0:0898e006947b	4176	*/
EDISON_NGUNJIRI	0:0898e006947b	4177	TextLCD_SPI_N_3_16::TextLCD_SPI_N_3_16(SPI *spi, PinName cs, LCDType type, PinName bl, LCDCtrl ctrl) :
EDISON_NGUNJIRI	0:0898e006947b	4178	TextLCD_Base(type, ctrl),
EDISON_NGUNJIRI	0:0898e006947b	4179	_spi(spi),
EDISON_NGUNJIRI	0:0898e006947b	4180	_cs(cs) {
EDISON_NGUNJIRI	0:0898e006947b	4181
EDISON_NGUNJIRI	0:0898e006947b	4182	// Init CS
EDISON_NGUNJIRI	0:0898e006947b	4183	_cs = 1;
EDISON_NGUNJIRI	0:0898e006947b	4184
EDISON_NGUNJIRI	0:0898e006947b	4185	// Setup the spi for 8 bit data, low steady state clock,
EDISON_NGUNJIRI	0:0898e006947b	4186	// rising edge capture, with a 500KHz or 1MHz clock rate
EDISON_NGUNJIRI	0:0898e006947b	4187	_spi->format(8,0);
EDISON_NGUNJIRI	0:0898e006947b	4188	_spi->frequency(1000000);
EDISON_NGUNJIRI	0:0898e006947b	4189
EDISON_NGUNJIRI	0:0898e006947b	4190	// The hardware Backlight pin is optional. Test and make sure whether it exists or not to prevent illegal access.
EDISON_NGUNJIRI	0:0898e006947b	4191	if (bl != NC) {
EDISON_NGUNJIRI	0:0898e006947b	4192	_bl = new DigitalOut(bl); //Construct new pin
EDISON_NGUNJIRI	0:0898e006947b	4193	_bl->write(0); //Deactivate
EDISON_NGUNJIRI	0:0898e006947b	4194	}
EDISON_NGUNJIRI	0:0898e006947b	4195	else {
EDISON_NGUNJIRI	0:0898e006947b	4196	// No Hardware Backlight pin
EDISON_NGUNJIRI	0:0898e006947b	4197	_bl = NULL; //Construct dummy pin
EDISON_NGUNJIRI	0:0898e006947b	4198	}
EDISON_NGUNJIRI	0:0898e006947b	4199
EDISON_NGUNJIRI	0:0898e006947b	4200	//Sanity check
EDISON_NGUNJIRI	0:0898e006947b	4201	if (_ctrl & LCD_C_SPI3_16) {
EDISON_NGUNJIRI	0:0898e006947b	4202	_init(_LCD_DL_8); // Set Datalength to 8 bit for all native serial interfaces
EDISON_NGUNJIRI	0:0898e006947b	4203	}
EDISON_NGUNJIRI	0:0898e006947b	4204	else {
EDISON_NGUNJIRI	0:0898e006947b	4205	error("Error: LCD Controller type does not support native SPI3 16 bits interface\n\r");
EDISON_NGUNJIRI	0:0898e006947b	4206	}
EDISON_NGUNJIRI	0:0898e006947b	4207	}
EDISON_NGUNJIRI	0:0898e006947b	4208
EDISON_NGUNJIRI	0:0898e006947b	4209	TextLCD_SPI_N_3_16::~TextLCD_SPI_N_3_16() {
EDISON_NGUNJIRI	0:0898e006947b	4210	if (_bl != NULL) {delete _bl;} // BL pin
EDISON_NGUNJIRI	0:0898e006947b	4211	}
EDISON_NGUNJIRI	0:0898e006947b	4212
EDISON_NGUNJIRI	0:0898e006947b	4213	// Not used in this mode
EDISON_NGUNJIRI	0:0898e006947b	4214	void TextLCD_SPI_N_3_16::_setEnable(bool value) {
EDISON_NGUNJIRI	0:0898e006947b	4215	}
EDISON_NGUNJIRI	0:0898e006947b	4216
EDISON_NGUNJIRI	0:0898e006947b	4217	// Set RS pin
EDISON_NGUNJIRI	0:0898e006947b	4218	// Used for mbed pins, I2C bus expander or SPI shiftregister
EDISON_NGUNJIRI	0:0898e006947b	4219	void TextLCD_SPI_N_3_16::_setRS(bool value) {
EDISON_NGUNJIRI	0:0898e006947b	4220	// The 16bit mode is split in 2 bytes. The first byte is for synchronisation and controlbits. The controlbits define the meaning of the next byte.
EDISON_NGUNJIRI	0:0898e006947b	4221	// The 8 actual bits represent either a data or a command byte.
EDISON_NGUNJIRI	0:0898e006947b	4222	// b15 b14 b13 b12 b11 b10 b9 b8 - b7 b6 b5 b4 b3 b2 b1 b0
EDISON_NGUNJIRI	0:0898e006947b	4223	// 1 1 1 1 1 RW RS 0 d7 d6 d5 d4 d3 d2 d1 d0
EDISON_NGUNJIRI	0:0898e006947b	4224	//
EDISON_NGUNJIRI	0:0898e006947b	4225	// RS=1 means that next byte is data, RS=0 means that next byte is command
EDISON_NGUNJIRI	0:0898e006947b	4226	// RW=0 means that next byte is writen, RW=1 means that next byte is read (not used in this lib)
EDISON_NGUNJIRI	0:0898e006947b	4227	//
EDISON_NGUNJIRI	0:0898e006947b	4228
EDISON_NGUNJIRI	0:0898e006947b	4229	if (value) {
EDISON_NGUNJIRI	0:0898e006947b	4230	_controlbyte = 0xFA; // Next byte is data
EDISON_NGUNJIRI	0:0898e006947b	4231	}
EDISON_NGUNJIRI	0:0898e006947b	4232	else {
EDISON_NGUNJIRI	0:0898e006947b	4233	_controlbyte = 0xF8; // Next byte is command
EDISON_NGUNJIRI	0:0898e006947b	4234	}
EDISON_NGUNJIRI	0:0898e006947b	4235	}
EDISON_NGUNJIRI	0:0898e006947b	4236
EDISON_NGUNJIRI	0:0898e006947b	4237	// Set BL pin
EDISON_NGUNJIRI	0:0898e006947b	4238	void TextLCD_SPI_N_3_16::_setBL(bool value) {
EDISON_NGUNJIRI	0:0898e006947b	4239	if (_bl) {
EDISON_NGUNJIRI	0:0898e006947b	4240	_bl->write(value);
EDISON_NGUNJIRI	0:0898e006947b	4241	}
EDISON_NGUNJIRI	0:0898e006947b	4242	}
EDISON_NGUNJIRI	0:0898e006947b	4243
EDISON_NGUNJIRI	0:0898e006947b	4244	// Not used in this mode
EDISON_NGUNJIRI	0:0898e006947b	4245	void TextLCD_SPI_N_3_16::_setData(int value) {
EDISON_NGUNJIRI	0:0898e006947b	4246	}
EDISON_NGUNJIRI	0:0898e006947b	4247
EDISON_NGUNJIRI	0:0898e006947b	4248	// Write a byte using SPI3 16 bits mode
EDISON_NGUNJIRI	0:0898e006947b	4249	void TextLCD_SPI_N_3_16::_writeByte(int value) {
EDISON_NGUNJIRI	0:0898e006947b	4250	_cs = 0;
EDISON_NGUNJIRI	0:0898e006947b	4251	wait_us(1);
EDISON_NGUNJIRI	0:0898e006947b	4252
EDISON_NGUNJIRI	0:0898e006947b	4253	_spi->write(_controlbyte);
EDISON_NGUNJIRI	0:0898e006947b	4254
EDISON_NGUNJIRI	0:0898e006947b	4255	_spi->write(value);
EDISON_NGUNJIRI	0:0898e006947b	4256
EDISON_NGUNJIRI	0:0898e006947b	4257	wait_us(1);
EDISON_NGUNJIRI	0:0898e006947b	4258	_cs = 1;
EDISON_NGUNJIRI	0:0898e006947b	4259	}
EDISON_NGUNJIRI	0:0898e006947b	4260	#endif /* Native SPI bus */
EDISON_NGUNJIRI	0:0898e006947b	4261	//------- End TextLCD_SPI_N_3_16 ----------
EDISON_NGUNJIRI	0:0898e006947b	4262
EDISON_NGUNJIRI	0:0898e006947b	4263
EDISON_NGUNJIRI	0:0898e006947b	4264	//------- Start TextLCD_SPI_N_3_24 --------
EDISON_NGUNJIRI	0:0898e006947b	4265	#if(LCD_SPI_N_3_24 == 1) /* Native SPI bus */
EDISON_NGUNJIRI	0:0898e006947b	4266
EDISON_NGUNJIRI	0:0898e006947b	4267	/** Create a TextLCD interface using a controller with a native SPI3 24 bits interface
EDISON_NGUNJIRI	0:0898e006947b	4268	*
EDISON_NGUNJIRI	0:0898e006947b	4269	* @param spi SPI Bus
EDISON_NGUNJIRI	0:0898e006947b	4270	* @param cs chip select pin (active low)
EDISON_NGUNJIRI	0:0898e006947b	4271	* @param type Sets the panel size/addressing mode (default = LCD16x2)
EDISON_NGUNJIRI	0:0898e006947b	4272	* @param bl Backlight control line (optional, default = NC)
EDISON_NGUNJIRI	0:0898e006947b	4273	* @param ctrl LCD controller (default = SSD1803)
EDISON_NGUNJIRI	0:0898e006947b	4274	*/
EDISON_NGUNJIRI	0:0898e006947b	4275	TextLCD_SPI_N_3_24::TextLCD_SPI_N_3_24(SPI *spi, PinName cs, LCDType type, PinName bl, LCDCtrl ctrl) :
EDISON_NGUNJIRI	0:0898e006947b	4276	TextLCD_Base(type, ctrl),
EDISON_NGUNJIRI	0:0898e006947b	4277	_spi(spi),
EDISON_NGUNJIRI	0:0898e006947b	4278	_cs(cs) {
EDISON_NGUNJIRI	0:0898e006947b	4279
EDISON_NGUNJIRI	0:0898e006947b	4280	// Init CS
EDISON_NGUNJIRI	0:0898e006947b	4281	_cs = 1;
EDISON_NGUNJIRI	0:0898e006947b	4282
EDISON_NGUNJIRI	0:0898e006947b	4283	// Setup the spi for 8 bit data, high steady state clock,
EDISON_NGUNJIRI	0:0898e006947b	4284	// rising edge capture, with a 500KHz or 1MHz clock rate
EDISON_NGUNJIRI	0:0898e006947b	4285	_spi->format(8,3);
EDISON_NGUNJIRI	0:0898e006947b	4286	_spi->frequency(1000000);
EDISON_NGUNJIRI	0:0898e006947b	4287
EDISON_NGUNJIRI	0:0898e006947b	4288	// The hardware Backlight pin is optional. Test and make sure whether it exists or not to prevent illegal access.
EDISON_NGUNJIRI	0:0898e006947b	4289	if (bl != NC) {
EDISON_NGUNJIRI	0:0898e006947b	4290	_bl = new DigitalOut(bl); //Construct new pin
EDISON_NGUNJIRI	0:0898e006947b	4291	_bl->write(0); //Deactivate
EDISON_NGUNJIRI	0:0898e006947b	4292	}
EDISON_NGUNJIRI	0:0898e006947b	4293	else {
EDISON_NGUNJIRI	0:0898e006947b	4294	// No Hardware Backlight pin
EDISON_NGUNJIRI	0:0898e006947b	4295	_bl = NULL; //Construct dummy pin
EDISON_NGUNJIRI	0:0898e006947b	4296	}
EDISON_NGUNJIRI	0:0898e006947b	4297
EDISON_NGUNJIRI	0:0898e006947b	4298	//Sanity check
EDISON_NGUNJIRI	0:0898e006947b	4299	if (_ctrl & LCD_C_SPI3_24) {
EDISON_NGUNJIRI	0:0898e006947b	4300	_init(_LCD_DL_8); // Set Datalength to 8 bit for all native serial interfaces
EDISON_NGUNJIRI	0:0898e006947b	4301	}
EDISON_NGUNJIRI	0:0898e006947b	4302	else {
EDISON_NGUNJIRI	0:0898e006947b	4303	error("Error: LCD Controller type does not support native SPI3 24 bits interface\n\r");
EDISON_NGUNJIRI	0:0898e006947b	4304	}
EDISON_NGUNJIRI	0:0898e006947b	4305	}
EDISON_NGUNJIRI	0:0898e006947b	4306
EDISON_NGUNJIRI	0:0898e006947b	4307	TextLCD_SPI_N_3_24::~TextLCD_SPI_N_3_24() {
EDISON_NGUNJIRI	0:0898e006947b	4308	if (_bl != NULL) {delete _bl;} // BL pin
EDISON_NGUNJIRI	0:0898e006947b	4309	}
EDISON_NGUNJIRI	0:0898e006947b	4310
EDISON_NGUNJIRI	0:0898e006947b	4311	// Not used in this mode
EDISON_NGUNJIRI	0:0898e006947b	4312	void TextLCD_SPI_N_3_24::_setEnable(bool value) {
EDISON_NGUNJIRI	0:0898e006947b	4313	}
EDISON_NGUNJIRI	0:0898e006947b	4314
EDISON_NGUNJIRI	0:0898e006947b	4315	// Set RS pin
EDISON_NGUNJIRI	0:0898e006947b	4316	// Used for mbed pins, I2C bus expander or SPI shiftregister
EDISON_NGUNJIRI	0:0898e006947b	4317	void TextLCD_SPI_N_3_24::_setRS(bool value) {
EDISON_NGUNJIRI	0:0898e006947b	4318	// The 24bit mode is split in 3 bytes. The first byte is for synchronisation and controlbits. The controlbits define the meaning of the next two bytes.
EDISON_NGUNJIRI	0:0898e006947b	4319	// Each byte encodes 4 actual bits. The 8 actual bits represent either a data or a command byte.
EDISON_NGUNJIRI	0:0898e006947b	4320	// b23 b22 b21 b20 b19 b18 b17 b16 - b15 b14 b13 b12 b11 b10 b9 b8 - b7 b6 b5 b4 b3 b2 b1 b0
EDISON_NGUNJIRI	0:0898e006947b	4321	// 1 1 1 1 1 RW RS 0 d0 d1 d2 d3 0 0 0 0 d4 d5 d6 d7 0 0 0 0
EDISON_NGUNJIRI	0:0898e006947b	4322	//
EDISON_NGUNJIRI	0:0898e006947b	4323	// RS=1 means that next byte is data, RS=0 means that next byte is command
EDISON_NGUNJIRI	0:0898e006947b	4324	// RW=0 means that next byte is writen, RW=1 means that next byte is read (not used in this lib)
EDISON_NGUNJIRI	0:0898e006947b	4325	//
EDISON_NGUNJIRI	0:0898e006947b	4326	// Note: SPI3_24 expects LSB first. This is inconsistent with regular SPI convention (and hardware) that sends MSB first.
EDISON_NGUNJIRI	0:0898e006947b	4327
EDISON_NGUNJIRI	0:0898e006947b	4328	if (value) {
EDISON_NGUNJIRI	0:0898e006947b	4329	_controlbyte = 0xFA; // Next byte is data
EDISON_NGUNJIRI	0:0898e006947b	4330	}
EDISON_NGUNJIRI	0:0898e006947b	4331	else {
EDISON_NGUNJIRI	0:0898e006947b	4332	_controlbyte = 0xF8; // Next byte is command
EDISON_NGUNJIRI	0:0898e006947b	4333	}
EDISON_NGUNJIRI	0:0898e006947b	4334	}
EDISON_NGUNJIRI	0:0898e006947b	4335
EDISON_NGUNJIRI	0:0898e006947b	4336	// Set BL pin
EDISON_NGUNJIRI	0:0898e006947b	4337	void TextLCD_SPI_N_3_24::_setBL(bool value) {
EDISON_NGUNJIRI	0:0898e006947b	4338	if (_bl) {
EDISON_NGUNJIRI	0:0898e006947b	4339	_bl->write(value);
EDISON_NGUNJIRI	0:0898e006947b	4340	}
EDISON_NGUNJIRI	0:0898e006947b	4341	}
EDISON_NGUNJIRI	0:0898e006947b	4342
EDISON_NGUNJIRI	0:0898e006947b	4343	// Not used in this mode
EDISON_NGUNJIRI	0:0898e006947b	4344	void TextLCD_SPI_N_3_24::_setData(int value) {
EDISON_NGUNJIRI	0:0898e006947b	4345	}
EDISON_NGUNJIRI	0:0898e006947b	4346
EDISON_NGUNJIRI	0:0898e006947b	4347	//Mapping table to flip the bits around cause SPI3_24 expects LSB first.
EDISON_NGUNJIRI	0:0898e006947b	4348	const uint8_t map3_24[16] = {0x00, 0x80, 0x40, 0xC0, 0x20, 0xA0, 0x60, 0xE0, 0x10, 0x90, 0x50, 0xD0, 0x30, 0xB0, 0x70, 0xF0};
EDISON_NGUNJIRI	0:0898e006947b	4349
EDISON_NGUNJIRI	0:0898e006947b	4350	// Write a byte using SPI3 24 bits mode
EDISON_NGUNJIRI	0:0898e006947b	4351	void TextLCD_SPI_N_3_24::_writeByte(int value) {
EDISON_NGUNJIRI	0:0898e006947b	4352	_cs = 0;
EDISON_NGUNJIRI	0:0898e006947b	4353	wait_us(1);
EDISON_NGUNJIRI	0:0898e006947b	4354	_spi->write(_controlbyte);
EDISON_NGUNJIRI	0:0898e006947b	4355
EDISON_NGUNJIRI	0:0898e006947b	4356	//Map and send the LSB nibble
EDISON_NGUNJIRI	0:0898e006947b	4357	_spi->write( map3_24[value & 0x0F]);
EDISON_NGUNJIRI	0:0898e006947b	4358
EDISON_NGUNJIRI	0:0898e006947b	4359	//Map and send the MSB nibble
EDISON_NGUNJIRI	0:0898e006947b	4360	_spi->write( map3_24[(value >> 4) & 0x0F]);
EDISON_NGUNJIRI	0:0898e006947b	4361
EDISON_NGUNJIRI	0:0898e006947b	4362	wait_us(1);
EDISON_NGUNJIRI	0:0898e006947b	4363	_cs = 1;
EDISON_NGUNJIRI	0:0898e006947b	4364	}
EDISON_NGUNJIRI	0:0898e006947b	4365	#endif /* Native SPI bus */
EDISON_NGUNJIRI	0:0898e006947b	4366	//------- End TextLCD_SPI_N_3_24 ----------

Repository toolbox

Export to desktop IDE

Build repository

Repository details

Type:	Program
Created:	16 May 2022
Imports:	1
Forks:	0
Commits:	1
Dependents:	0
Dependencies:	0
Followers:	1

The code in this repository is Apache licensed.

TextLCD.cpp@0:0898e006947b, 2022-05-16 (annotated)

Who changed what in which revision?

Repository toolbox

Repository details

Important Information for this Arm website

Access Warning