sm_io/chips/*: add new si57x get_freq ()

f95982ad · Lucas Russo · 84b2c397 · f95982ad · f95982ad
Commit f95982ad authored Apr 26, 2016 by Lucas Russo
Hide whitespace changes
Inline Side-by-side

Showing with 20 additions and 0 deletions

sm_ch_si57x.h include/sm_ch_si57x.h +2 -0

sm_ch_si57x.c src/sm_io/chips/sm_ch_si57x.c +18 -0

No files found.
--- a/include/sm_ch_si57x.h
+++ b/include/sm_ch_si57x.h
@@ -41,6 +41,8 @@ smch_err_e smch_si57x_get_defaults (smch_si57x_t *self, double fout);

 /* Setup new frequency */
 smch_err_e smch_si57x_set_freq (smch_si57x_t *self, double frequency);
+/* Get current frequency */
+smch_err_e smch_si57x_get_freq (smch_si57x_t *self, double *freq);

 #ifdef __cplusplus
 }

--- a/src/sm_io/chips/sm_ch_si57x.c
+++ b/src/sm_io/chips/sm_ch_si57x.c
@@ -200,6 +200,24 @@ err_exit:
    return err;
 }

+smch_err_e smch_si57x_get_freq (smch_si57x_t *self, double *freq)
+{
+    assert (self);
+    assert (freq);
+    smch_err_e err = SMCH_SUCCESS;
+    double frequency = 0;
+
+    DBE_DEBUG (DBG_SM_CH | DBG_LVL_TRACE, "[sm_ch:si57x_set_freq] Getting current "
+            "frequency\n");
+
+    /* rfreq is usually a large value. So we divide it first */
+    frequency = (double) self->rfreq / (self->hs_div * self->n1);
+    frequency *= self->fxtal;
+
+    *freq = frequency;
+    return err;
+}
+
 /***************** Static functions *****************/

 static smch_err_e _smch_si57x_write_8 (smch_si57x_t *self, uint8_t addr,