zouhaitao/stc32g128k
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

fix: resolve startup hang by using safe byte-by-byte write sequence in WS2812_Write24Bit

Browse Source
This commit is contained in:
zouhaitao
2026-07-08 11:19:36 +08:00
parent 2026c52eb7
commit 8c7b6b3e22
1 changed files with 6 additions and 18 deletions
Download Patch File Download Diff File Expand all files Collapse all files

26
App/main.c
View File

@@ -149,7 +149,6 @@ void WS2812_EncodeByte5(u8 v, u8 *buf)
void WS2812_Write24Bit(u8 g, u8 r, u8 b)
{
u8 xdata buf[15];
u8 m1_save, m0_save;
u8 i;
WS2812_EncodeByte5(g, &buf[0]);
@@ -158,34 +157,23 @@ void WS2812_Write24Bit(u8 g, u8 r, u8 b)
EA = 0;
m1_save = P2M1 & (1 << 5);
m0_save = P2M0 & (1 << 5);
P2M1 |= (1 << 5);
P2M0 &= ~(1 << 5);
// Ensure P2.3 (MOSI) and P2.5 (SCLK) are configured as push-pull output
P2M1 &= ~((1 << 3) | (1 << 5));
P2M0 |= ((1 << 3) | (1 << 5));
SPCTL = 0xD0; // Enable SPI at SYSCLK/4 (6.0 MHz)
SPSTAT = 0xC0; // Clear flags
SPDAT = buf[0];
SPDAT = buf[1];
for (i = 2; i < 15; i++)
for (i = 0; i < 15; i++)
{
while (!(SPSTAT & 0x80));
SPSTAT = 0xC0;
SPDAT = buf[i];
while (!(SPSTAT & 0x80));
SPSTAT = 0xC0;
}
while (!(SPSTAT & 0x80));
SPSTAT = 0xC0;
while (!(SPSTAT & 0x80));
SPSTAT = 0xC0;
SPCTL = 0x90; // Disable SPI
WS2812_DI = 0;
P2M1 = (P2M1 & ~(1 << 5)) | m1_save;
P2M0 = (P2M0 & ~(1 << 5)) | m0_save;
MOTOR = 0; // Ensure motor is off
EA = 1;
}