with Interfaces; use Interfaces; with Interfaces.C; use Interfaces.C; with Interfaces.C.extensions; use Interfaces.C.extensions; with bcm2835_h; use bcm2835_h; with Ada.Text_IO; use Ada.Text_IO; package body st7565lcd is procedure io_init is begin bcm2835_gpio_fsel(pin => LCD_CS, mode => unsigned_char(BCM2835_GPIO_FSEL_OUTP)); bcm2835_gpio_fsel(pin => LCD_RST, mode => unsigned_char(BCM2835_GPIO_FSEL_OUTP)); bcm2835_gpio_fsel(pin => LCD_A0, mode => unsigned_char(BCM2835_GPIO_FSEL_OUTP)); bcm2835_gpio_fsel(pin => LCD_CLK, mode => unsigned_char(BCM2835_GPIO_FSEL_OUTP)); bcm2835_gpio_fsel(pin => LCD_SI, mode => unsigned_char(BCM2835_GPIO_FSEL_OUTP)); end io_init; procedure lcd_init is begin -- reset bcm2835_gpio_write(pin => LCD_CS, on => unsigned_char(HIGH)); bcm2835_delayMicroseconds(unsigned_long_long(1)); bcm2835_gpio_write(pin => LCD_RST, on => unsigned_char(LOW)); bcm2835_delayMicroseconds(unsigned_long_long(1)); bcm2835_gpio_write(pin => LCD_RST, on => unsigned_char(HIGH)); bcm2835_delayMicroseconds(unsigned_long_long(1)); -- init routine for index in lcd_init_data'range loop lcd_transfer_data(value => lcd_init_data(index), si => false); end loop; lcd_clear; end lcd_init; -- display strings on the lcd at a given position -- data is a string with any allowed range -- for strings not beginning at 0 we have to decrement the index -- variable for xpos by the value of the range begin, so we get -- for xpos a range from (xpos + 0 .. xpos + number of char in string) procedure lcd_ascii57_string (xpos : natural; ypos : natural; data : string) is begin for index in data'range loop lcd_ascii57(xpos => xpos + (index - data'first) * 6, ypos => ypos, data => character'val(character'pos(data(index)))); end loop; end lcd_ascii57_string; procedure lcd_ascii57 (xpos : natural; ypos : natural; data : character) is begin lcd_set_page(page => ypos, column => xpos); -- write one 5x7 char for index in 0..4 loop lcd_transfer_data(value => font_5x7(character'pos(data))(index), si => true); end loop; -- one free column between chars lcd_transfer_data(value => 16#00#, si => true); end lcd_ascii57; procedure lcd_picture (xpos : natural; ypos: natural; picture : t_lcd_array) is begin for outdex in 0..7 loop lcd_set_page(page => ypos + outdex, column => xpos); for index in (128 * outdex) .. (128 * (outdex + 1) - 1) loop lcd_transfer_data(value => picture(index), si => true); end loop; end loop; end lcd_picture; procedure lcd_clear is begin bcm2835_gpio_write(pin => LCD_CS, on => unsigned_char(LOW)); for outdex in 0..7 loop lcd_set_page(page => outdex, column => 0); for index in 0..128 loop lcd_transfer_data(value => 16#00#, si => true); end loop; end loop; bcm2835_gpio_write(pin => LCD_CS, on => unsigned_char(HIGH)); end lcd_clear; procedure lcd_transfer_data (value : byte; si : boolean) is begin bcm2835_gpio_write(pin => LCD_CS, on => unsigned_char(LOW)); bcm2835_gpio_write(pin => LCD_CLK, on => unsigned_char(HIGH)); if si then bcm2835_gpio_write(pin => LCD_A0, on => unsigned_char(HIGH)); else bcm2835_gpio_write(pin => LCD_A0, on => unsigned_char(LOW)); end if; lcd_byte(value); bcm2835_gpio_write(pin => LCD_CS, on => unsigned_char(HIGH)); end lcd_transfer_data; procedure lcd_set_page (page : natural; column : natural) is lsb : byte := byte(column + 1) and 16#0f#; msb : byte := byte(column + 1) and 16#f0#; page_int : byte := byte(page) or 16#b0#; begin msb := Shift_Right(msb, 4); msb := msb or 16#10#; lcd_transfer_data(value => page_int, si => false); lcd_transfer_data(value => msb, si => false); lcd_transfer_data(value => lsb, si => false); null; end lcd_set_page; procedure lcd_byte (data : byte) is data_int : byte := data; begin for index in 0..7 loop bcm2835_delayMicroseconds(unsigned_long_long(1)); bcm2835_gpio_write(pin => LCD_CLK, on => unsigned_char(LOW)); if (data_int and 16#80#) = 16#80# then bcm2835_gpio_write(pin => LCD_SI, on => unsigned_char(HIGH)); else bcm2835_gpio_write(pin => LCD_SI, on => unsigned_char(LOW)); end if; data_int := Shift_Left(data_int, 1); bcm2835_delayMicroseconds(unsigned_long_long(1)); bcm2835_gpio_write(pin => LCD_CLK, on => unsigned_char(HIGH)); end loop; end lcd_byte; function bmp_to_lcd (bmp_picture : t_bmp_picture) return t_lcd_array is lcd : t_lcd_array := (others => 16#00#); logic : byte; begin for aussen in 0 .. 7 loop logic := 16#01#; for outdex in 0 .. 7 loop for index in 0 .. 127 loop if ((bmp_picture.data(aussen * 1024 + outdex * 128 + index)(which_byte(bmp_picture.mask.red)) or bmp_picture.data(aussen * 1024 + outdex * 128 + index)(which_byte(bmp_picture.mask.green)) or bmp_picture.data(aussen * 1024 + outdex * 128 + index)(which_byte(bmp_picture.mask.blue))) < 16#88#) then lcd(aussen * 128 + index) := lcd(aussen * 128 + index) or logic; end if; end loop; logic := Shift_Left(logic, 1); end loop; end loop; return lcd; end bmp_to_lcd; function which_byte (data : dword) return integer is begin case data is when 16#000000FF# => return 0; when 16#0000FF00# => return 1; when 16#00FF0000# => return 2; when 16#FF000000# => return 3; when others => raise mask_exception; end case; end which_byte; -- read_bmp : read a bmp file in t_bmp_picture record procedure read_bmp (file : in Ada.Streams.Stream_IO.File_Type; file_access : access Ada.Streams.Root_Stream_Type'Class; bmp_picture : in out t_bmp_picture) is begin -- read header t_bmp_header'Read(file_access, bmp_picture.header); -- check for valid header if (abs bmp_picture.header.biHeight /= 64 or bmp_picture.header.biWidth /= 128 or (bmp_picture.header.biCompression /= 0 and bmp_picture.header.biCompression /= 3) or bmp_picture.header.biBitCount /= 32) then raise bmp_exception; end if; -- get color map if existing if bmp_picture.header.biCompression = 3 then t_color_mask'Read(file_access, bmp_picture.mask); end if; -- read in image data if bmp_picture.header.biHeight < 0 then -- top-down pixel matrix for index in bmp_picture.data'range loop if not Ada.Streams.Stream_IO.End_Of_File(file) then t_byte_array'Read(file_access, bmp_picture.data(index)); end if; end loop; else -- bottom-top pixel matrix for row in reverse 0 .. 63 loop for column in 0 .. 127 loop if not Ada.Streams.Stream_IO.End_Of_File(file) then t_byte_array'Read(file_access, bmp_picture.data(row * 128 + column)); end if; end loop; end loop; end if; end read_bmp; end st7565lcd;