fixes, and use the new rsc parsing for some unit pins
This commit is contained in:
@@ -16,7 +16,7 @@ error_t UU_Npx_Clear(Unit *unit)
|
||||
CHECK_TYPE(unit, &UNIT_NEOPIXEL);
|
||||
|
||||
struct priv *priv = unit->data;
|
||||
ws2812_clear(priv->port, priv->ll_pin, priv->pixels);
|
||||
ws2812_clear(priv->port, priv->ll_pin, priv->cfg.pixels);
|
||||
return E_SUCCESS;
|
||||
}
|
||||
|
||||
@@ -26,8 +26,8 @@ error_t UU_Npx_Load(Unit *unit, const uint8_t *packed_rgb, uint32_t nbytes)
|
||||
CHECK_TYPE(unit, &UNIT_NEOPIXEL);
|
||||
|
||||
struct priv *priv = unit->data;
|
||||
if (nbytes != 3*priv->pixels) return E_BAD_COUNT;
|
||||
ws2812_load_raw(priv->port, priv->ll_pin, packed_rgb, priv->pixels);
|
||||
if (nbytes != 3*priv->cfg.pixels) return E_BAD_COUNT;
|
||||
ws2812_load_raw(priv->port, priv->ll_pin, packed_rgb, priv->cfg.pixels);
|
||||
return E_SUCCESS;
|
||||
}
|
||||
|
||||
@@ -37,8 +37,8 @@ static error_t load_u32(Unit *unit, const uint8_t *bytes, uint32_t nbytes, bool
|
||||
CHECK_TYPE(unit, &UNIT_NEOPIXEL);
|
||||
|
||||
struct priv *priv = unit->data;
|
||||
if (nbytes != 4*priv->pixels) return E_BAD_COUNT;
|
||||
ws2812_load_sparse(priv->port, priv->ll_pin, bytes, priv->pixels, bige);
|
||||
if (nbytes != 4*priv->cfg.pixels) return E_BAD_COUNT;
|
||||
ws2812_load_sparse(priv->port, priv->ll_pin, bytes, priv->cfg.pixels, bige);
|
||||
return E_SUCCESS;
|
||||
}
|
||||
|
||||
@@ -60,6 +60,6 @@ error_t UU_Npx_GetCount(Unit *unit, uint16_t *count)
|
||||
CHECK_TYPE(unit, &UNIT_NEOPIXEL);
|
||||
|
||||
struct priv *priv = unit->data;
|
||||
*count = priv->pixels;
|
||||
*count = priv->cfg.pixels;
|
||||
return E_SUCCESS;
|
||||
}
|
||||
|
||||
@@ -16,9 +16,8 @@ error_t Npx_preInit(Unit *unit)
|
||||
if (priv == NULL) return E_OUT_OF_MEM;
|
||||
|
||||
// some defaults
|
||||
priv->pin_number = 0;
|
||||
priv->port_name = 'A';
|
||||
priv->pixels = 1;
|
||||
priv->cfg.pin = R_PA0;
|
||||
priv->cfg.pixels = 1;
|
||||
|
||||
return E_SUCCESS;
|
||||
}
|
||||
@@ -30,13 +29,9 @@ error_t Npx_init(Unit *unit)
|
||||
struct priv *priv = unit->data;
|
||||
|
||||
// --- Parse config ---
|
||||
priv->ll_pin = hw_pin2ll(priv->pin_number, &suc);
|
||||
priv->port = hw_port2periph(priv->port_name, &suc);
|
||||
Resource rsc = rsc_portpin2rsc(priv->port_name, priv->pin_number, &suc);
|
||||
suc = hw_pinrsc2ll(priv->cfg.pin, &priv->port, &priv->ll_pin);
|
||||
if (!suc) return E_BAD_CONFIG;
|
||||
|
||||
// --- Claim resources ---
|
||||
TRY(rsc_claim(unit, rsc));
|
||||
TRY(rsc_claim(unit, priv->cfg.pin));
|
||||
|
||||
// --- Init hardware ---
|
||||
LL_GPIO_SetPinMode(priv->port, priv->ll_pin, LL_GPIO_MODE_OUTPUT);
|
||||
@@ -45,7 +40,7 @@ error_t Npx_init(Unit *unit)
|
||||
|
||||
// clear strip
|
||||
|
||||
ws2812_clear(priv->port, priv->ll_pin, priv->pixels);
|
||||
ws2812_clear(priv->port, priv->ll_pin, priv->cfg.pixels);
|
||||
|
||||
return E_SUCCESS;
|
||||
}
|
||||
|
||||
@@ -13,9 +13,10 @@
|
||||
|
||||
/** Private data structure */
|
||||
struct priv {
|
||||
char port_name;
|
||||
uint8_t pin_number;
|
||||
uint16_t pixels;
|
||||
struct {
|
||||
Resource pin;
|
||||
uint16_t pixels;
|
||||
} cfg;
|
||||
|
||||
uint32_t ll_pin;
|
||||
GPIO_TypeDef *port;
|
||||
|
||||
@@ -13,9 +13,8 @@ void Npx_loadBinary(Unit *unit, PayloadParser *pp)
|
||||
{
|
||||
struct priv *priv = unit->data;
|
||||
|
||||
priv->port_name = pp_char(pp);
|
||||
priv->pin_number = pp_u8(pp);
|
||||
priv->pixels = pp_u16(pp);
|
||||
priv->cfg.pin = (Resource) pp_u8(pp);
|
||||
priv->cfg.pixels = pp_u16(pp);
|
||||
}
|
||||
|
||||
/** Write to a binary buffer for storing in Flash */
|
||||
@@ -23,9 +22,8 @@ void Npx_writeBinary(Unit *unit, PayloadBuilder *pb)
|
||||
{
|
||||
struct priv *priv = unit->data;
|
||||
|
||||
pb_char(pb, priv->port_name);
|
||||
pb_u8(pb, priv->pin_number);
|
||||
pb_u16(pb, priv->pixels);
|
||||
pb_u8(pb, priv->cfg.pin);
|
||||
pb_u16(pb, priv->cfg.pixels);
|
||||
}
|
||||
|
||||
// ------------------------------------------------------------------------
|
||||
@@ -37,10 +35,10 @@ error_t Npx_loadIni(Unit *unit, const char *key, const char *value)
|
||||
struct priv *priv = unit->data;
|
||||
|
||||
if (streq(key, "pin")) {
|
||||
suc = cfg_portpin_parse(value, &priv->port_name, &priv->pin_number);
|
||||
priv->cfg.pin = cfg_pinrsc_parse(value, &suc);
|
||||
}
|
||||
else if (streq(key, "pixels")) {
|
||||
priv->pixels = cfg_u16_parse(value, &suc);
|
||||
priv->cfg.pixels = cfg_u16_parse(value, &suc);
|
||||
}
|
||||
else {
|
||||
return E_BAD_KEY;
|
||||
@@ -56,8 +54,8 @@ void Npx_writeIni(Unit *unit, IniWriter *iw)
|
||||
struct priv *priv = unit->data;
|
||||
|
||||
iw_comment(iw, "Data pin");
|
||||
iw_entry(iw, "pin", "%c%d", priv->port_name, priv->pin_number);
|
||||
iw_entry(iw, "pin", cfg_pinrsc_encode(priv->cfg.pin));
|
||||
|
||||
iw_comment(iw, "Number of pixels");
|
||||
iw_entry(iw, "pixels", "%d", priv->pixels);
|
||||
iw_entry(iw, "pixels", "%d", priv->cfg.pixels);
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user