Форум РадиоКот

Код: Выделить всё

diff --git a/display/ks0108.c b/display/ks0108.c
index f8c8bfb..68b5ad1 100644
--- a/display/ks0108.c
+++ b/display/ks0108.c
@@ -22,7 +22,7 @@ void ks0108SetBrightness(uint8_t br)
 
 static void ks0108Write(uint8_t type, uint8_t data)
 {
-	_delay_us(50);
+	_delay_us(100);
 
 	if (type == KS0108_DATA)
 		KS0108_CTRL_PORT |= KS0108_DI;
@@ -69,45 +69,49 @@ ISR (TIMER0_OVF_vect)
 	static uint8_t cs;
 
 	static uint8_t br;
-
-	if (j == 64) {									/* Phase 1 (Y) */
-		if (++i >= 8) {
-			i = 0;
-			if (++cs >= KS0108_CHIPS)
-				cs = 0;
-			switch (cs) {
-			case 1:
-				KS0108_SET_CS(KS0108_CS2);
-				break;
-			default:
-				KS0108_SET_CS(KS0108_CS1);
-				break;
+	static uint8_t upd = 0;
+
+	upd = !upd;
+	if (upd) {
+		if (j == 64) {									/* Phase 1 (Y) */
+			if (++i >= 8) {
+				i = 0;
+				if (++cs >= KS0108_CHIPS)
+					cs = 0;
+				switch (cs) {
+				case 1:
+					KS0108_SET_CS(KS0108_CS2);
+					break;
+				default:
+					KS0108_SET_CS(KS0108_CS1);
+					break;
+				}
 			}
+			KS0108_CTRL_PORT &= ~KS0108_DI;				/* Go to command mode */
+			KS0108_DATA_PORT = KS0108_SET_PAGE + i;		/* Set Y */
+		} else if (j == 65) {							/* Phase 2 (X) */
+			KS0108_DATA_PORT = KS0108_SET_ADDRESS;		/* Set X */
+		} else {										/* Phase 3 (32 bytes of data) */
+			KS0108_DATA_PORT = fb[j + 64 * cs][i];
 		}
-		KS0108_CTRL_PORT &= ~KS0108_DI;				/* Go to command mode */
-		KS0108_DATA_PORT = KS0108_SET_PAGE + i;		/* Set Y */
-	} else if (j == 65) {							/* Phase 2 (X) */
-		KS0108_DATA_PORT = KS0108_SET_ADDRESS;		/* Set X */
-	} else {										/* Phase 3 (32 bytes of data) */
-		KS0108_DATA_PORT = fb[j + 64 * cs][i];
-	}
 
-	KS0108_CTRL_PORT |= KS0108_E;					/* Strob */
-	asm("nop");
-	KS0108_CTRL_PORT &= ~KS0108_E;
+		KS0108_CTRL_PORT |= KS0108_E;					/* Strob */
+		asm("nop");
+		KS0108_CTRL_PORT &= ~KS0108_E;
 
-	if (++j >= 66) {
-		j = 0;
-		KS0108_CTRL_PORT |= KS0108_DI;				/* Go to data mode */
-	}
+		if (++j >= 66) {
+			j = 0;
+			KS0108_CTRL_PORT |= KS0108_DI;				/* Go to data mode */
+		}
 
-	if (++br >= KS0108_MAX_BRIGTHNESS)				/* Loop brightness */
-		br = KS0108_MIN_BRIGHTNESS;
+		if (++br >= KS0108_MAX_BRIGTHNESS)				/* Loop brightness */
+			br = KS0108_MIN_BRIGHTNESS;
 
-	if (br == _br) {
-		KS0108_BCKL_PORT &= ~KS0108_BCKL;			/* Turn backlight off */
-	} else if (br == 0)
-		KS0108_BCKL_PORT |= KS0108_BCKL;			/* Turn backlight on */
+		if (br == _br) {
+			KS0108_BCKL_PORT &= ~KS0108_BCKL;			/* Turn backlight off */
+		} else if (br == 0)
+			KS0108_BCKL_PORT |= KS0108_BCKL;			/* Turn backlight on */
+	}
 
 	return;
 }
diff --git a/display/st7920.c b/display/st7920.c
index 0a6135f..232202b 100644
--- a/display/st7920.c
+++ b/display/st7920.c
@@ -16,7 +16,7 @@ void st7920SetBrightness(uint8_t br)
 
 static void st7920Write(uint8_t type, uint8_t data)
 {
-	_delay_us(50);
+	_delay_us(100);
 
 	if (type == ST7920_DATA)
 		ST7920_CTRL_PORT |= ST7920_RS;
@@ -62,34 +62,38 @@ ISR (TIMER0_OVF_vect)
 	static uint8_t j = 32;
 
 	static uint8_t br;
+	static uint8_t upd = 0;
+
+	upd = !upd;
+	if (upd) {
+		if (j == 32) {										/* Phase 1 (Y) */
+			ST7920_CTRL_PORT &= ~ST7920_RS;					/* Go to command mode */
+			if (++i >= 32)
+				i = 0;
+			ST7920_DATA_PORT = ST7920_SET_GRAPHIC_RAM | i;	/* Set Y */
+		} else if (j == 33) {								/* Phase 2 (X) */
+			ST7920_DATA_PORT = ST7920_SET_GRAPHIC_RAM;		/* Set X */
+		} else {											/* Phase 3 (32 bytes of data) */
+			ST7920_DATA_PORT = fb[j][i];
+		}
 
-	if (j == 32) {										/* Phase 1 (Y) */
-		ST7920_CTRL_PORT &= ~ST7920_RS;					/* Go to command mode */
-		if (++i >= 32)
-			i = 0;
-		ST7920_DATA_PORT = ST7920_SET_GRAPHIC_RAM | i;	/* Set Y */
-	} else if (j == 33) {								/* Phase 2 (X) */
-		ST7920_DATA_PORT = ST7920_SET_GRAPHIC_RAM;		/* Set X */
-	} else {											/* Phase 3 (32 bytes of data) */
-		ST7920_DATA_PORT = fb[j][i];
-	}
-
-	ST7920_CTRL_PORT |= ST7920_E;						/* Strob */
-	asm("nop");
-	ST7920_CTRL_PORT &= ~ST7920_E;
+		ST7920_CTRL_PORT |= ST7920_E;						/* Strob */
+		asm("nop");
+		ST7920_CTRL_PORT &= ~ST7920_E;
 
-	if (++j >= 34) {
-		j = 0;
-		ST7920_CTRL_PORT |= ST7920_RS;					/* Go to data mode */
-	}
+		if (++j >= 34) {
+			j = 0;
+			ST7920_CTRL_PORT |= ST7920_RS;					/* Go to data mode */
+		}
 
-	if (++br >= ST7920_MAX_BRIGTHNESS)					/* Loop brightness */
-		br = ST7920_MIN_BRIGHTNESS;
+		if (++br >= ST7920_MAX_BRIGTHNESS)					/* Loop brightness */
+			br = ST7920_MIN_BRIGHTNESS;
 
-	if (br == _br) {
-		ST7920_BCKL_PORT &= ~ST7920_BCKL;				/* Turn backlight off */
-	} else if (br == 0)
-		ST7920_BCKL_PORT |= ST7920_BCKL;				/* Turn backlight on */
+		if (br == _br) {
+			ST7920_BCKL_PORT &= ~ST7920_BCKL;				/* Turn backlight off */
+		} else if (br == 0)
+			ST7920_BCKL_PORT |= ST7920_BCKL;				/* Turn backlight on */
+	}
 
 	return;
 }

Код: Выделить всё

case CMD_BTN_1_LONG:
case CMD_RC5_BACKLIGHT:
        dispMode = MODE_BR;
        setDisplayTime(DISPLAY_TIME_BR);
        break;