Compare commits
| Author | SHA1 | Date | |
|---|---|---|---|
|
|
003ae692e6
|
||
|
|
9cff75554b
|
||
|
|
98900cdb3b
|
+2
-1
@@ -71,6 +71,7 @@ static void settings_bulkread_cb(BulkRead *bulk, uint32_t chunk, uint8_t *buffer
|
||||
if (bulk->offset == 0) iw_begin();
|
||||
|
||||
IniWriter iw = iw_init((char *)buffer, bulk->offset, chunk);
|
||||
iw.tag = 1;
|
||||
settings_build_units_ini(&iw);
|
||||
}
|
||||
|
||||
@@ -85,7 +86,7 @@ static TF_Result lst_ini_export(TinyFrame *tf, TF_Msg *msg)
|
||||
assert_param(bulk != NULL);
|
||||
|
||||
bulk->frame_id = msg->frame_id;
|
||||
bulk->len = iw_measure_total(settings_build_units_ini);
|
||||
bulk->len = iw_measure_total(settings_build_units_ini, 1);
|
||||
bulk->read = settings_bulkread_cb;
|
||||
bulk->userdata = NULL;
|
||||
|
||||
|
||||
@@ -229,7 +229,6 @@ static void gex_file_preamble(IniWriter *iw, const char *filename)
|
||||
iw_hdr_comment(iw, filename);
|
||||
iw_hdr_comment(iw, "GEX v%s on %s", GEX_VERSION, GEX_PLATFORM);
|
||||
iw_hdr_comment(iw, "built %s at %s", __DATE__, __TIME__);
|
||||
iw_cmt_newline(iw);
|
||||
}
|
||||
|
||||
/** Generate a config file header (write instructions) */
|
||||
@@ -237,12 +236,15 @@ static void ini_preamble(IniWriter *iw, const char *filename)
|
||||
{
|
||||
gex_file_preamble(iw, filename);
|
||||
|
||||
if (iw->tag == 0) { // tag 1 is set when exporting via the API
|
||||
iw_cmt_newline(iw);
|
||||
iw_comment(iw, "Overwrite this file to change settings.");
|
||||
#if PLAT_LOCK_BTN
|
||||
iw_comment(iw, "Press the LOCK button to save them to Flash.");
|
||||
#else
|
||||
iw_comment(iw, "Close the LOCK jumper to save them to Flash.");
|
||||
#endif
|
||||
}
|
||||
}
|
||||
|
||||
// --- UNITS.INI ---
|
||||
@@ -284,7 +286,7 @@ extern void plat_print_system_pinout(IniWriter *iw);
|
||||
void settings_build_pinout_txt(IniWriter *iw)
|
||||
{
|
||||
gex_file_preamble(iw, "PINOUT.TXT");
|
||||
|
||||
iw_cmt_newline(iw);
|
||||
rsc_print_all_available(iw);
|
||||
ureg_print_unit_resources(iw);
|
||||
plat_print_system_pinout(iw);
|
||||
|
||||
@@ -340,19 +340,26 @@ bool ureg_finalize_all_init(void)
|
||||
} else {
|
||||
pUnit->status = pUnit->driver->init(pUnit);
|
||||
if (pUnit->status != E_SUCCESS) {
|
||||
dbg("!!! error initing unit %s: %s", pUnit->name,
|
||||
error_get_message(pUnit->status));
|
||||
dbg("!!! error initing unit %s: %s", pUnit->name, error_get_message(pUnit->status));
|
||||
}
|
||||
|
||||
// try to assign unique callsigns
|
||||
// FIXME this is wrong, sometimes leads to duplicate CS
|
||||
if (pUnit->callsign == 0) {
|
||||
pUnit->callsign = callsign++;
|
||||
// this is very inefficient but should be reliable
|
||||
bool change = false;
|
||||
do {
|
||||
UlistEntry *xli = ulist_head;
|
||||
while (xli != NULL) {
|
||||
if (xli->unit.callsign != 0) {
|
||||
if (xli->unit.callsign == callsign) {
|
||||
change = true;
|
||||
callsign++;
|
||||
}
|
||||
else {
|
||||
if (pUnit->callsign >= callsign) {
|
||||
callsign = (uint8_t) (pUnit->callsign + 1);
|
||||
}
|
||||
xli = xli->next;
|
||||
}
|
||||
} while (change && callsign < 255);
|
||||
pUnit->callsign = callsign;
|
||||
}
|
||||
}
|
||||
|
||||
@@ -398,8 +405,9 @@ void ureg_build_ini(IniWriter *iw)
|
||||
|
||||
// Unit list
|
||||
iw_section(iw, "UNITS");
|
||||
iw_comment(iw, "Create units by adding their names next to a type (e.g. PIN=A,B),");
|
||||
iw_comment(iw, "Create units by adding their names next to a type (e.g. DO=A,B),");
|
||||
iw_comment(iw, "remove the same way. Reload to update the unit sections below.");
|
||||
iw_cmt_newline(iw);
|
||||
|
||||
// This could certainly be done in some more efficient way ...
|
||||
re = ureg_head;
|
||||
@@ -412,7 +420,6 @@ void ureg_build_ini(IniWriter *iw)
|
||||
|
||||
const UnitDriver *const pDriver = re->driver;
|
||||
|
||||
iw_cmt_newline(iw);
|
||||
iw_comment(iw, pDriver->description);
|
||||
iw_string(iw, pDriver->name);
|
||||
iw_string(iw, "=");
|
||||
|
||||
@@ -14,6 +14,7 @@ GEX_SRC_DIR = \
|
||||
User/units/i2c \
|
||||
User/units/spi \
|
||||
User/units/adc \
|
||||
User/units/sipo \
|
||||
User/TinyFrame \
|
||||
User/CWPack \
|
||||
User/tasks
|
||||
|
||||
+4
-1
@@ -240,6 +240,8 @@ char * pinmask2str_up(uint32_t pins, char *buffer)
|
||||
return buffer;
|
||||
}
|
||||
|
||||
#pragma GCC push_options
|
||||
#pragma GCC optimize ("O2")
|
||||
/** spread a packed pinfield using a mask */
|
||||
uint32_t pinmask_spread_32(uint32_t packed, uint32_t mask)
|
||||
{
|
||||
@@ -247,7 +249,7 @@ uint32_t pinmask_spread_32(uint32_t packed, uint32_t mask)
|
||||
uint32_t poke = 1;
|
||||
if(packed == 0) return 0;
|
||||
|
||||
for (int i = 0; i<32; i++) {
|
||||
for (int i = 0; i < 32; i++) {
|
||||
if (mask & 1) {
|
||||
if (packed & poke) {
|
||||
result |= 1<<i;
|
||||
@@ -295,6 +297,7 @@ uint8_t pinmask_translate(uint32_t mask, uint8_t index)
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
#pragma GCC pop_options
|
||||
|
||||
/** Configure unit pins as analog (part of unit teardown) */
|
||||
void hw_deinit_unit_pins(Unit *unit)
|
||||
|
||||
@@ -100,6 +100,7 @@ char * pinmask2str_up(uint32_t pins, char *buffer);
|
||||
*/
|
||||
uint32_t pinmask_spread_32(uint32_t packed, uint32_t mask);
|
||||
|
||||
/** Spread packed port pins using a mask - 16-bit version */
|
||||
static inline uint16_t pinmask_spread(uint16_t packed, uint16_t mask)
|
||||
{
|
||||
return (uint16_t) pinmask_spread_32(packed, mask);
|
||||
@@ -114,6 +115,7 @@ static inline uint16_t pinmask_spread(uint16_t packed, uint16_t mask)
|
||||
*/
|
||||
uint32_t pinmask_pack_32(uint32_t spread, uint32_t mask);
|
||||
|
||||
/** Pack spread port pins using a mask - 16-bit version */
|
||||
static inline uint16_t pinmask_pack(uint32_t spread, uint32_t mask)
|
||||
{
|
||||
return (uint16_t) pinmask_pack_32(spread, mask);
|
||||
|
||||
@@ -17,6 +17,7 @@
|
||||
#include "units/test/unit_test.h"
|
||||
#include "units/usart/unit_usart.h"
|
||||
#include "units/spi/unit_spi.h"
|
||||
#include "units/sipo/unit_sipo.h"
|
||||
#include "hw_utils.h"
|
||||
|
||||
void plat_init_resources(void)
|
||||
@@ -86,6 +87,7 @@ void plat_init_resources(void)
|
||||
ureg_add_type(&UNIT_USART);
|
||||
ureg_add_type(&UNIT_1WIRE);
|
||||
ureg_add_type(&UNIT_ADC);
|
||||
ureg_add_type(&UNIT_SIPO);
|
||||
|
||||
// Free all present resources
|
||||
{
|
||||
|
||||
@@ -9,80 +9,56 @@
|
||||
#define DOUT_INTERNAL
|
||||
#include "_dout_internal.h"
|
||||
|
||||
error_t UU_DOut_Spread(Unit *unit, uint16_t packed, uint16_t *spread_out)
|
||||
{
|
||||
CHECK_TYPE(unit, &UNIT_DOUT);
|
||||
*spread_out = UU_DOut_Spread_HS(unit, packed);
|
||||
return E_SUCCESS;
|
||||
}
|
||||
|
||||
uint16_t UU_DOut_Spread_HS(Unit *unit, uint16_t packed)
|
||||
{
|
||||
struct priv *priv = unit->data;
|
||||
uint16_t mask = priv->pins;
|
||||
return pinmask_spread(packed, mask);
|
||||
}
|
||||
|
||||
void UU_DOut_Write_HS(Unit *unit, uint16_t spread)
|
||||
{
|
||||
struct priv *priv = unit->data;
|
||||
uint16_t mask = priv->pins;
|
||||
uint16_t set = spread;
|
||||
uint16_t reset = ((~spread) & mask);
|
||||
priv->port->BSRR = set | (reset << 16);
|
||||
}
|
||||
|
||||
void UU_DOut_Set_HS(Unit *unit, uint16_t spread)
|
||||
{
|
||||
struct priv *priv = unit->data;
|
||||
priv->port->BSRR = spread;
|
||||
}
|
||||
|
||||
void UU_DOut_Clear_HS(Unit *unit, uint16_t spread)
|
||||
{
|
||||
struct priv *priv = unit->data;
|
||||
priv->port->BSRR = (spread<<16);
|
||||
}
|
||||
|
||||
void UU_DOut_Toggle_HS(Unit *unit, uint16_t spread)
|
||||
{
|
||||
struct priv *priv = unit->data;
|
||||
uint16_t mask = priv->pins;
|
||||
uint16_t flipped = (uint16_t) (~priv->port->ODR) & mask;
|
||||
uint16_t set = flipped & spread;
|
||||
uint16_t reset = ((~flipped) & mask) & spread;
|
||||
priv->port->BSRR = set | (reset<<16);
|
||||
}
|
||||
|
||||
error_t UU_DOut_Write(Unit *unit, uint16_t packed)
|
||||
{
|
||||
CHECK_TYPE(unit, &UNIT_DOUT);
|
||||
const uint16_t spread = UU_DOut_Spread_HS(unit, packed);
|
||||
UU_DOut_Write_HS(unit, spread);
|
||||
|
||||
struct priv *priv = unit->data;
|
||||
uint16_t mask = priv->pins;
|
||||
uint16_t spread = pinmask_spread(packed, mask);
|
||||
|
||||
uint16_t set = spread;
|
||||
uint16_t reset = ((~spread) & mask);
|
||||
priv->port->BSRR = set | (reset << 16);
|
||||
return E_SUCCESS;
|
||||
}
|
||||
|
||||
error_t UU_DOut_Set(Unit *unit, uint16_t packed)
|
||||
{
|
||||
CHECK_TYPE(unit, &UNIT_DOUT);
|
||||
const uint16_t spread = UU_DOut_Spread_HS(unit, packed);
|
||||
UU_DOut_Set_HS(unit, spread);
|
||||
|
||||
struct priv *priv = unit->data;
|
||||
uint16_t mask = priv->pins;
|
||||
uint16_t spread = pinmask_spread(packed, mask);
|
||||
|
||||
priv->port->BSRR = spread;
|
||||
return E_SUCCESS;
|
||||
}
|
||||
|
||||
error_t UU_DOut_Clear(Unit *unit, uint16_t packed)
|
||||
{
|
||||
CHECK_TYPE(unit, &UNIT_DOUT);
|
||||
const uint16_t spread = UU_DOut_Spread_HS(unit, packed);
|
||||
UU_DOut_Clear_HS(unit, spread);
|
||||
|
||||
struct priv *priv = unit->data;
|
||||
uint16_t mask = priv->pins;
|
||||
uint16_t spread = pinmask_spread(packed, mask);
|
||||
|
||||
priv->port->BSRR = (spread<<16);
|
||||
return E_SUCCESS;
|
||||
}
|
||||
|
||||
error_t UU_DOut_Toggle(Unit *unit, uint16_t packed)
|
||||
{
|
||||
CHECK_TYPE(unit, &UNIT_DOUT);
|
||||
const uint16_t spread = UU_DOut_Spread_HS(unit, packed);
|
||||
UU_DOut_Toggle_HS(unit, spread);
|
||||
|
||||
struct priv *priv = unit->data;
|
||||
uint16_t mask = priv->pins;
|
||||
uint16_t spread = pinmask_spread(packed, mask);
|
||||
|
||||
uint16_t flipped = (uint16_t) (~priv->port->ODR) & mask;
|
||||
uint16_t set = flipped & spread;
|
||||
uint16_t reset = ((~flipped) & mask) & spread;
|
||||
priv->port->BSRR = set | (reset<<16);
|
||||
return E_SUCCESS;
|
||||
}
|
||||
|
||||
|
||||
@@ -47,13 +47,13 @@ error_t DOut_loadIni(Unit *unit, const char *key, const char *value)
|
||||
suc = parse_port_name(value, &priv->port_name);
|
||||
}
|
||||
else if (streq(key, "pins")) {
|
||||
priv->pins = parse_pinmask(value, &suc);
|
||||
priv->pins = (uint16_t) parse_pinmask(value, &suc);
|
||||
}
|
||||
else if (streq(key, "initial")) {
|
||||
priv->initial = parse_pinmask(value, &suc);
|
||||
priv->initial = (uint16_t) parse_pinmask(value, &suc);
|
||||
}
|
||||
else if (streq(key, "open-drain")) {
|
||||
priv->open_drain = parse_pinmask(value, &suc);
|
||||
priv->open_drain = (uint16_t) parse_pinmask(value, &suc);
|
||||
}
|
||||
else {
|
||||
return E_BAD_KEY;
|
||||
|
||||
@@ -56,17 +56,4 @@ error_t UU_DOut_Toggle(Unit *unit, uint16_t packed);
|
||||
*/
|
||||
error_t UU_DOut_GetPinCount(Unit *unit, uint8_t *count);
|
||||
|
||||
// --- high-speed variants, without type checking and spreading ---
|
||||
|
||||
/** Spread a packed word */
|
||||
error_t UU_DOut_Spread(Unit *unit, uint16_t packed, uint16_t *spread_out);
|
||||
|
||||
// those are like the normal functions, but without driver checking and other verification (where applicable)
|
||||
// also the argument must be already spread, which saves time if the same value is used repeatedly
|
||||
uint16_t UU_DOut_Spread_HS(Unit *unit, uint16_t packed);
|
||||
void UU_DOut_Write_HS(Unit *unit, uint16_t spread);
|
||||
void UU_DOut_Set_HS(Unit *unit, uint16_t spread);
|
||||
void UU_DOut_Clear_HS(Unit *unit, uint16_t spread);
|
||||
void UU_DOut_Toggle_HS(Unit *unit, uint16_t spread);
|
||||
|
||||
#endif //U_DOUT_H
|
||||
|
||||
@@ -0,0 +1,110 @@
|
||||
//
|
||||
// Created by MightyPork on 2018/02/03.
|
||||
//
|
||||
|
||||
#include "platform.h"
|
||||
#include "unit_base.h"
|
||||
#include "unit_sipo.h"
|
||||
|
||||
#define SIPO_INTERNAL
|
||||
#include "_sipo_internal.h"
|
||||
|
||||
static void send_pulse(bool pol, GPIO_TypeDef *port, uint32_t ll)
|
||||
{
|
||||
if (pol) {
|
||||
LL_GPIO_SetOutputPin(port, ll);
|
||||
}
|
||||
else {
|
||||
LL_GPIO_ResetOutputPin(port, ll);
|
||||
}
|
||||
|
||||
__asm_loop(2);
|
||||
|
||||
if (pol) {
|
||||
LL_GPIO_ResetOutputPin(port, ll);
|
||||
}
|
||||
else {
|
||||
LL_GPIO_SetOutputPin(port, ll);
|
||||
}
|
||||
}
|
||||
|
||||
#pragma GCC push_options
|
||||
#pragma GCC optimize ("O2")
|
||||
error_t UU_SIPO_Write(Unit *unit, const uint8_t *buffer, uint16_t buflen, uint16_t terminal_data)
|
||||
{
|
||||
CHECK_TYPE(unit, &UNIT_SIPO);
|
||||
struct priv *priv = unit->data;
|
||||
|
||||
if (buflen % priv->data_width != 0) {
|
||||
dbg("Buflen %d vs width %d", (int)buflen, (int)priv->data_width);
|
||||
return E_BAD_COUNT; // must be a multiple of the channel count
|
||||
}
|
||||
|
||||
// buffer contains data for the individual data pins, back to back as AAA BBB CCC (whole bytes)
|
||||
const uint8_t data_width = priv->data_width;
|
||||
const uint16_t bytelen = buflen / data_width;
|
||||
const uint16_t mask = priv->data_pins;
|
||||
|
||||
uint8_t offsets[16];
|
||||
for (int i=0; i<16; i++) offsets[i] = (uint8_t) (bytelen * i);
|
||||
|
||||
for (int32_t bn = bytelen - 1; bn >= 0; bn--) {
|
||||
// send the byte
|
||||
for (int32_t i = 0; i < 8; i++) {
|
||||
uint16_t packed = 0;
|
||||
for (int32_t j = data_width - 1; j >= 0; j--) {
|
||||
packed |= (buffer[bn + offsets[j]] >> i) & 1;
|
||||
if (j > 0) packed <<= 1;
|
||||
}
|
||||
|
||||
uint16_t spread = pinmask_spread(packed, mask);
|
||||
priv->data_port->BSRR = spread | (((~spread) & mask) << 16);
|
||||
|
||||
// Shift clock pulse
|
||||
send_pulse(priv->shift_pol, priv->shift_port, priv->shift_ll);
|
||||
}
|
||||
}
|
||||
|
||||
// load the final data - this may be used by some other circuitry or
|
||||
// simply to rest the lines at a defined known level
|
||||
uint16_t spread = pinmask_spread(terminal_data, mask);
|
||||
priv->data_port->BSRR = spread | (((~spread) & mask) << 16);
|
||||
|
||||
send_pulse(priv->store_pol, priv->store_port, priv->store_ll);
|
||||
return E_SUCCESS;
|
||||
}
|
||||
#pragma GCC pop_options
|
||||
|
||||
error_t UU_SIPO_DirectData(Unit *unit, uint16_t data_packed)
|
||||
{
|
||||
CHECK_TYPE(unit, &UNIT_SIPO);
|
||||
struct priv *priv = unit->data;
|
||||
|
||||
uint16_t spread = pinmask_spread(data_packed, priv->data_pins);
|
||||
priv->data_port->BSRR = spread | (((~spread) & priv->data_pins) << 16);
|
||||
return E_SUCCESS;
|
||||
}
|
||||
|
||||
error_t UU_SIPO_DirectClear(Unit *unit)
|
||||
{
|
||||
CHECK_TYPE(unit, &UNIT_SIPO);
|
||||
struct priv *priv = unit->data;
|
||||
send_pulse(priv->clear_pol, priv->clear_port, priv->clear_ll);
|
||||
return E_SUCCESS;
|
||||
}
|
||||
|
||||
error_t UU_SIPO_DirectShift(Unit *unit)
|
||||
{
|
||||
CHECK_TYPE(unit, &UNIT_SIPO);
|
||||
struct priv *priv = unit->data;
|
||||
send_pulse(priv->shift_pol, priv->shift_port, priv->shift_ll);
|
||||
return E_SUCCESS;
|
||||
}
|
||||
|
||||
error_t UU_SIPO_DirectStore(Unit *unit)
|
||||
{
|
||||
CHECK_TYPE(unit, &UNIT_SIPO);
|
||||
struct priv *priv = unit->data;
|
||||
send_pulse(priv->store_pol, priv->store_port, priv->store_ll);
|
||||
return E_SUCCESS;
|
||||
}
|
||||
@@ -0,0 +1,126 @@
|
||||
//
|
||||
// Created by MightyPork on 2018/02/03.
|
||||
//
|
||||
|
||||
#include "platform.h"
|
||||
#include "unit_base.h"
|
||||
|
||||
#define SIPO_INTERNAL
|
||||
#include "_sipo_internal.h"
|
||||
|
||||
/** Allocate data structure and set defaults */
|
||||
error_t USIPO_preInit(Unit *unit)
|
||||
{
|
||||
struct priv *priv = unit->data = calloc_ck(1, sizeof(struct priv));
|
||||
if (priv == NULL) return E_OUT_OF_MEM;
|
||||
|
||||
priv->store_pname = 'A';
|
||||
priv->store_pnum = 0;
|
||||
priv->store_pol = true;
|
||||
|
||||
priv->shift_pname = 'A';
|
||||
priv->shift_pnum = 1;
|
||||
priv->shift_pol = true;
|
||||
|
||||
priv->clear_pname = 'A';
|
||||
priv->clear_pnum = 2;
|
||||
priv->clear_pol = false;
|
||||
|
||||
priv->data_pname = 'A';
|
||||
priv->data_pins = (1<<3);
|
||||
|
||||
return E_SUCCESS;
|
||||
}
|
||||
|
||||
/** Finalize unit set-up */
|
||||
error_t USIPO_init(Unit *unit)
|
||||
{
|
||||
bool suc = true;
|
||||
struct priv *priv = unit->data;
|
||||
|
||||
// --- Parse config ---
|
||||
priv->store_ll = hw_pin2ll(priv->store_pnum, &suc);
|
||||
priv->store_port = hw_port2periph(priv->store_pname, &suc);
|
||||
Resource store_rsc = hw_pin2resource(priv->store_pname, priv->store_pnum, &suc);
|
||||
if (!suc) return E_BAD_CONFIG;
|
||||
TRY(rsc_claim(unit, store_rsc));
|
||||
|
||||
priv->shift_ll = hw_pin2ll(priv->shift_pnum, &suc);
|
||||
priv->shift_port = hw_port2periph(priv->shift_pname, &suc);
|
||||
Resource shift_rsc = hw_pin2resource(priv->shift_pname, priv->shift_pnum, &suc);
|
||||
if (!suc) return E_BAD_CONFIG;
|
||||
TRY(rsc_claim(unit, shift_rsc));
|
||||
|
||||
priv->clear_ll = hw_pin2ll(priv->clear_pnum, &suc);
|
||||
priv->clear_port = hw_port2periph(priv->clear_pname, &suc);
|
||||
Resource clear_rsc = hw_pin2resource(priv->clear_pname, priv->clear_pnum, &suc);
|
||||
if (!suc) return E_BAD_CONFIG;
|
||||
TRY(rsc_claim(unit, clear_rsc));
|
||||
|
||||
// Claim all needed pins
|
||||
TRY(rsc_claim_gpios(unit, priv->data_pname, priv->data_pins));
|
||||
priv->data_port = hw_port2periph(priv->data_pname, &suc);
|
||||
|
||||
// --- Init hardware ---
|
||||
|
||||
priv->data_width = 0;
|
||||
for (int i = 0; i < 16; i++) {
|
||||
if (priv->data_pins & (1 << i)) {
|
||||
uint32_t ll_pin = hw_pin2ll((uint8_t) i, &suc);
|
||||
LL_GPIO_SetPinMode(priv->data_port, ll_pin, LL_GPIO_MODE_OUTPUT);
|
||||
LL_GPIO_SetPinOutputType(priv->data_port, ll_pin, LL_GPIO_OUTPUT_PUSHPULL);
|
||||
LL_GPIO_SetPinSpeed(priv->data_port, ll_pin, LL_GPIO_SPEED_FREQ_HIGH);
|
||||
priv->data_width++;
|
||||
}
|
||||
}
|
||||
|
||||
// Set the initial state - zeros
|
||||
priv->data_port->ODR &= ~priv->data_pins;
|
||||
|
||||
|
||||
// STORE
|
||||
LL_GPIO_SetPinMode(priv->store_port, priv->store_ll, LL_GPIO_MODE_OUTPUT);
|
||||
LL_GPIO_SetPinOutputType(priv->store_port, priv->store_ll, LL_GPIO_OUTPUT_PUSHPULL);
|
||||
LL_GPIO_SetPinSpeed(priv->store_port, priv->store_ll, LL_GPIO_SPEED_FREQ_HIGH);
|
||||
|
||||
if (priv->store_pol)
|
||||
LL_GPIO_ResetOutputPin(priv->store_port, priv->store_ll);
|
||||
else
|
||||
LL_GPIO_SetOutputPin(priv->store_port, priv->store_ll);
|
||||
|
||||
// SHIFT
|
||||
LL_GPIO_SetPinMode(priv->shift_port, priv->shift_ll, LL_GPIO_MODE_OUTPUT);
|
||||
LL_GPIO_SetPinOutputType(priv->shift_port, priv->shift_ll, LL_GPIO_OUTPUT_PUSHPULL);
|
||||
LL_GPIO_SetPinSpeed(priv->shift_port, priv->shift_ll, LL_GPIO_SPEED_FREQ_HIGH);
|
||||
|
||||
if (priv->shift_pol)
|
||||
LL_GPIO_ResetOutputPin(priv->shift_port, priv->shift_ll);
|
||||
else
|
||||
LL_GPIO_SetOutputPin(priv->shift_port, priv->shift_ll);
|
||||
|
||||
// CLEAR
|
||||
LL_GPIO_SetPinMode(priv->clear_port, priv->clear_ll, LL_GPIO_MODE_OUTPUT);
|
||||
LL_GPIO_SetPinOutputType(priv->clear_port, priv->clear_ll, LL_GPIO_OUTPUT_PUSHPULL);
|
||||
LL_GPIO_SetPinSpeed(priv->clear_port, priv->clear_ll, LL_GPIO_SPEED_FREQ_HIGH);
|
||||
|
||||
if (priv->clear_pol)
|
||||
LL_GPIO_ResetOutputPin(priv->clear_port, priv->clear_ll);
|
||||
else
|
||||
LL_GPIO_SetOutputPin(priv->clear_port, priv->clear_ll);
|
||||
|
||||
// initial clear
|
||||
UU_SIPO_DirectClear(unit);
|
||||
|
||||
return E_SUCCESS;
|
||||
}
|
||||
|
||||
|
||||
/** Tear down the unit */
|
||||
void USIPO_deInit(Unit *unit)
|
||||
{
|
||||
// Release all resources, deinit pins
|
||||
rsc_teardown(unit);
|
||||
|
||||
// Free memory
|
||||
free_ck(unit->data);
|
||||
}
|
||||
@@ -0,0 +1,121 @@
|
||||
//
|
||||
// Created by MightyPork on 2018/02/03.
|
||||
//
|
||||
|
||||
#ifndef GEX_F072_SIPO_INTERNAL_H
|
||||
#define GEX_F072_SIPO_INTERNAL_H
|
||||
|
||||
#ifndef SIPO_INTERNAL
|
||||
#error bad include!
|
||||
#endif
|
||||
|
||||
#include "unit_base.h"
|
||||
|
||||
/** Private data structure */
|
||||
struct priv {
|
||||
// settings
|
||||
char store_pname;
|
||||
uint8_t store_pnum;
|
||||
bool store_pol; //!< Store pulse active edge
|
||||
|
||||
char shift_pname;
|
||||
uint8_t shift_pnum;
|
||||
bool shift_pol; //!< Shift clock active edge
|
||||
|
||||
char clear_pname;
|
||||
uint8_t clear_pnum;
|
||||
bool clear_pol; //!< Clear signal active level
|
||||
|
||||
char data_pname;
|
||||
uint16_t data_pins;
|
||||
|
||||
// live fields
|
||||
uint32_t store_ll;
|
||||
uint32_t shift_ll;
|
||||
uint32_t clear_ll;
|
||||
|
||||
GPIO_TypeDef *store_port;
|
||||
GPIO_TypeDef *shift_port;
|
||||
GPIO_TypeDef *clear_port;
|
||||
GPIO_TypeDef *data_port;
|
||||
|
||||
uint8_t data_width;
|
||||
};
|
||||
|
||||
/** Allocate data structure and set defaults */
|
||||
error_t USIPO_preInit(Unit *unit);
|
||||
|
||||
/** Load from a binary buffer stored in Flash */
|
||||
void USIPO_loadBinary(Unit *unit, PayloadParser *pp);
|
||||
|
||||
/** Write to a binary buffer for storing in Flash */
|
||||
void USIPO_writeBinary(Unit *unit, PayloadBuilder *pb);
|
||||
|
||||
// ------------------------------------------------------------------------
|
||||
|
||||
/** Parse a key-value pair from the INI file */
|
||||
error_t USIPO_loadIni(Unit *unit, const char *key, const char *value);
|
||||
|
||||
/** Generate INI file section for the unit */
|
||||
void USIPO_writeIni(Unit *unit, IniWriter *iw);
|
||||
|
||||
// ------------------------------------------------------------------------
|
||||
|
||||
/** Finalize unit set-up */
|
||||
error_t USIPO_init(Unit *unit);
|
||||
|
||||
/** Tear down the unit */
|
||||
void USIPO_deInit(Unit *unit);
|
||||
|
||||
// ------------------------------------------------------------------------
|
||||
|
||||
/**
|
||||
* Write a buffer to the pins.
|
||||
* Buffer contains data for the individual channels, sequentially (AAAAAA BBBBBB CCCCCC ...)
|
||||
* The bytes are sent LSB first, from the last byte (e.g. 1,2,3 - 3 is sent first, LSB-first).
|
||||
*
|
||||
* The chunks order is from the lowest to the highest bit
|
||||
*
|
||||
* @param unit
|
||||
* @param buffer - buffer of data to send
|
||||
* @param buflen - number of bytes in the buffer
|
||||
* @param terminal_data - data to set before sending the store pulse (final data lines state, will not appear in the SIPOs)
|
||||
* @return success
|
||||
*/
|
||||
error_t UU_SIPO_Write(Unit *unit, const uint8_t *buffer, uint16_t buflen, uint16_t terminal_data);
|
||||
|
||||
/**
|
||||
* Direct access to the output data pins (may be useful for debugging, or circuits that use them
|
||||
* for something else when not loading a new value).
|
||||
*
|
||||
* @param unit
|
||||
* @param data_packed - packed data to set on the output (right-aligned, highest to lowest pin)
|
||||
* @return success
|
||||
*/
|
||||
error_t UU_SIPO_DirectData(Unit *unit, uint16_t data_packed);
|
||||
|
||||
/**
|
||||
* Send a clear pulse.
|
||||
*
|
||||
* @param unit
|
||||
* @return success
|
||||
*/
|
||||
error_t UU_SIPO_DirectClear(Unit *unit);
|
||||
|
||||
/**
|
||||
* Send a shift pulse.
|
||||
*
|
||||
* @param unit
|
||||
* @return success
|
||||
*/
|
||||
error_t UU_SIPO_DirectShift(Unit *unit);
|
||||
|
||||
/**
|
||||
* Send a store pulse.
|
||||
*
|
||||
* @param unit
|
||||
* @return success
|
||||
*/
|
||||
error_t UU_SIPO_DirectStore(Unit *unit);
|
||||
|
||||
#endif //GEX_F072_SIPO_INTERNAL_H
|
||||
@@ -0,0 +1,122 @@
|
||||
//
|
||||
// Created by MightyPork on 2018/02/03.
|
||||
//
|
||||
|
||||
#include "platform.h"
|
||||
#include "unit_base.h"
|
||||
|
||||
#define SIPO_INTERNAL
|
||||
#include "_sipo_internal.h"
|
||||
|
||||
/** Load from a binary buffer stored in Flash */
|
||||
void USIPO_loadBinary(Unit *unit, PayloadParser *pp)
|
||||
{
|
||||
struct priv *priv = unit->data;
|
||||
|
||||
uint8_t version = pp_u8(pp);
|
||||
(void)version;
|
||||
|
||||
priv->store_pname = pp_char(pp);
|
||||
priv->store_pnum = pp_u8(pp);
|
||||
priv->store_pol = pp_bool(pp);
|
||||
|
||||
priv->shift_pname = pp_char(pp);
|
||||
priv->shift_pnum = pp_u8(pp);
|
||||
priv->shift_pol = pp_bool(pp);
|
||||
|
||||
priv->clear_pname = pp_char(pp);
|
||||
priv->clear_pnum = pp_u8(pp);
|
||||
priv->clear_pol = pp_bool(pp);
|
||||
|
||||
priv->data_pname = pp_char(pp);
|
||||
priv->data_pins = pp_u16(pp);
|
||||
}
|
||||
|
||||
/** Write to a binary buffer for storing in Flash */
|
||||
void USIPO_writeBinary(Unit *unit, PayloadBuilder *pb)
|
||||
{
|
||||
struct priv *priv = unit->data;
|
||||
|
||||
pb_u8(pb, 0); // version
|
||||
|
||||
pb_char(pb, priv->store_pname);
|
||||
pb_u8(pb, priv->store_pnum);
|
||||
pb_bool(pb, priv->store_pol);
|
||||
|
||||
pb_char(pb, priv->shift_pname);
|
||||
pb_u8(pb, priv->shift_pnum);
|
||||
pb_bool(pb, priv->shift_pol);
|
||||
|
||||
pb_char(pb, priv->clear_pname);
|
||||
pb_u8(pb, priv->clear_pnum);
|
||||
pb_bool(pb, priv->clear_pol);
|
||||
|
||||
pb_char(pb, priv->data_pname);
|
||||
pb_u16(pb, priv->data_pins);
|
||||
}
|
||||
|
||||
// ------------------------------------------------------------------------
|
||||
|
||||
/** Parse a key-value pair from the INI file */
|
||||
error_t USIPO_loadIni(Unit *unit, const char *key, const char *value)
|
||||
{
|
||||
bool suc = true;
|
||||
struct priv *priv = unit->data;
|
||||
|
||||
if (streq(key, "store-pin")) {
|
||||
suc = parse_pin(value, &priv->store_pname, &priv->store_pnum);
|
||||
}
|
||||
else if (streq(key, "shift-pin")) {
|
||||
suc = parse_pin(value, &priv->shift_pname, &priv->shift_pnum);
|
||||
}
|
||||
else if (streq(key, "clear-pin")) {
|
||||
suc = parse_pin(value, &priv->clear_pname, &priv->clear_pnum);
|
||||
}
|
||||
|
||||
else if (streq(key, "store-pol")) {
|
||||
priv->store_pol = (bool) avr_atoi(value);
|
||||
}
|
||||
else if (streq(key, "shift-pol")) {
|
||||
priv->shift_pol = (bool) avr_atoi(value);
|
||||
}
|
||||
else if (streq(key, "clear-pol")) {
|
||||
priv->clear_pol = (bool) avr_atoi(value);
|
||||
}
|
||||
|
||||
else if (streq(key, "data-port")) {
|
||||
suc = parse_port_name(value, &priv->data_pname);
|
||||
}
|
||||
else if (streq(key, "data-pins")) {
|
||||
priv->data_pins = (uint16_t) parse_pinmask(value, &suc);
|
||||
}
|
||||
|
||||
else {
|
||||
return E_BAD_KEY;
|
||||
}
|
||||
|
||||
if (!suc) return E_BAD_VALUE;
|
||||
return E_SUCCESS;
|
||||
}
|
||||
|
||||
/** Generate INI file section for the unit */
|
||||
void USIPO_writeIni(Unit *unit, IniWriter *iw)
|
||||
{
|
||||
struct priv *priv = unit->data;
|
||||
|
||||
iw_comment(iw, "Shift pin & its active edge (1-rising,0-falling)");
|
||||
iw_entry(iw, "shift-pin", "%c%d", priv->shift_pname, priv->shift_pnum);
|
||||
iw_entry(iw, "shift-pol", "%d", priv->shift_pol);
|
||||
|
||||
iw_comment(iw, "Store pin & its active edge");
|
||||
iw_entry(iw, "store-pin", "%c%d", priv->store_pname, priv->store_pnum);
|
||||
iw_entry(iw, "store-pol", "%d", priv->store_pol);
|
||||
|
||||
iw_comment(iw, "Clear pin & its active level");
|
||||
iw_entry(iw, "clear-pin", "%c%d", priv->clear_pname, priv->clear_pnum);
|
||||
iw_entry(iw, "clear-pol", "%d", priv->clear_pol);
|
||||
|
||||
iw_comment(iw, "Data port and pins");
|
||||
iw_entry(iw, "data-port", "%c", priv->data_pname);
|
||||
iw_entry(iw, "data-pins", "%s", pinmask2str_up(priv->data_pins, unit_tmp512));
|
||||
}
|
||||
|
||||
@@ -0,0 +1,73 @@
|
||||
//
|
||||
// Created by MightyPork on 2017/11/25.
|
||||
//
|
||||
|
||||
#include "unit_base.h"
|
||||
#include "unit_sipo.h"
|
||||
|
||||
#define SIPO_INTERNAL
|
||||
|
||||
#include "_sipo_internal.h"
|
||||
|
||||
// ------------------------------------------------------------------------
|
||||
|
||||
enum SipoCmd_ {
|
||||
CMD_WRITE = 0,
|
||||
CMD_DIRECT_DATA = 1,
|
||||
CMD_DIRECT_SHIFT = 2,
|
||||
CMD_DIRECT_CLEAR = 3,
|
||||
CMD_DIRECT_STORE = 4,
|
||||
};
|
||||
|
||||
/** Handle a request message */
|
||||
static error_t USIPO_handleRequest(Unit *unit, TF_ID frame_id, uint8_t command, PayloadParser *pp)
|
||||
{
|
||||
switch (command) {
|
||||
case CMD_WRITE:
|
||||
{
|
||||
uint32_t len;
|
||||
uint16_t terminal_packed = pp_u16(pp);
|
||||
const uint8_t *tail = pp_tail(pp, &len);
|
||||
TRY(UU_SIPO_Write(unit, (uint8_t *) tail, (uint16_t) len, terminal_packed));
|
||||
}
|
||||
return E_SUCCESS;
|
||||
|
||||
case CMD_DIRECT_DATA:
|
||||
TRY(UU_SIPO_DirectData(unit, pp_u16(pp)));
|
||||
return E_SUCCESS;
|
||||
|
||||
case CMD_DIRECT_CLEAR:
|
||||
TRY(UU_SIPO_DirectClear(unit));
|
||||
return E_SUCCESS;
|
||||
|
||||
case CMD_DIRECT_SHIFT:
|
||||
TRY(UU_SIPO_DirectShift(unit));
|
||||
return E_SUCCESS;
|
||||
|
||||
case CMD_DIRECT_STORE:
|
||||
TRY(UU_SIPO_DirectStore(unit));
|
||||
return E_SUCCESS;
|
||||
|
||||
default:
|
||||
return E_UNKNOWN_COMMAND;
|
||||
}
|
||||
}
|
||||
|
||||
// ------------------------------------------------------------------------
|
||||
|
||||
/** Unit template */
|
||||
const UnitDriver UNIT_SIPO = {
|
||||
.name = "SIPO",
|
||||
.description = "Shift register driver (595, 4094)",
|
||||
// Settings
|
||||
.preInit = USIPO_preInit,
|
||||
.cfgLoadBinary = USIPO_loadBinary,
|
||||
.cfgWriteBinary = USIPO_writeBinary,
|
||||
.cfgLoadIni = USIPO_loadIni,
|
||||
.cfgWriteIni = USIPO_writeIni,
|
||||
// Init
|
||||
.init = USIPO_init,
|
||||
.deInit = USIPO_deInit,
|
||||
// Function
|
||||
.handleRequest = USIPO_handleRequest,
|
||||
};
|
||||
@@ -0,0 +1,16 @@
|
||||
//
|
||||
// Created by MightyPork on 2017/11/25.
|
||||
//
|
||||
// Digital input unit; single or multiple pin read access on one port (A-F)
|
||||
//
|
||||
|
||||
#ifndef U_SIPO_H
|
||||
#define U_SIPO_H
|
||||
|
||||
#include "unit.h"
|
||||
|
||||
extern const UnitDriver UNIT_SIPO;
|
||||
|
||||
// UU_ prototypes
|
||||
|
||||
#endif //U_SIPO_H
|
||||
+2
-1
@@ -119,9 +119,10 @@ void iw_entry(IniWriter *iw, const char *key, const char *format, ...)
|
||||
iw_newline(iw); // one newline after entry
|
||||
}
|
||||
|
||||
uint32_t iw_measure_total(void (*handler)(IniWriter *))
|
||||
uint32_t iw_measure_total(void (*handler)(IniWriter *), uint32_t tag)
|
||||
{
|
||||
IniWriter iw = iw_init(NULL, 0xFFFFFFFF, 1);
|
||||
iw.tag = tag;
|
||||
iw_begin();
|
||||
handler(&iw);
|
||||
iw_end();
|
||||
|
||||
+3
-2
@@ -18,6 +18,7 @@ typedef struct iniwriter_ {
|
||||
char *ptr;
|
||||
uint32_t skip;
|
||||
uint32_t count;
|
||||
uint32_t tag; // general purpose field (used to identify for which purpose is the file being read)
|
||||
} IniWriter;
|
||||
|
||||
/**
|
||||
@@ -43,7 +44,7 @@ void iw_end(void);
|
||||
* @param count - number of bytes to write, truncate rest
|
||||
* @return structure initializer
|
||||
*/
|
||||
#define iw_init(buffer, skip, count) (IniWriter){buffer, skip, count}
|
||||
#define iw_init(xbuffer, xskip, xcount) (IniWriter){.ptr=(xbuffer), .skip=(xskip), .count=(xcount)}
|
||||
|
||||
/**
|
||||
* Try to write a buffer to the file
|
||||
@@ -131,6 +132,6 @@ void iw_entry(IniWriter *iw, const char *key, const char *format, ...)
|
||||
* @param handler - function that normally writes to the writer
|
||||
* @return byte count
|
||||
*/
|
||||
uint32_t iw_measure_total(void (*handler)(IniWriter *));
|
||||
uint32_t iw_measure_total(void (*handler)(IniWriter *), uint32_t tag);
|
||||
|
||||
#endif //INIWRITER_H
|
||||
|
||||
+3
-3
@@ -73,9 +73,9 @@ void vfs_user_build_filesystem(void)
|
||||
// Setup the filesystem based on target parameters
|
||||
vfs_init(daplink_drive_name, 0/*unused "disk size"*/);
|
||||
|
||||
vfs_create_file("UNITS INI", read_file_units_ini, NULL, iw_measure_total(settings_build_units_ini));
|
||||
vfs_create_file("SYSTEM INI", read_file_system_ini, NULL, iw_measure_total(settings_build_system_ini));
|
||||
vfs_create_file("PINOUT TXT", read_file_pinout_txt, NULL, iw_measure_total(settings_build_pinout_txt));
|
||||
vfs_create_file("UNITS INI", read_file_units_ini, NULL, iw_measure_total(settings_build_units_ini, 0));
|
||||
vfs_create_file("SYSTEM INI", read_file_system_ini, NULL, iw_measure_total(settings_build_system_ini, 0));
|
||||
vfs_create_file("PINOUT TXT", read_file_pinout_txt, NULL, iw_measure_total(settings_build_pinout_txt, 0));
|
||||
}
|
||||
|
||||
|
||||
|
||||
Reference in New Issue
Block a user