Example of how to use an Ada Fruit RGB LCD with the Ada Fruit RGB LCD Shield Library

Dependencies:   AdaFruit_RGBLCDShield MCP23017 mbed RTclock

Dependents:   SX1276_GPS

Fork of MCP_test by Wim Huiskamp

Updated the Adafruit RGB LCD Shield test app with a module system.

It pulls in RTclock which is another library I did for controlling the DS1307 RTC in a sane way (marries stdlib time and the RTC together cleanly). You don't need an RTC to run the example, it'll just use stdlib time instead. This class also maps RTC to system time, so if you loose the RTC the mbed will free run.

Four modules are defined in the modules folder plus the module base class. These examples provide:

  • title menu item
  • time menu item (updates automatically)
  • date menu item
  • fake temp menu item

Press select to switch modes: menu->cursor->change

Menu switches menu items going up/down. Cursor allows you to move around editable fields using the cursor keys / marker. Change allows you to move left/right on a particular line and change values by using up/down on an item with the blink box.

Custom fonts are defined for UI arrows and degree character.

If you want a menu item to update over time then you need to implement the canRefresh() member function in any child module you derive from class Module. Make it return true to receive update requests in your show() member function. Date and time both check when refreshing to see if anything has changed, then update.

main() registers a table of modules with the MenuManager. Others can be added easily by creating children derived from the Module base class..

Depending on what you want to do you may need to adjust the loop wait time in MenuManager::loop(). If you don't balance this based on work you need to do then the key presses may get a little lively. I may adjust the key checking to be fixed to 200ms regardless of loop wait time, however the catch there is that you'll consume more power the more loops you do so the wait is still important.

Happy coding!

Files at this revision

API Documentation at this revision

Comitter:
vtraveller
Date:
Sat Aug 02 12:39:25 2014 +0000
Parent:
2:ac3b92ebf17a
Child:
4:d70e37f6c6bd
Commit message:
snapshot

Changed in this revision

