parent
590d550a09
commit
b2066a9010
@ -0,0 +1,40 @@ |
|||||||
|
//
|
||||||
|
// Created by MightyPork on 2018/02/03.
|
||||||
|
//
|
||||||
|
|
||||||
|
#include "platform.h" |
||||||
|
#include "unit_base.h" |
||||||
|
#include "unit_dac.h" |
||||||
|
|
||||||
|
#define DAC_INTERNAL |
||||||
|
#include "_dac_internal.h" |
||||||
|
|
||||||
|
/**
|
||||||
|
* Re-configure the
|
||||||
|
* @param unit |
||||||
|
*/ |
||||||
|
void UDAC_Reconfigure(Unit *unit) |
||||||
|
{ |
||||||
|
struct priv *priv = unit->data; |
||||||
|
|
||||||
|
DAC->CR &= ~(DAC_CR_EN1 | DAC_CR_EN2); |
||||||
|
uint32_t CR = 0; |
||||||
|
if (priv->cfg.ch1.enable) { |
||||||
|
CR |= |
||||||
|
(priv->cfg.ch1.buffered ? 0 : DAC_CR_BOFF1) | |
||||||
|
(priv->cfg.ch1.noise_type << DAC_CR_WAVE1_Pos) | |
||||||
|
(priv->cfg.ch1.noise_level & 0xF) << DAC_CR_MAMP1_Pos | |
||||||
|
(0b111 << DAC_CR_TSEL1_Pos); // software trigger;
|
||||||
|
|
||||||
|
CR |= DAC_CR_EN1; |
||||||
|
} |
||||||
|
if (priv->cfg.ch2.enable) { |
||||||
|
CR |= |
||||||
|
(priv->cfg.ch2.buffered ? 0 : DAC_CR_BOFF2) | |
||||||
|
(priv->cfg.ch2.noise_type << DAC_CR_WAVE2_Pos) | |
||||||
|
(priv->cfg.ch2.noise_level & 0xF) << DAC_CR_MAMP2_Pos | |
||||||
|
(0b111 << DAC_CR_TSEL2_Pos); // software trigger
|
||||||
|
CR |= DAC_CR_EN2; |
||||||
|
} |
||||||
|
DAC->CR = CR; |
||||||
|
} |
@ -0,0 +1,99 @@ |
|||||||
|
//
|
||||||
|
// Created by MightyPork on 2018/02/03.
|
||||||
|
//
|
||||||
|
|
||||||
|
#include "platform.h" |
||||||
|
#include "unit_base.h" |
||||||
|
|
||||||
|
#define DAC_INTERNAL |
||||||
|
#include "_dac_internal.h" |
||||||
|
|
||||||
|
/** Allocate data structure and set defaults */ |
||||||
|
error_t UDAC_preInit(Unit *unit) |
||||||
|
{ |
||||||
|
struct priv *priv = unit->data = calloc_ck(1, sizeof(struct priv)); |
||||||
|
if (priv == NULL) return E_OUT_OF_MEM; |
||||||
|
|
||||||
|
priv->cfg.ch1.buffered = true; |
||||||
|
priv->cfg.ch1.enable = true; |
||||||
|
priv->cfg.ch1.noise_level = 2; |
||||||
|
priv->cfg.ch1.noise_type = NOISE_NONE; |
||||||
|
|
||||||
|
priv->ch1.noise_type = priv->cfg.ch1.noise_type; |
||||||
|
priv->ch1.noise_level = priv->cfg.ch1.noise_level; |
||||||
|
|
||||||
|
priv->cfg.ch2.buffered = true; |
||||||
|
priv->cfg.ch2.enable = true; |
||||||
|
priv->cfg.ch2.noise_level = 2; |
||||||
|
priv->cfg.ch2.noise_type = NOISE_NONE; |
||||||
|
|
||||||
|
priv->ch2.noise_type = priv->cfg.ch2.noise_type; |
||||||
|
priv->ch2.noise_level = priv->cfg.ch2.noise_level; |
||||||
|
|
||||||
|
return E_SUCCESS; |
||||||
|
} |
||||||
|
|
||||||
|
/** Finalize unit set-up */ |
||||||
|
error_t UDAC_init(Unit *unit) |
||||||
|
{ |
||||||
|
bool suc = true; |
||||||
|
struct priv *priv = unit->data; |
||||||
|
|
||||||
|
// this may change for different devices
|
||||||
|
const Resource r_ch1 = R_PA4; |
||||||
|
const Resource r_ch2 = R_PA5; |
||||||
|
|
||||||
|
const bool e1 = priv->cfg.ch1.enable; |
||||||
|
const bool e2 = priv->cfg.ch2.enable; |
||||||
|
|
||||||
|
|
||||||
|
if (e1) { |
||||||
|
TRY(rsc_claim(unit, r_ch1)); |
||||||
|
} |
||||||
|
|
||||||
|
if (e2) { |
||||||
|
TRY(rsc_claim(unit, r_ch2)); |
||||||
|
} |
||||||
|
|
||||||
|
TRY(rsc_claim(unit, R_DAC1)); |
||||||
|
|
||||||
|
// ensure the peripheral is clean (this may be redundant)
|
||||||
|
__HAL_RCC_DAC1_FORCE_RESET(); |
||||||
|
__HAL_RCC_DAC1_RELEASE_RESET(); |
||||||
|
|
||||||
|
hw_periph_clock_enable(DAC1); |
||||||
|
|
||||||
|
GPIO_TypeDef *port; |
||||||
|
uint32_t ll; |
||||||
|
if (e1) { |
||||||
|
assert_param(hw_pinrsc2ll(r_ch1, &port, &ll)); |
||||||
|
LL_GPIO_SetPinMode(port, ll, LL_GPIO_MODE_ANALOG); |
||||||
|
} |
||||||
|
if (e2) { |
||||||
|
assert_param(hw_pinrsc2ll(r_ch1, &port, &ll)); |
||||||
|
LL_GPIO_SetPinMode(port, ll, LL_GPIO_MODE_ANALOG); |
||||||
|
} |
||||||
|
|
||||||
|
UDAC_Reconfigure(unit); |
||||||
|
|
||||||
|
return E_SUCCESS; |
||||||
|
} |
||||||
|
|
||||||
|
|
||||||
|
/** Tear down the unit */ |
||||||
|
void UDAC_deInit(Unit *unit) |
||||||
|
{ |
||||||
|
struct priv *priv = unit->data; |
||||||
|
|
||||||
|
// de-init peripherals
|
||||||
|
if (unit->status == E_SUCCESS ) { |
||||||
|
LL_DAC_DeInit(DAC); |
||||||
|
hw_periph_clock_disable(DAC1); |
||||||
|
} |
||||||
|
|
||||||
|
// Release all resources, deinit pins
|
||||||
|
rsc_teardown(unit); |
||||||
|
|
||||||
|
// Free memory
|
||||||
|
free_ck(unit->data); |
||||||
|
} |
@ -0,0 +1,73 @@ |
|||||||
|
//
|
||||||
|
// Created by MightyPork on 2018/02/03.
|
||||||
|
//
|
||||||
|
|
||||||
|
#ifndef GEX_F072_DAC_INTERNAL_H |
||||||
|
#define GEX_F072_DAC_INTERNAL_H |
||||||
|
|
||||||
|
#ifndef DAC_INTERNAL |
||||||
|
#error bad include! |
||||||
|
#endif |
||||||
|
|
||||||
|
#include "unit_base.h" |
||||||
|
|
||||||
|
enum UDAC_Noise { |
||||||
|
NOISE_NONE = 0b00, |
||||||
|
NOISE_WHITE = 0b01, |
||||||
|
NOISE_TRIANGLE = 0b10, |
||||||
|
}; |
||||||
|
|
||||||
|
struct udac_channel_cfg { |
||||||
|
bool enable; |
||||||
|
bool buffered; |
||||||
|
enum UDAC_Noise noise_type; |
||||||
|
uint8_t noise_level; // 0-11
|
||||||
|
}; |
||||||
|
|
||||||
|
struct udac_channel_live { |
||||||
|
enum UDAC_Noise noise_type; |
||||||
|
uint8_t noise_level; // 0-11
|
||||||
|
}; |
||||||
|
|
||||||
|
/** Private data structure */ |
||||||
|
struct priv { |
||||||
|
// settings
|
||||||
|
struct { |
||||||
|
struct udac_channel_cfg ch1; |
||||||
|
struct udac_channel_cfg ch2; |
||||||
|
} cfg; |
||||||
|
|
||||||
|
// internal state
|
||||||
|
struct udac_channel_live ch1; |
||||||
|
struct udac_channel_live ch2; |
||||||
|
TIM_TypeDef *TIMx; // timer used for the DDS function
|
||||||
|
}; |
||||||
|
|
||||||
|
/** Allocate data structure and set defaults */ |
||||||
|
error_t UDAC_preInit(Unit *unit); |
||||||
|
|
||||||
|
/** Load from a binary buffer stored in Flash */ |
||||||
|
void UDAC_loadBinary(Unit *unit, PayloadParser *pp); |
||||||
|
|
||||||
|
/** Write to a binary buffer for storing in Flash */ |
||||||
|
void UDAC_writeBinary(Unit *unit, PayloadBuilder *pb); |
||||||
|
|
||||||
|
// ------------------------------------------------------------------------
|
||||||
|
|
||||||
|
/** Parse a key-value pair from the INI file */ |
||||||
|
error_t UDAC_loadIni(Unit *unit, const char *key, const char *value); |
||||||
|
|
||||||
|
/** Generate INI file section for the unit */ |
||||||
|
void UDAC_writeIni(Unit *unit, IniWriter *iw); |
||||||
|
|
||||||
|
// ------------------------------------------------------------------------
|
||||||
|
|
||||||
|
/** Finalize unit set-up */ |
||||||
|
error_t UDAC_init(Unit *unit); |
||||||
|
|
||||||
|
/** Tear down the unit */ |
||||||
|
void UDAC_deInit(Unit *unit); |
||||||
|
|
||||||
|
void UDAC_Reconfigure(Unit *unit); |
||||||
|
|
||||||
|
#endif //GEX_F072_DAC_INTERNAL_H
|
@ -0,0 +1,131 @@ |
|||||||
|
//
|
||||||
|
// Created by MightyPork on 2018/02/03.
|
||||||
|
//
|
||||||
|
|
||||||
|
#include "platform.h" |
||||||
|
#include "unit_base.h" |
||||||
|
|
||||||
|
#define DAC_INTERNAL |
||||||
|
#include "_dac_internal.h" |
||||||
|
|
||||||
|
/** Load from a binary buffer stored in Flash */ |
||||||
|
void UDAC_loadBinary(Unit *unit, PayloadParser *pp) |
||||||
|
{ |
||||||
|
struct priv *priv = unit->data; |
||||||
|
|
||||||
|
uint8_t version = pp_u8(pp); |
||||||
|
(void)version; |
||||||
|
|
||||||
|
priv->cfg.ch1.enable = pp_bool(pp); |
||||||
|
priv->cfg.ch1.buffered = pp_bool(pp); |
||||||
|
priv->cfg.ch1.noise_type = (enum UDAC_Noise) pp_u8(pp); |
||||||
|
priv->cfg.ch1.noise_level = pp_u8(pp); |
||||||
|
|
||||||
|
priv->cfg.ch2.enable = pp_bool(pp); |
||||||
|
priv->cfg.ch2.buffered = pp_bool(pp); |
||||||
|
priv->cfg.ch2.noise_type = (enum UDAC_Noise) pp_u8(pp); |
||||||
|
priv->cfg.ch2.noise_level = pp_u8(pp); |
||||||
|
} |
||||||
|
|
||||||
|
/** Write to a binary buffer for storing in Flash */ |
||||||
|
void UDAC_writeBinary(Unit *unit, PayloadBuilder *pb) |
||||||
|
{ |
||||||
|
struct priv *priv = unit->data; |
||||||
|
|
||||||
|
pb_u8(pb, 0); // version
|
||||||
|
|
||||||
|
pb_bool(pb, priv->cfg.ch1.enable); |
||||||
|
pb_bool(pb, priv->cfg.ch1.buffered); |
||||||
|
pb_u8(pb, priv->cfg.ch1.noise_type); |
||||||
|
pb_u8(pb, priv->cfg.ch1.noise_level); |
||||||
|
|
||||||
|
pb_bool(pb, priv->cfg.ch2.enable); |
||||||
|
pb_bool(pb, priv->cfg.ch2.buffered); |
||||||
|
pb_u8(pb, priv->cfg.ch2.noise_type); |
||||||
|
pb_u8(pb, priv->cfg.ch2.noise_level); |
||||||
|
} |
||||||
|
|
||||||
|
// ------------------------------------------------------------------------
|
||||||
|
|
||||||
|
/** Parse a key-value pair from the INI file */ |
||||||
|
error_t UDAC_loadIni(Unit *unit, const char *key, const char *value) |
||||||
|
{ |
||||||
|
bool suc = true; |
||||||
|
struct priv *priv = unit->data; |
||||||
|
|
||||||
|
// Ch1
|
||||||
|
if (streq(key, "ch1_enable")) { |
||||||
|
priv->cfg.ch1.enable = cfg_bool_parse(value, &suc); |
||||||
|
} |
||||||
|
else if (streq(key, "ch1_buff")) { |
||||||
|
priv->cfg.ch1.buffered = cfg_bool_parse(value, &suc); |
||||||
|
} |
||||||
|
else if (streq(key, "ch1_noise")) { |
||||||
|
priv->cfg.ch1.noise_type = |
||||||
|
(enum UDAC_Noise) cfg_enum3_parse(value, |
||||||
|
"NONE", NOISE_NONE, |
||||||
|
"WHITE", NOISE_WHITE, |
||||||
|
"TRIANGLE", NOISE_TRIANGLE, &suc); |
||||||
|
} |
||||||
|
else if (streq(key, "ch1_noise-level")) { |
||||||
|
uint8_t x = cfg_u8_parse(value, &suc); |
||||||
|
if (x == 0) x = 1; |
||||||
|
if (x > 12) x = 12; |
||||||
|
priv->cfg.ch1.noise_level = (uint8_t) (x - 1); |
||||||
|
} |
||||||
|
// Ch2
|
||||||
|
else if (streq(key, "ch2_enable")) { |
||||||
|
priv->cfg.ch2.enable = cfg_bool_parse(value, &suc); |
||||||
|
} |
||||||
|
else if (streq(key, "ch2_buff")) { |
||||||
|
priv->cfg.ch2.buffered = cfg_bool_parse(value, &suc); |
||||||
|
} |
||||||
|
else if (streq(key, "ch2_noise")) { |
||||||
|
priv->cfg.ch2.noise_type = |
||||||
|
(enum UDAC_Noise) cfg_enum3_parse(value, |
||||||
|
"NONE", NOISE_NONE, |
||||||
|
"WHITE", NOISE_WHITE, |
||||||
|
"TRIANGLE", NOISE_TRIANGLE, &suc); |
||||||
|
} |
||||||
|
else if (streq(key, "ch2_noise-level")) { |
||||||
|
uint8_t x = cfg_u8_parse(value, &suc); |
||||||
|
if (x == 0) x = 1; |
||||||
|
if (x > 12) x = 12; |
||||||
|
priv->cfg.ch2.noise_level = (uint8_t) (x - 1); |
||||||
|
} |
||||||
|
// end
|
||||||
|
else { |
||||||
|
return E_BAD_KEY; |
||||||
|
} |
||||||
|
|
||||||
|
if (!suc) return E_BAD_VALUE; |
||||||
|
return E_SUCCESS; |
||||||
|
} |
||||||
|
|
||||||
|
/** Generate INI file section for the unit */ |
||||||
|
void UDAC_writeIni(Unit *unit, IniWriter *iw) |
||||||
|
{ |
||||||
|
struct priv *priv = unit->data; |
||||||
|
|
||||||
|
iw_comment(iw, "Enabled channels (1:A4, 2:A5)"); |
||||||
|
iw_entry_s(iw, "ch1_enable", str_yn(priv->cfg.ch1.enable)); |
||||||
|
iw_entry_s(iw, "ch2_enable", str_yn(priv->cfg.ch2.enable)); |
||||||
|
|
||||||
|
iw_comment(iw, "Output buffering"); |
||||||
|
iw_entry_s(iw, "ch1_buff", str_yn(priv->cfg.ch1.buffered)); |
||||||
|
iw_entry_s(iw, "ch2_buff", str_yn(priv->cfg.ch2.buffered)); |
||||||
|
|
||||||
|
iw_comment(iw, "Superimposed noise type (NONE,WHITE,TRIANGLE)"); |
||||||
|
iw_entry_s(iw, "ch1_noise", cfg_enum3_encode(priv->cfg.ch1.noise_type, |
||||||
|
NOISE_NONE, "NONE", |
||||||
|
NOISE_WHITE, "WHITE", |
||||||
|
NOISE_TRIANGLE, "TRIANGLE")); |
||||||
|
iw_entry_s(iw, "ch2_noise", cfg_enum3_encode(priv->cfg.ch2.noise_type, |
||||||
|
NOISE_NONE, "NONE", |
||||||
|
NOISE_WHITE, "WHITE", |
||||||
|
NOISE_TRIANGLE, "TRIANGLE")); |
||||||
|
|
||||||
|
iw_comment(iw, "Noise amplitude (nbr. of bits,1-12)"); |
||||||
|
iw_entry_d(iw, "ch1_noise-level", priv->cfg.ch1.noise_level + 1); |
||||||
|
iw_entry_d(iw, "ch2_noise-level", priv->cfg.ch2.noise_level + 1); |
||||||
|
} |
@ -0,0 +1,59 @@ |
|||||||
|
//
|
||||||
|
// Created by MightyPork on 2017/11/25.
|
||||||
|
//
|
||||||
|
|
||||||
|
#include "unit_base.h" |
||||||
|
#include "unit_dac.h" |
||||||
|
|
||||||
|
#define DAC_INTERNAL |
||||||
|
#include "_dac_internal.h" |
||||||
|
|
||||||
|
// ------------------------------------------------------------------------
|
||||||
|
|
||||||
|
enum DacCmd_ { |
||||||
|
CMD_SET_LEVEL, |
||||||
|
}; |
||||||
|
|
||||||
|
/** Handle a request message */ |
||||||
|
static error_t UDAC_handleRequest(Unit *unit, TF_ID frame_id, uint8_t command, |
||||||
|
PayloadParser *pp) |
||||||
|
{ |
||||||
|
switch (command) { |
||||||
|
case CMD_SET_LEVEL: { |
||||||
|
uint16_t ch1 = pp_u16(pp); |
||||||
|
uint16_t ch2 = pp_u16(pp); |
||||||
|
uint32_t dual_reg = DAC->DHR12RD; |
||||||
|
if (ch1 != 0xFFFF) { |
||||||
|
dual_reg = (dual_reg & 0xFFFF0000) | ch1; |
||||||
|
} |
||||||
|
if (ch2 != 0xFFFF) { |
||||||
|
dual_reg = (dual_reg & 0xFFFF) | (ch2<<16); |
||||||
|
} |
||||||
|
DAC->DHR12RD = dual_reg; |
||||||
|
// Trigger a conversion
|
||||||
|
DAC->SWTRIGR = (DAC_SWTR_CH1 | DAC_SWTR_CH2); |
||||||
|
return E_SUCCESS; |
||||||
|
} |
||||||
|
default: |
||||||
|
return E_UNKNOWN_COMMAND; |
||||||
|
} |
||||||
|
} |
||||||
|
|
||||||
|
// ------------------------------------------------------------------------
|
||||||
|
|
||||||
|
/** Unit template */ |
||||||
|
const UnitDriver UNIT_DAC = { |
||||||
|
.name = "DAC", |
||||||
|
.description = "Analog output", |
||||||
|
// Settings
|
||||||
|
.preInit = UDAC_preInit, |
||||||
|
.cfgLoadBinary = UDAC_loadBinary, |
||||||
|
.cfgWriteBinary = UDAC_writeBinary, |
||||||
|
.cfgLoadIni = UDAC_loadIni, |
||||||
|
.cfgWriteIni = UDAC_writeIni, |
||||||
|
// Init
|
||||||
|
.init = UDAC_init, |
||||||
|
.deInit = UDAC_deInit, |
||||||
|
// Function
|
||||||
|
.handleRequest = UDAC_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_DAC_H |
||||||
|
#define U_DAC_H |
||||||
|
|
||||||
|
#include "unit.h" |
||||||
|
|
||||||
|
extern const UnitDriver UNIT_DAC; |
||||||
|
|
||||||
|
// UU_ prototypes
|
||||||
|
|
||||||
|
#endif //U_DAC_H
|
Loading…
Reference in new issue