source: ETALON/DAQ/Sensors/lcd/lcd.cpp @ 709

#include "lcd.h"

lcd::lcd(void){
        bcm2835_init();
this->LCD_RS = 4;
this->LCD_E  = 15;
this->LCD_D4 = 24;
this->LCD_D5 = 23;
this->LCD_D6 = 14;
this->LCD_D7 = 22;
bcm2835_gpio_fsel(LCD_RS, BCM2835_GPIO_FSEL_OUTP);
bcm2835_gpio_fsel(LCD_E, BCM2835_GPIO_FSEL_OUTP);
bcm2835_gpio_fsel(LCD_D4, BCM2835_GPIO_FSEL_OUTP);
bcm2835_gpio_fsel(LCD_D5, BCM2835_GPIO_FSEL_OUTP);
bcm2835_gpio_fsel(LCD_D6, BCM2835_GPIO_FSEL_OUTP);
bcm2835_gpio_fsel(LCD_D7, BCM2835_GPIO_FSEL_OUTP);

        this->lcd_byte(0x33,0);
        this->lcd_byte(0x32,0);
        this->lcd_byte(0x28,0);
        this->lcd_byte(0x0C,0);  
        this->lcd_byte(0x06,0);
        this->lcd_byte(0x01,0);
        
}

lcd::~lcd(void){
        bcm2835_close();
}
void lcd::lcd_byte(uint8_t bits, bool mode)
{
int E_DELAY = 100;
mode?bcm2835_gpio_set(LCD_RS):bcm2835_gpio_clr(LCD_RS);

bcm2835_gpio_clr(LCD_D4);
bcm2835_gpio_clr(LCD_D5);
bcm2835_gpio_clr(LCD_D6);
bcm2835_gpio_clr(LCD_D7);


if ((bits&0x10)==0x10) bcm2835_gpio_set(LCD_D4);
if ((bits&0x20)==0x20) bcm2835_gpio_set(LCD_D5);
if ((bits&0x40)==0x40) bcm2835_gpio_set(LCD_D6);
if ((bits&0x80)==0x80) bcm2835_gpio_set(LCD_D7);

usleep(E_DELAY);
bcm2835_gpio_set(LCD_E);
usleep(E_DELAY);
bcm2835_gpio_clr(LCD_E);
usleep(E_DELAY);

bcm2835_gpio_clr(LCD_D4);
bcm2835_gpio_clr(LCD_D5);
bcm2835_gpio_clr(LCD_D6);
bcm2835_gpio_clr(LCD_D7);
    
if ((bits&0x01)==0x01) bcm2835_gpio_set(LCD_D4);
if ((bits&0x02)==0x02) bcm2835_gpio_set(LCD_D5);
if ((bits&0x04)==0x04) bcm2835_gpio_set(LCD_D6);
if ((bits&0x08)==0x08) bcm2835_gpio_set(LCD_D7);

usleep(E_DELAY);
bcm2835_gpio_set(LCD_E);
usleep(E_DELAY);
bcm2835_gpio_clr(LCD_E);
usleep(E_DELAY);

}

void lcd::write(string message, uint8_t row)
{if (row==1) this->lcd_byte(0x80, 0);
if (row==2) this->lcd_byte(0xC0, 0);
 message.append("                ",16-message.length());
for (int i=0;i<16;i++) {this->lcd_byte(message[i],1);}
}