AdaFruit_RGBLCDShield.cpp Show annotated file Show diff for this revision Revisions of this file
Adafruit_RGBLCDShield.h Show annotated file Show diff for this revision Revisions of this file
MCP23017.lib Show annotated file Show diff for this revision Revisions of this file
main.cpp Show annotated file Show diff for this revision Revisions of this file
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/AdaFruit_RGBLCDShield.cpp	Sat Aug 02 12:39:25 2014 +0000
@@ -0,0 +1,436 @@
+/*************************************************** 
+  This is a library for the Adafruit RGB 16x2 LCD Shield 
+  Pick one up at the Adafruit shop!
+  ---------> http://http://www.adafruit.com/products/714
+
+  The shield uses I2C to communicate, 2 pins are required to  
+  interface
+  Adafruit invests time and resources providing this open source code, 
+  please support Adafruit and open-source hardware by purchasing 
+  products from Adafruit!
+
+  Written by Limor Fried/Ladyada for Adafruit Industries.  
+  BSD license, all text above must be included in any redistribution
+ ****************************************************/
+
+
+#include "Adafruit_RGBLCDShield.h"
+
+#include <stdio.h>
+#include <string.h>
+#include <inttypes.h>
+#include <Wire.h>
+#ifdef __AVR__
+ #define WIRE Wire
+#else // Arduino Due
+ #define WIRE Wire1
+#endif
+
+#if ARDUINO >= 100
+ #include "Arduino.h"
+#else
+ #include "WProgram.h"
+#endif
+
+// When the display powers up, it is configured as follows:
+//
+// 1. Display clear
+// 2. Function set: 
+//    DL = 1; 8-bit interface data 
+//    N = 0; 1-line display 
+//    F = 0; 5x8 dot character font 
+// 3. Display on/off control: 
+//    D = 0; Display off 
+//    C = 0; Cursor off 
+//    B = 0; Blinking off 
+// 4. Entry mode set: 
+//    I/D = 1; Increment by 1 
+//    S = 0; No shift 
+//
+// Note, however, that resetting the Arduino doesn't reset the LCD, so we
+// can't assume that its in that state when a sketch starts (and the
+// RGBLCDShield constructor is called).
+
+Adafruit_RGBLCDShield::Adafruit_RGBLCDShield() {
+  _i2cAddr = 0;
+
+  _displayfunction = LCD_4BITMODE | LCD_1LINE | LCD_5x8DOTS;
+  
+  // the I/O expander pinout
+  _rs_pin = 15;
+  _rw_pin = 14;
+  _enable_pin = 13;
+  _data_pins[0] = 12;  // really d4
+  _data_pins[1] = 11;  // really d5
+  _data_pins[2] = 10;  // really d6
+  _data_pins[3] = 9;  // really d7
+  
+  _button_pins[0] = 0;
+  _button_pins[1] = 1;
+  _button_pins[2] = 2;
+  _button_pins[3] = 3;
+  _button_pins[4] = 4;
+  // we can't begin() yet :(
+}
+
+
+
+
+void Adafruit_RGBLCDShield::init(uint8_t fourbitmode, uint8_t rs, uint8_t rw, uint8_t enable,
+             uint8_t d0, uint8_t d1, uint8_t d2, uint8_t d3,
+             uint8_t d4, uint8_t d5, uint8_t d6, uint8_t d7)
+{
+  _rs_pin = rs;
+  _rw_pin = rw;
+  _enable_pin = enable;
+  
+  _data_pins[0] = d0;
+  _data_pins[1] = d1;
+  _data_pins[2] = d2;
+  _data_pins[3] = d3; 
+  _data_pins[4] = d4;
+  _data_pins[5] = d5;
+  _data_pins[6] = d6;
+  _data_pins[7] = d7; 
+
+  _i2cAddr = 255;
+
+  _pinMode(_rs_pin, OUTPUT);
+  // we can save 1 pin by not using RW. Indicate by passing 255 instead of pin#
+  if (_rw_pin != 255) { 
+    _pinMode(_rw_pin, OUTPUT);
+  }
+  _pinMode(_enable_pin, OUTPUT);
+  
+
+  if (fourbitmode)
+    _displayfunction = LCD_4BITMODE | LCD_1LINE | LCD_5x8DOTS;
+  else 
+    _displayfunction = LCD_8BITMODE | LCD_1LINE | LCD_5x8DOTS;
+  
+  begin(16, 1);  
+}
+
+void Adafruit_RGBLCDShield::begin(uint8_t cols, uint8_t lines, uint8_t dotsize) {
+  // check if i2c
+  if (_i2cAddr != 255) {
+    //_i2c.begin(_i2cAddr);
+    WIRE.begin();
+    _i2c.begin();
+
+    _i2c.pinMode(8, OUTPUT);
+    _i2c.pinMode(6, OUTPUT);
+    _i2c.pinMode(7, OUTPUT);
+    setBacklight(0x7);
+
+    if (_rw_pin)
+      _i2c.pinMode(_rw_pin, OUTPUT);
+
+    _i2c.pinMode(_rs_pin, OUTPUT);
+    _i2c.pinMode(_enable_pin, OUTPUT);
+    for (uint8_t i=0; i<4; i++) 
+      _i2c.pinMode(_data_pins[i], OUTPUT);
+
+    for (uint8_t i=0; i<5; i++) {
+      _i2c.pinMode(_button_pins[i], INPUT);
+      _i2c.pullUp(_button_pins[i], 1);
+    }
+  }
+
+  if (lines > 1) {
+    _displayfunction |= LCD_2LINE;
+  }
+  _numlines = lines;
+  _currline = 0;
+
+  // for some 1 line displays you can select a 10 pixel high font
+  if ((dotsize != 0) && (lines == 1)) {
+    _displayfunction |= LCD_5x10DOTS;
+  }
+
+  // SEE PAGE 45/46 FOR INITIALIZATION SPECIFICATION!
+  // according to datasheet, we need at least 40ms after power rises above 2.7V
+  // before sending commands. Arduino can turn on way befer 4.5V so we'll wait 50
+  delayMicroseconds(50000); 
+  // Now we pull both RS and R/W low to begin commands
+  _digitalWrite(_rs_pin, LOW);
+  _digitalWrite(_enable_pin, LOW);
+  if (_rw_pin != 255) { 
+    _digitalWrite(_rw_pin, LOW);
+  }
+  
+  //put the LCD into 4 bit or 8 bit mode
+  if (! (_displayfunction & LCD_8BITMODE)) {
+    // this is according to the hitachi HD44780 datasheet
+    // figure 24, pg 46
+
+    // we start in 8bit mode, try to set 4 bit mode
+    write4bits(0x03);
+    delayMicroseconds(4500); // wait min 4.1ms
+
+    // second try
+    write4bits(0x03);
+    delayMicroseconds(4500); // wait min 4.1ms
+    
+    // third go!
+    write4bits(0x03); 
+    delayMicroseconds(150);
+
+    // finally, set to 8-bit interface
+    write4bits(0x02); 
+  } else {
+    // this is according to the hitachi HD44780 datasheet
+    // page 45 figure 23
+
+    // Send function set command sequence
+    command(LCD_FUNCTIONSET | _displayfunction);
+    delayMicroseconds(4500);  // wait more than 4.1ms
+
+    // second try
+    command(LCD_FUNCTIONSET | _displayfunction);
+    delayMicroseconds(150);
+
+    // third go
+    command(LCD_FUNCTIONSET | _displayfunction);
+  }
+
+  // finally, set # lines, font size, etc.
+  command(LCD_FUNCTIONSET | _displayfunction);  
+
+  // turn the display on with no cursor or blinking default
+  _displaycontrol = LCD_DISPLAYON | LCD_CURSOROFF | LCD_BLINKOFF;  
+  display();
+
+  // clear it off
+  clear();
+
+  // Initialize to default text direction (for romance languages)
+  _displaymode = LCD_ENTRYLEFT | LCD_ENTRYSHIFTDECREMENT;
+  // set the entry mode
+  command(LCD_ENTRYMODESET | _displaymode);
+
+}
+
+/********** high level commands, for the user! */
+void Adafruit_RGBLCDShield::clear()
+{
+  command(LCD_CLEARDISPLAY);  // clear display, set cursor position to zero
+  delayMicroseconds(2000);  // this command takes a long time!
+}
+
+void Adafruit_RGBLCDShield::home()
+{
+  command(LCD_RETURNHOME);  // set cursor position to zero
+  delayMicroseconds(2000);  // this command takes a long time!
+}
+
+void Adafruit_RGBLCDShield::setCursor(uint8_t col, uint8_t row)
+{
+  int row_offsets[] = { 0x00, 0x40, 0x14, 0x54 };
+  if ( row > _numlines ) {
+    row = _numlines-1;    // we count rows starting w/0
+  }
+  
+  command(LCD_SETDDRAMADDR | (col + row_offsets[row]));
+}
+
+// Turn the display on/off (quickly)
+void Adafruit_RGBLCDShield::noDisplay() {
+  _displaycontrol &= ~LCD_DISPLAYON;
+  command(LCD_DISPLAYCONTROL | _displaycontrol);
+}
+void Adafruit_RGBLCDShield::display() {
+  _displaycontrol |= LCD_DISPLAYON;
+  command(LCD_DISPLAYCONTROL | _displaycontrol);
+}
+
+// Turns the underline cursor on/off
+void Adafruit_RGBLCDShield::noCursor() {
+  _displaycontrol &= ~LCD_CURSORON;
+  command(LCD_DISPLAYCONTROL | _displaycontrol);
+}
+void Adafruit_RGBLCDShield::cursor() {
+  _displaycontrol |= LCD_CURSORON;
+  command(LCD_DISPLAYCONTROL | _displaycontrol);
+}
+
+// Turn on and off the blinking cursor
+void Adafruit_RGBLCDShield::noBlink() {
+  _displaycontrol &= ~LCD_BLINKON;
+  command(LCD_DISPLAYCONTROL | _displaycontrol);
+}
+void Adafruit_RGBLCDShield::blink() {
+  _displaycontrol |= LCD_BLINKON;
+  command(LCD_DISPLAYCONTROL | _displaycontrol);
+}
+
+// These commands scroll the display without changing the RAM
+void Adafruit_RGBLCDShield::scrollDisplayLeft(void) {
+  command(LCD_CURSORSHIFT | LCD_DISPLAYMOVE | LCD_MOVELEFT);
+}
+void Adafruit_RGBLCDShield::scrollDisplayRight(void) {
+  command(LCD_CURSORSHIFT | LCD_DISPLAYMOVE | LCD_MOVERIGHT);
+}
+
+// This is for text that flows Left to Right
+void Adafruit_RGBLCDShield::leftToRight(void) {
+  _displaymode |= LCD_ENTRYLEFT;
+  command(LCD_ENTRYMODESET | _displaymode);
+}
+
+// This is for text that flows Right to Left
+void Adafruit_RGBLCDShield::rightToLeft(void) {
+  _displaymode &= ~LCD_ENTRYLEFT;
+  command(LCD_ENTRYMODESET | _displaymode);
+}
+
+// This will 'right justify' text from the cursor
+void Adafruit_RGBLCDShield::autoscroll(void) {
+  _displaymode |= LCD_ENTRYSHIFTINCREMENT;
+  command(LCD_ENTRYMODESET | _displaymode);
+}
+
+// This will 'left justify' text from the cursor
+void Adafruit_RGBLCDShield::noAutoscroll(void) {
+  _displaymode &= ~LCD_ENTRYSHIFTINCREMENT;
+  command(LCD_ENTRYMODESET | _displaymode);
+}
+
+// Allows us to fill the first 8 CGRAM locations
+// with custom characters
+void Adafruit_RGBLCDShield::createChar(uint8_t location, uint8_t charmap[]) {
+  location &= 0x7; // we only have 8 locations 0-7
+  command(LCD_SETCGRAMADDR | (location << 3));
+  for (int i=0; i<8; i++) {
+    write(charmap[i]);
+  }
+  command(LCD_SETDDRAMADDR);  // unfortunately resets the location to 0,0
+}
+
+/*********** mid level commands, for sending data/cmds */
+
+inline void Adafruit_RGBLCDShield::command(uint8_t value) {
+  send(value, LOW);
+}
+
+#if ARDUINO >= 100
+inline size_t Adafruit_RGBLCDShield::write(uint8_t value) {
+  send(value, HIGH);
+  return 1;
+}
+#else
+inline void Adafruit_RGBLCDShield::write(uint8_t value) {
+  send(value, HIGH);
+}
+#endif
+
+/************ low level data pushing commands **********/
+
+// little wrapper for i/o writes
+void  Adafruit_RGBLCDShield::_digitalWrite(uint8_t p, uint8_t d) {
+  if (_i2cAddr != 255) {
+    // an i2c command
+    _i2c.digitalWrite(p, d);
+  } else {
+    // straightup IO
+    digitalWrite(p, d);
+  }
+}
+
+// Allows to set the backlight, if the LCD backpack is used
+void Adafruit_RGBLCDShield::setBacklight(uint8_t status) {
+  // check if i2c or SPI
+  _i2c.digitalWrite(8, ~(status >> 2) & 0x1);
+  _i2c.digitalWrite(7, ~(status >> 1) & 0x1);
+  _i2c.digitalWrite(6, ~status & 0x1);
+}
+
+// little wrapper for i/o directions
+void  Adafruit_RGBLCDShield::_pinMode(uint8_t p, uint8_t d) {
+  if (_i2cAddr != 255) {
+    // an i2c command
+    _i2c.pinMode(p, d);
+  } else {
+    // straightup IO
+    pinMode(p, d);
+  }
+}
+
+// write either command or data, with automatic 4/8-bit selection
+void Adafruit_RGBLCDShield::send(uint8_t value, uint8_t mode) {
+  _digitalWrite(_rs_pin, mode);
+
+  // if there is a RW pin indicated, set it low to Write
+  if (_rw_pin != 255) { 
+    _digitalWrite(_rw_pin, LOW);
+  }
+  
+  if (_displayfunction & LCD_8BITMODE) {
+    write8bits(value); 
+  } else {
+    write4bits(value>>4);
+    write4bits(value);
+  }
+}
+
+void Adafruit_RGBLCDShield::pulseEnable(void) {
+  _digitalWrite(_enable_pin, LOW);
+  delayMicroseconds(1);    
+  _digitalWrite(_enable_pin, HIGH);
+  delayMicroseconds(1);    // enable pulse must be >450ns
+  _digitalWrite(_enable_pin, LOW);
+  delayMicroseconds(100);   // commands need > 37us to settle
+}
+
+void Adafruit_RGBLCDShield::write4bits(uint8_t value) {
+  if (_i2cAddr != 255) {
+    uint16_t out = 0;
+
+    out = _i2c.readGPIOAB();
+
+    // speed up for i2c since its sluggish
+    for (int i = 0; i < 4; i++) {
+      out &= ~(1 << _data_pins[i]);
+      out |= ((value >> i) & 0x1) << _data_pins[i];
+    }
+
+    // make sure enable is low
+    out &= ~(1 << _enable_pin);
+
+    _i2c.writeGPIOAB(out);
+
+    // pulse enable
+    delayMicroseconds(1);
+    out |= (1 << _enable_pin);
+    _i2c.writeGPIOAB(out);
+    delayMicroseconds(1);
+    out &= ~(1 << _enable_pin);
+    _i2c.writeGPIOAB(out);   
+    delayMicroseconds(100);
+
+  } else {
+    for (int i = 0; i < 4; i++) {
+     _pinMode(_data_pins[i], OUTPUT);
+     _digitalWrite(_data_pins[i], (value >> i) & 0x01);
+    }
+    pulseEnable();
+  }
+}
+
+void Adafruit_RGBLCDShield::write8bits(uint8_t value) {
+  for (int i = 0; i < 8; i++) {
+    _pinMode(_data_pins[i], OUTPUT);
+    _digitalWrite(_data_pins[i], (value >> i) & 0x01);
+  }
+  
+  pulseEnable();
+}
+
+uint8_t Adafruit_RGBLCDShield::readButtons(void) {
+  uint8_t reply = 0x1F;
+
+  for (uint8_t i=0; i<5; i++) {
+    reply &= ~((_i2c.digitalRead(_button_pins[i])) << i);
+  }
+  return reply;
+}
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/Adafruit_RGBLCDShield.h	Sat Aug 02 12:39:25 2014 +0000
@@ -0,0 +1,133 @@
+/*************************************************** 
+  This is a library for the Adafruit RGB 16x2 LCD Shield 
+  Pick one up at the Adafruit shop!
+  ---------> http://http://www.adafruit.com/products/714
+
+  The shield uses I2C to communicate, 2 pins are required to  
+  interface
+  Adafruit invests time and resources providing this open source code, 
+  please support Adafruit and open-source hardware by purchasing 
+  products from Adafruit!
+
+  Written by Limor Fried/Ladyada for Adafruit Industries.  
+  BSD license, all text above must be included in any redistribution
+ ****************************************************/
+
+#ifndef Adafruit_RGBLCDShield_h
+#define Adafruit_RGBLCDShield_h
+
+#include <inttypes.h>
+#include "MCP23017.h"
+
+// commands
+#define LCD_CLEARDISPLAY 0x01
+#define LCD_RETURNHOME 0x02
+#define LCD_ENTRYMODESET 0x04
+#define LCD_DISPLAYCONTROL 0x08
+#define LCD_CURSORSHIFT 0x10
+#define LCD_FUNCTIONSET 0x20
+#define LCD_SETCGRAMADDR 0x40
+#define LCD_SETDDRAMADDR 0x80
+
+// flags for display entry mode
+#define LCD_ENTRYRIGHT 0x00
+#define LCD_ENTRYLEFT 0x02
+#define LCD_ENTRYSHIFTINCREMENT 0x01
+#define LCD_ENTRYSHIFTDECREMENT 0x00
+
+// flags for display on/off control
+#define LCD_DISPLAYON 0x04
+#define LCD_DISPLAYOFF 0x00
+#define LCD_CURSORON 0x02
+#define LCD_CURSOROFF 0x00
+#define LCD_BLINKON 0x01
+#define LCD_BLINKOFF 0x00
+
+// flags for display/cursor shift
+#define LCD_DISPLAYMOVE 0x08
+#define LCD_CURSORMOVE 0x00
+#define LCD_MOVERIGHT 0x04
+#define LCD_MOVELEFT 0x00
+
+// flags for function set
+#define LCD_8BITMODE 0x10
+#define LCD_4BITMODE 0x00
+#define LCD_2LINE 0x08
+#define LCD_1LINE 0x00
+#define LCD_5x10DOTS 0x04
+#define LCD_5x8DOTS 0x00
+
+#define BUTTON_UP 0x08
+#define BUTTON_DOWN 0x04
+#define BUTTON_LEFT 0x10
+#define BUTTON_RIGHT 0x02
+#define BUTTON_SELECT 0x01
+
+
+class Adafruit_RGBLCDShield
+//    : public Print
+{
+public:
+  Adafruit_RGBLCDShield();
+
+  void init(uint8_t fourbitmode, uint8_t rs, uint8_t rw, uint8_t enable,
+        uint8_t d0, uint8_t d1, uint8_t d2, uint8_t d3,
+        uint8_t d4, uint8_t d5, uint8_t d6, uint8_t d7);
+    
+  void begin(uint8_t cols, uint8_t rows, uint8_t charsize = LCD_5x8DOTS);
+
+  void clear();
+  void home();
+
+  void noDisplay();
+  void display();
+  void noBlink();
+  void blink();
+  void noCursor();
+  void cursor();
+  void scrollDisplayLeft();
+  void scrollDisplayRight();
+  void leftToRight();
+  void rightToLeft();
+  void autoscroll();
+  void noAutoscroll();
+  
+  // only if using backpack
+  void setBacklight(uint8_t status); 
+
+  void createChar(uint8_t, uint8_t[]);
+  void setCursor(uint8_t, uint8_t); 
+#if ARDUINO >= 100
+  virtual size_t write(uint8_t);
+#else
+  virtual void write(uint8_t);
+#endif
+  void command(uint8_t);
+  uint8_t readButtons();
+
+private:
+  void send(uint8_t, uint8_t);
+  void write4bits(uint8_t);
+  void write8bits(uint8_t);
+  void pulseEnable();
+  void _digitalWrite(uint8_t, uint8_t);
+  void _pinMode(uint8_t, uint8_t);
+
+  uint8_t _rs_pin; // LOW: command.  HIGH: character.
+  uint8_t _rw_pin; // LOW: write to LCD.  HIGH: read from LCD.
+  uint8_t _enable_pin; // activated by a HIGH pulse.
+  uint8_t _data_pins[8];
+  uint8_t _button_pins[5];
+  uint8_t _displayfunction;
+  uint8_t _displaycontrol;
+  uint8_t _displaymode;
+
+  uint8_t _initialized;
+
+  uint8_t _numlines,_currline;
+
+  uint8_t _i2cAddr;
+  MCP20317 _i2c;
+};
+
+#endif
--- a/MCP23017.lib	Sat Aug 02 11:07:48 2014 +0000
+++ b/MCP23017.lib	Sat Aug 02 12:39:25 2014 +0000
@@ -1,1 +1,1 @@
-http://mbed.org/users/wim/code/MCP23017/#5696b886a895
+http://mbed.org/users/jimherd/code/MCP23017/#d57de266cf19
--- a/main.cpp	Sat Aug 02 11:07:48 2014 +0000
+++ b/main.cpp	Sat Aug 02 12:39:25 2014 +0000
@@ -1,39 +1,65 @@
 #include "mbed.h"
 #include "MCP23017.h"
 
