Initial fix for Module17 r0.1c display

pull/63/head
Mathis Schmieder 2021-11-26 08:18:50 +00:00 zatwierdzone przez silseva
rodzic 55c0b0d868
commit 22a0d73fbc
1 zmienionych plików z 53 dodań i 52 usunięć

Wyświetl plik

@ -15,6 +15,16 @@
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
* GNU General Public License for more details. *
* *
* As a special exception, if other files instantiate templates or use *
* macros or inline functions from this file, or you compile this file *
* and link it with other works to produce a work based on this file, *
* this file does not by itself cause the resulting work to be covered *
* by the GNU General Public License. However the source code for this *
* file must still be made available in accordance with the GNU General *
* Public License. This exception does not invalidate any other reasons *
* why a work based on this file might be covered by the GNU General *
* Public License. *
* *
* You should have received a copy of the GNU General Public License *
* along with this program; if not, see <http://www.gnu.org/licenses/> *
***************************************************************************/
@ -87,34 +97,30 @@ void display_init()
gpio_clearPin(LCD_CS);
gpio_clearPin(LCD_RS); /* RS low -> command mode */
spi2_sendRecv(0xAE); /* Disable Display */
spi2_sendRecv(0x20); /* Set Memory Addressing Mode to horizontal addressing Mode */
spi2_sendRecv(0xAE); // SH110X_DISPLAYOFF,
spi2_sendRecv(0xd5); // SH110X_SETDISPLAYCLOCKDIV, 0x51,
spi2_sendRecv(0x51);
spi2_sendRecv(0x20); // SH110X_MEMORYMODE,
spi2_sendRecv(0x00);
spi2_sendRecv(0xB0); /* Set Page Start Address for Page Addressing Mode */
spi2_sendRecv(0xC8); /* Set COM Output Scan Direction */
spi2_sendRecv(0x00); /* Set low column address */
spi2_sendRecv(0x10); /* Set high column address */
spi2_sendRecv(0x40); /* Set start line address */
spi2_sendRecv(0x81); /* Set contrast */
spi2_sendRecv(0xCF);
spi2_sendRecv(0xA1); /* Set segment re-map 0 to 127 */
spi2_sendRecv(0xA6); /* Set normal color */
spi2_sendRecv(0xA8); /* Set multiplex ratio (1 to 64) */
spi2_sendRecv(0x3F);
spi2_sendRecv(0xA4); /* Output follows RAM content */
spi2_sendRecv(0xD3); /* Set display offset */
spi2_sendRecv(0x00); /* Not offset */
spi2_sendRecv(0xD5); /* Set display clock divide ratio/oscillator frequency */
spi2_sendRecv(0xF0); /* Set divide ratio */
spi2_sendRecv(0xD9); /* Set pre-charge period */
spi2_sendRecv(0x81); // SH110X_SETCONTRAST, 0x4F,
spi2_sendRecv(0x4F);
spi2_sendRecv(0xAD); // SH110X_DCDC, 0x8A,
spi2_sendRecv(0x8A);
spi2_sendRecv(0xA0); // SH110X_SEGREMAP,
spi2_sendRecv(0xC0); // SH110X_COMSCANINC,
spi2_sendRecv(0xDC); // SH110X_SETDISPSTARTLINE, 0x0,
spi2_sendRecv(0x00);
spi2_sendRecv(0xd3); // SH110X_SETDISPLAYOFFSET, 0x60,
spi2_sendRecv(0x60);
spi2_sendRecv(0xd9); // SH110X_SETPRECHARGE, 0x22,
spi2_sendRecv(0x22);
spi2_sendRecv(0xDA); /* Set com pins hardware configuration */
spi2_sendRecv(0x12);
spi2_sendRecv(0xDB); /* Set vcomh */
spi2_sendRecv(0x40);
spi2_sendRecv(0x8D); /* Set DC-DC enable */
spi2_sendRecv(0x14);
spi2_sendRecv(0xAF); /* Enable Display */
spi2_sendRecv(0xdb); // SH110X_SETVCOMDETECT, 0x35,
spi2_sendRecv(0x35);
spi2_sendRecv(0xa8); // SH110X_SETMULTIPLEX, 0x3F,
spi2_sendRecv(0x3f);
spi2_sendRecv(0xa4); // SH110X_DISPLAYALLON_RESUME,
spi2_sendRecv(0xa6); // SH110X_NORMALDISPLAY,
spi2_sendRecv(0xAF); // SH110x_DISPLAYON
gpio_setPin(LCD_CS);
}
@ -130,36 +136,31 @@ void display_terminate()
void display_renderRow(uint8_t row)
{
/* magic stuff */
uint8_t *buf = (frameBuffer + 128 * row);
for (uint8_t i = 0; i<16; i++)
{
uint8_t tmp[8] = {0};
for (uint8_t j = 0; j < 8; j++)
{
uint8_t tmp_buf = buf[j*16 + i];
int count = __builtin_popcount(tmp_buf);
while (count > 0)
{
int pos = __builtin_ctz(tmp_buf);
tmp[pos] |= 1UL << j;
tmp_buf &= ~(1 << pos);
count--;
}
}
uint8_t *buf = (frameBuffer);
for(uint16_t i=0; i<64; i++)
{
//for(uint8_t k=0; k<8; k++)
{
//spi2_sendRecv(buf[(j+1)*16 - (16-row)]);
uint8_t out=0, tmp=buf[i*16 + 15-row];
for(uint8_t j=0; j<8; j++)
{
out|=((tmp>>(7-j))&1)<<j;
}
spi2_sendRecv(out);
}
}
for (uint8_t s = 0; s < 8; s++)
{
(void) spi2_sendRecv(tmp[s]);
}
}
}
void display_renderRows(uint8_t startRow, uint8_t endRow)
{
gpio_clearPin(LCD_CS);
for(uint8_t row = startRow; row < endRow; row++)
for(uint8_t row = startRow; row <= endRow; row++)
{
gpio_clearPin(LCD_RS); /* RS low -> command mode */
(void) spi2_sendRecv(0xB0 | row); /* Set Y position */
@ -168,13 +169,13 @@ void display_renderRows(uint8_t startRow, uint8_t endRow)
gpio_setPin(LCD_RS); /* RS high -> data mode */
display_renderRow(row);
}
gpio_setPin(LCD_CS);
}
void display_render()
{
display_renderRows(0, SCREEN_HEIGHT / 8);
display_renderRows(0, SCREEN_WIDTH / 8 - 1);
}
bool display_renderingInProgress()