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

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