added lcdWriteStream start and stop functions

2 files changed, 29 insertions, 1 deletions

diff --git a/drivers/lcd/ssd1289_lld.c b/drivers/lcd/ssd1289_lld.c
index 7a9109ad..82cd281e 100644
--- a/drivers/lcd/ssd1289_lld.c
+++ b/drivers/lcd/ssd1289_lld.c
@@ -71,8 +71,34 @@ static __inline void lcdDelay(uint16_t us) {
 	chThdSleepMicroseconds(us);
 }
 
-__inline lld_lcdWriteStream(uint16_t *buffer, uint16_t size) {
+__inline void lld_lcdWriteStreamStart(void) {
+	#ifdef LCD_USE_GPIO
+		Clr_CS
+		Clr_RS;
+		Set_RD;
 
+		palWritePort(LCD_DATA_PORT, 0x0022);
+
+		Clr_WR;
+		Set_WR;
+	#endif
+}
+
+__inline void lld_lcdWriteStreamStop(void) {
+	#ifdef LCD_USE_GPIO
+		Set_CS;	
+	#endif
+}
+
+__inline void lld_lcdWriteStream(uint16_t *buffer, uint16_t size) {
+	uint16_t i;
+
+	for(i = 0; i < size; i++) {
+		palWritePort(LCD_DATA_PORT, buffer[i]);
+
+		Clr_WR;
+		Set_WR;
+	}
 }
 
 void lld_lcdSetCursor(uint16_t x, uint16_t y) {
diff --git a/drivers/lcd/ssd1289_lld.h b/drivers/lcd/ssd1289_lld.h
index 19235d2f..6d26d3ad 100644
--- a/drivers/lcd/ssd1289_lld.h
+++ b/drivers/lcd/ssd1289_lld.h
@@ -16,6 +16,8 @@
 #define Clr_RD		palClearPad(LCD_CMD_PORT, LCD_RD);
 
 void lld_lcdInit(void);
+void lld_lcdWriteStreamStart(void);
+void lld_lcdWriteStreamStop(void);
 void lld_lcdWriteStream(uint16_t *buffer, uint16_t size);
 void lld_lcdSetCursor(uint16_t x, uint16_t y);
 void lld_lcdSetOrientation(uint8_t newOrientation);