parent
f1b8db78d4
commit
8643d16989
GPG Key ID:
2C5FD5035250423D
@ -0,0 +1,161 @@ |
|||||||
|
//
|
||||||
|
// Created by MightyPork on 2018/02/03.
|
||||||
|
//
|
||||||
|
|
||||||
|
#include "platform.h" |
||||||
|
#include "unit_base.h" |
||||||
|
|
||||||
|
#define I2C_INTERNAL |
||||||
|
#include "_i2c_internal.h" |
||||||
|
#include "_i2c_init.h" |
||||||
|
|
||||||
|
|
||||||
|
/** Allocate data structure and set defaults */ |
||||||
|
error_t UI2C_preInit(Unit *unit) |
||||||
|
{ |
||||||
|
struct priv *priv = unit->data = calloc_ck(1, sizeof(struct priv)); |
||||||
|
if (priv == NULL) return E_OUT_OF_MEM; |
||||||
|
|
||||||
|
// some defaults
|
||||||
|
priv->periph_num = 1; |
||||||
|
priv->speed = 1; |
||||||
|
priv->anf = true; |
||||||
|
priv->dnf = 0; |
||||||
|
|
||||||
|
return E_SUCCESS; |
||||||
|
} |
||||||
|
|
||||||
|
/** Finalize unit set-up */ |
||||||
|
error_t UI2C_init(Unit *unit) |
||||||
|
{ |
||||||
|
bool suc = true; |
||||||
|
struct priv *priv = unit->data; |
||||||
|
|
||||||
|
if (!(priv->periph_num >= 1 && priv->periph_num <= 2)) { |
||||||
|
dbg("!! Bad I2C periph"); // TODO report
|
||||||
|
return E_BAD_CONFIG; |
||||||
|
} |
||||||
|
|
||||||
|
if (!(priv->speed >= 1 && priv->speed <= 3)) { |
||||||
|
dbg("!! Bad I2C speed"); |
||||||
|
return E_BAD_CONFIG; |
||||||
|
} |
||||||
|
|
||||||
|
if (priv->dnf > 15) { |
||||||
|
dbg("!! Bad I2C DNF bw"); |
||||||
|
return E_BAD_CONFIG; |
||||||
|
} |
||||||
|
|
||||||
|
// assign and claim the peripheral
|
||||||
|
if (priv->periph_num == 1) { |
||||||
|
TRY(rsc_claim(unit, R_I2C1)); |
||||||
|
priv->periph = I2C1; |
||||||
|
} else { |
||||||
|
TRY(rsc_claim(unit, R_I2C2)); |
||||||
|
priv->periph = I2C2; |
||||||
|
} |
||||||
|
|
||||||
|
// This is written for F072, other platforms will need adjustments
|
||||||
|
|
||||||
|
char portname; |
||||||
|
uint8_t pin_scl; |
||||||
|
uint8_t pin_sda; |
||||||
|
uint32_t af_i2c; |
||||||
|
uint32_t timing; // magic constant from CubeMX
|
||||||
|
|
||||||
|
#if GEX_PLAT_F072_DISCOVERY |
||||||
|
// scl - 6 or 8 for I2C1, 10 for I2C2
|
||||||
|
// sda - 7 or 9 for I2C1, 11 for I2C2
|
||||||
|
if (priv->periph_num == 1) { |
||||||
|
// I2C1
|
||||||
|
if (priv->remap == 0) { |
||||||
|
af_i2c = LL_GPIO_AF_1; |
||||||
|
portname = 'B'; |
||||||
|
pin_scl = 6; |
||||||
|
pin_sda = 7; |
||||||
|
} else if (priv->remap == 1) { |
||||||
|
af_i2c = LL_GPIO_AF_1; |
||||||
|
portname = 'B'; |
||||||
|
pin_scl = 8; |
||||||
|
pin_sda = 9; |
||||||
|
} else { |
||||||
|
return E_BAD_CONFIG; |
||||||
|
} |
||||||
|
} else { |
||||||
|
// I2C2
|
||||||
|
if (priv->remap == 0) { |
||||||
|
af_i2c = LL_GPIO_AF_1; |
||||||
|
portname = 'B'; |
||||||
|
pin_scl = 10; |
||||||
|
pin_sda = 11; |
||||||
|
} else if (priv->remap == 1) { |
||||||
|
af_i2c = LL_GPIO_AF_5; |
||||||
|
portname = 'B'; |
||||||
|
pin_scl = 13; |
||||||
|
pin_sda = 14; |
||||||
|
} else { |
||||||
|
return E_BAD_CONFIG; |
||||||
|
} |
||||||
|
} |
||||||
|
|
||||||
|
if (priv->speed == 1) |
||||||
|
timing = 0x00301D2B; // Standard
|
||||||
|
else if (priv->speed == 2) |
||||||
|
timing = 0x0000020B; // Fast
|
||||||
|
else |
||||||
|
timing = 0x00000001; // Fast+
|
||||||
|
|
||||||
|
#elif GEX_PLAT_F103_BLUEPILL |
||||||
|
#error "NO IMPL" |
||||||
|
#elif GEX_PLAT_F303_DISCOVERY |
||||||
|
#error "NO IMPL" |
||||||
|
#elif GEX_PLAT_F407_DISCOVERY |
||||||
|
#error "NO IMPL" |
||||||
|
#else |
||||||
|
#error "BAD PLATFORM!" |
||||||
|
#endif |
||||||
|
|
||||||
|
// first, we have to claim the pins
|
||||||
|
TRY(rsc_claim_pin(unit, portname, pin_sda)); |
||||||
|
TRY(rsc_claim_pin(unit, portname, pin_scl)); |
||||||
|
|
||||||
|
hw_configure_gpio_af(portname, pin_sda, af_i2c); |
||||||
|
hw_configure_gpio_af(portname, pin_scl, af_i2c); |
||||||
|
|
||||||
|
hw_periph_clock_enable(priv->periph); |
||||||
|
|
||||||
|
/* Disable the selected I2Cx Peripheral */ |
||||||
|
LL_I2C_Disable(priv->periph); |
||||||
|
LL_I2C_ConfigFilters(priv->periph, |
||||||
|
(priv->anf ? LL_I2C_ANALOGFILTER_ENABLE : LL_I2C_ANALOGFILTER_DISABLE), |
||||||
|
priv->dnf); |
||||||
|
|
||||||
|
LL_I2C_SetTiming(priv->periph, timing); |
||||||
|
//LL_I2C_DisableClockStretching(priv->periph);
|
||||||
|
LL_I2C_Enable(priv->periph); |
||||||
|
|
||||||
|
LL_I2C_DisableOwnAddress1(priv->periph); // OA not used
|
||||||
|
LL_I2C_SetMode(priv->periph, LL_I2C_MODE_I2C); // not using SMBus
|
||||||
|
|
||||||
|
return E_SUCCESS; |
||||||
|
} |
||||||
|
|
||||||
|
/** Tear down the unit */ |
||||||
|
void UI2C_deInit(Unit *unit) |
||||||
|
{ |
||||||
|
struct priv *priv = unit->data; |
||||||
|
|
||||||
|
// de-init the pins & peripheral only if inited correctly
|
||||||
|
if (unit->status == E_SUCCESS) { |
||||||
|
assert_param(priv->periph); |
||||||
|
LL_I2C_DeInit(priv->periph); |
||||||
|
|
||||||
|
hw_periph_clock_disable(priv->periph); |
||||||
|
} |
||||||
|
|
||||||
|
// Release all resources
|
||||||
|
rsc_teardown(unit); |
||||||
|
|
||||||
|
// Free memory
|
||||||
|
free_ck(unit->data); |
||||||
|
} |
||||||
@ -0,0 +1,24 @@ |
|||||||
|
//
|
||||||
|
// Created by MightyPork on 2018/02/03.
|
||||||
|
//
|
||||||
|
|
||||||
|
#ifndef GEX_F072_I2C_INIT_H |
||||||
|
#define GEX_F072_I2C_INIT_H |
||||||
|
|
||||||
|
#ifndef I2C_INTERNAL |
||||||
|
#error bad include! |
||||||
|
#endif |
||||||
|
|
||||||
|
#include "unit_base.h" |
||||||
|
|
||||||
|
/** Allocate data structure and set defaults */ |
||||||
|
error_t UI2C_preInit(Unit *unit); |
||||||
|
|
||||||
|
/** Finalize unit set-up */ |
||||||
|
error_t UI2C_init(Unit *unit); |
||||||
|
|
||||||
|
/** Tear down the unit */ |
||||||
|
void UI2C_deInit(Unit *unit); |
||||||
|
|
||||||
|
|
||||||
|
#endif //GEX_F072_I2C_INIT_H
|
||||||
@ -0,0 +1,107 @@ |
|||||||
|
//
|
||||||
|
// Created by MightyPork on 2018/02/03.
|
||||||
|
//
|
||||||
|
|
||||||
|
#include "platform.h" |
||||||
|
#include "unit_base.h" |
||||||
|
|
||||||
|
#define I2C_INTERNAL |
||||||
|
#include "_i2c_internal.h" |
||||||
|
#include "_i2c_settings.h" |
||||||
|
|
||||||
|
/** Load from a binary buffer stored in Flash */ |
||||||
|
void UI2C_loadBinary(Unit *unit, PayloadParser *pp) |
||||||
|
{ |
||||||
|
struct priv *priv = unit->data; |
||||||
|
|
||||||
|
uint8_t version = pp_u8(pp); |
||||||
|
(void)version; |
||||||
|
|
||||||
|
priv->periph_num = pp_u8(pp); |
||||||
|
priv->anf = pp_bool(pp); |
||||||
|
priv->dnf = pp_u8(pp); |
||||||
|
priv->speed = pp_u8(pp); |
||||||
|
|
||||||
|
if (version >= 1) { |
||||||
|
priv->remap = pp_u8(pp); |
||||||
|
} |
||||||
|
} |
||||||
|
|
||||||
|
/** Write to a binary buffer for storing in Flash */ |
||||||
|
void UI2C_writeBinary(Unit *unit, PayloadBuilder *pb) |
||||||
|
{ |
||||||
|
struct priv *priv = unit->data; |
||||||
|
|
||||||
|
pb_u8(pb, 1); // version
|
||||||
|
|
||||||
|
pb_u8(pb, priv->periph_num); |
||||||
|
pb_bool(pb, priv->anf); |
||||||
|
pb_u8(pb, priv->dnf); |
||||||
|
pb_u8(pb, priv->speed); |
||||||
|
pb_u8(pb, priv->remap); |
||||||
|
} |
||||||
|
|
||||||
|
// ------------------------------------------------------------------------
|
||||||
|
|
||||||
|
/** Parse a key-value pair from the INI file */ |
||||||
|
error_t UI2C_loadIni(Unit *unit, const char *key, const char *value) |
||||||
|
{ |
||||||
|
bool suc = true; |
||||||
|
struct priv *priv = unit->data; |
||||||
|
|
||||||
|
if (streq(key, "device")) { |
||||||
|
priv->periph_num = (uint8_t) avr_atoi(value); |
||||||
|
} |
||||||
|
else if (streq(key, "remap")) { |
||||||
|
priv->remap = (uint8_t) avr_atoi(value); |
||||||
|
} |
||||||
|
else if (streq(key, "analog-filter")) { |
||||||
|
priv->anf = str_parse_yn(value, &suc); |
||||||
|
} |
||||||
|
else if (streq(key, "digital-filter")) { |
||||||
|
priv->dnf = (uint8_t) avr_atoi(value); |
||||||
|
} |
||||||
|
else if (streq(key, "speed")) { |
||||||
|
priv->speed = (uint8_t) avr_atoi(value); |
||||||
|
} |
||||||
|
else { |
||||||
|
return E_BAD_KEY; |
||||||
|
} |
||||||
|
|
||||||
|
if (!suc) return E_BAD_VALUE; |
||||||
|
return E_SUCCESS; |
||||||
|
} |
||||||
|
|
||||||
|
/** Generate INI file section for the unit */ |
||||||
|
void UI2C_writeIni(Unit *unit, IniWriter *iw) |
||||||
|
{ |
||||||
|
struct priv *priv = unit->data; |
||||||
|
|
||||||
|
iw_comment(iw, "Peripheral number (I2Cx)"); |
||||||
|
iw_entry(iw, "device", "%d", (int)priv->periph_num); |
||||||
|
|
||||||
|
iw_comment(iw, "Pin mappings (SCL,SDA)"); |
||||||
|
#if GEX_PLAT_F072_DISCOVERY |
||||||
|
iw_comment(iw, " I2C1: (0) B6,B7 (1) B8,B9"); |
||||||
|
iw_comment(iw, " I2C2: (0) B10,B11 (1) B13,B14"); |
||||||
|
#elif GEX_PLAT_F103_BLUEPILL |
||||||
|
#error "NO IMPL" |
||||||
|
#elif GEX_PLAT_F303_DISCOVERY |
||||||
|
#error "NO IMPL" |
||||||
|
#elif GEX_PLAT_F407_DISCOVERY |
||||||
|
#error "NO IMPL" |
||||||
|
#else |
||||||
|
#error "BAD PLATFORM!" |
||||||
|
#endif |
||||||
|
iw_entry(iw, "remap", "%d", (int)priv->remap); |
||||||
|
|
||||||
|
iw_cmt_newline(iw); |
||||||
|
iw_comment(iw, "Speed: 1-Standard, 2-Fast, 3-Fast+"); |
||||||
|
iw_entry(iw, "speed", "%d", (int)priv->speed); |
||||||
|
|
||||||
|
iw_comment(iw, "Analog noise filter enable (Y,N)"); |
||||||
|
iw_entry(iw, "analog-filter", "%s", str_yn(priv->anf)); |
||||||
|
|
||||||
|
iw_comment(iw, "Digital noise filter bandwidth (0-15)"); |
||||||
|
iw_entry(iw, "digital-filter", "%d", (int)priv->dnf); |
||||||
|
} |
||||||
@ -0,0 +1,28 @@ |
|||||||
|
//
|
||||||
|
// Created by MightyPork on 2018/02/03.
|
||||||
|
//
|
||||||
|
|
||||||
|
#ifndef GEX_F072_I2C_SETTINGS_H |
||||||
|
#define GEX_F072_I2C_SETTINGS_H |
||||||
|
|
||||||
|
#ifndef I2C_INTERNAL |
||||||
|
#error bad include! |
||||||
|
#endif |
||||||
|
|
||||||
|
#include "unit_base.h" |
||||||
|
|
||||||
|
/** Load from a binary buffer stored in Flash */ |
||||||
|
void UI2C_loadBinary(Unit *unit, PayloadParser *pp); |
||||||
|
|
||||||
|
/** Write to a binary buffer for storing in Flash */ |
||||||
|
void UI2C_writeBinary(Unit *unit, PayloadBuilder *pb); |
||||||
|
|
||||||
|
// ------------------------------------------------------------------------
|
||||||
|
|
||||||
|
/** Parse a key-value pair from the INI file */ |
||||||
|
error_t UI2C_loadIni(Unit *unit, const char *key, const char *value); |
||||||
|
|
||||||
|
/** Generate INI file section for the unit */ |
||||||
|
void UI2C_writeIni(Unit *unit, IniWriter *iw); |
||||||
|
|
||||||
|
#endif //GEX_F072_I2C_SETTINGS_H
|
||||||
Loading…
Reference in new issue