TextLCD | Mbed

Users » sergiomejia » Code » TextLCD

TextLCD.cpp@9:2dc192cd376a, 2020-01-15 (annotated)

Committer:: sergiomejia
Date:: Wed Jan 15 00:00:30 2020 +0000
Revision:: 9:2dc192cd376a
Parent:: 7:44f34c09bd37

Programa para probar el LCD

Who changed what in which revision?

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

Repository toolbox

Repository details

Type:	Library
Created:	15 Jan 2020
Imports:	8
Forks:	0
Commits:	10
Dependents:	0
Dependencies:	0
Followers:	1

Important changes to repositories hosted on mbed.com

TextLCD.cpp@9:2dc192cd376a, 2020-01-15 (annotated)

Who changed what in which revision?

Repository toolbox

Repository details

Important Information for this Arm website

Important changes to repositories hosted on mbed.com

TextLCD.cpp@9:2dc192cd376a, 2020-01-15 (annotated)

Who changed what in which revision?

Repository toolbox

Repository details

Important Information for this Arm website

Access Warning