-DigitalOut myled1(LED1);
-DigitalOut myled2(LED2);
+Serial pc(SERIAL_TX, SERIAL_RX);
 
-Serial pc(USBTX, USBRX);
-I2C i2c(I2C_SDA, I2C_SCL);
+MCP23017 mcp23017 = MCP23017(I2C_SDA, I2C_SCL, 0x40);
 
-MCP23017 mcp23017 = MCP23017(i2c, 0x40);
+#define RED 0x1
+#define YELLOW 0x3
+#define GREEN 0x2
+#define TEAL 0x6
+#define BLUE 0x4
+#define VIOLET 0x5
+#define WHITE 0x7
+    
+// Allows to set the backlight, if the LCD backpack is used
+void SetBacklight(unsigned char status)
+{
+    pc.printf("Backlight: %i\n\r", status);
+    
+    mcp23017.digitalWrite(8, (~(status >> 2) & 0x1));
+    mcp23017.digitalWrite(7, (~(status >> 1) & 0x1));
+    mcp23017.digitalWrite(6, (~status & 0x1));
+}
 
-int main() {
-    
-    pc.printf("Hello World\n\r");
+void LED(bool bOn)
+{
+    pc.printf("LED: %s\n\r", bOn ? "On" : "Off");
+    //mcp23017.write(PORT_A, bOn ? 0x10 : 0xFF);
+    //mcp23017.write(PORT_B, bOn ? 0x10 : 0xFF);
+}
+
+int main()
+{    
+    pc.printf("START\n\r");
     
     // I2C init
-    i2c.frequency(400000);
+    //mcp23017.i2c.frequency(400000);
     
     // Port A is databus - Output
-    mcp23017.direction(PORT_A, PORT_DIR_OUT);
+    //mcp23017.direction(PORT_A, PORT_DIR_OUT);
+    
     // Port B is controlbus - Output       
-    mcp23017.direction(PORT_B, PORT_DIR_OUT); 
+    //mcp23017.direction(PORT_B, PORT_DIR_OUT); 
+    
+    pc.printf("mcp23017.config(0,1,0);\n\r");
+    mcp23017.config(0,1,0);
+    wait(0.5);
     
-    myled2 = 1;
+    pc.printf("mcp23017.pinMode\n\r");
+    mcp23017.pinMode(8, DIR_OUTPUT);
+    mcp23017.pinMode(7, DIR_OUTPUT);
+    mcp23017.pinMode(6, DIR_OUTPUT);
+    
+    SetBacklight(WHITE);
+
+    wait(0.5);
     pc.printf("MPC Init done\n\r");           
     
-    while(1) {
-        myled1 = 1;
-        mcp23017.write(PORT_A, 0xFF);
-        mcp23017.write(PORT_B, 0xFF);        
-        wait(0.1);
-           
-        myled1 = 0;
-        mcp23017.write(PORT_A, 0x00);
-        mcp23017.write(PORT_B, 0x00);        
-        wait(0.1);
-        pc.printf("*");
-    }
+    LED(false);
+    LED(true);
+    
+    SetBacklight(RED);
+    pc.printf("FINISHED\n\r");
 }