From: Rodrigo Alencar <[email protected]>

Add DRG channels with destination selection (frequency, phase, or
amplitude) based on attribute writes, dwell mode control,
configurable upper/lower limits, increment/decrement step sizes, and
step rate settings.

Signed-off-by: Rodrigo Alencar <[email protected]>
---
 drivers/iio/frequency/ad9910.c | 425 ++++++++++++++++++++++++++++++++++++++++-
 1 file changed, 423 insertions(+), 2 deletions(-)

diff --git a/drivers/iio/frequency/ad9910.c b/drivers/iio/frequency/ad9910.c
index 5b4076028a29..c9ec677cd63a 100644
--- a/drivers/iio/frequency/ad9910.c
+++ b/drivers/iio/frequency/ad9910.c
@@ -132,6 +132,18 @@
 #define AD9910_MC_SYNC_OUTPUT_DELAY_MSK                GENMASK(15, 11)
 #define AD9910_MC_SYNC_INPUT_DELAY_MSK         GENMASK(7, 3)
 
+/* Digital Ramp Limit Register */
+#define AD9910_DRG_LIMIT_UPPER_MSK             GENMASK_ULL(63, 32)
+#define AD9910_DRG_LIMIT_LOWER_MSK             GENMASK_ULL(31, 0)
+
+/* Digital Ramp Step Register */
+#define AD9910_DRG_STEP_DEC_MSK                        GENMASK_ULL(63, 32)
+#define AD9910_DRG_STEP_INC_MSK                        GENMASK_ULL(31, 0)
+
+/* Digital Ramp Rate Register */
+#define AD9910_DRG_RATE_DEC_MSK                        GENMASK(31, 16)
+#define AD9910_DRG_RATE_INC_MSK                        GENMASK(15, 0)
+
 /* Profile Register Format (Single Tone Mode) */
 #define AD9910_PROFILE_ST_ASF_MSK              GENMASK_ULL(61, 48)
 #define AD9910_PROFILE_ST_POW_MSK              GENMASK_ULL(47, 32)
@@ -147,6 +159,7 @@
 #define AD9910_ASF_PP_LSB_MAX          GENMASK(5, 0)
 #define AD9910_POW_MAX                 GENMASK(15, 0)
 #define AD9910_POW_PP_LSB_MAX          GENMASK(7, 0)
+#define AD9910_STEP_RATE_MAX           GENMASK(15, 0)
 #define AD9910_NUM_PROFILES            8
 
 /* PLL constants */
@@ -198,6 +211,9 @@
  * @AD9910_CHANNEL_PROFILE_6: Profile 6 output channel
  * @AD9910_CHANNEL_PROFILE_7: Profile 7 output channel
  * @AD9910_CHANNEL_PARALLEL_PORT: Parallel port output channel
+ * @AD9910_CHANNEL_DRG: Digital Ramp Generator output channel
+ * @AD9910_CHANNEL_DRG_RAMP_UP: DRG ramp up channel
+ * @AD9910_CHANNEL_DRG_RAMP_DOWN: DRG ramp down channel
  */
 enum ad9910_channel {
        AD9910_CHANNEL_PHY = 100,
@@ -210,6 +226,24 @@ enum ad9910_channel {
        AD9910_CHANNEL_PROFILE_6 = 107,
        AD9910_CHANNEL_PROFILE_7 = 108,
        AD9910_CHANNEL_PARALLEL_PORT = 110,
+       AD9910_CHANNEL_DRG = 120,
+       AD9910_CHANNEL_DRG_RAMP_UP = 121,
+       AD9910_CHANNEL_DRG_RAMP_DOWN = 122,
+};
+
+/**
+ * enum ad9910_destination - AD9910 DDS core parameter destination
+ *
+ * @AD9910_DEST_FREQUENCY: Frequency destination
+ * @AD9910_DEST_PHASE: Phase destination
+ * @AD9910_DEST_AMPLITUDE: Amplitude destination
+ * @AD9910_DEST_POLAR: Polar destination
+ */
+enum ad9910_destination {
+       AD9910_DEST_FREQUENCY,
+       AD9910_DEST_PHASE,
+       AD9910_DEST_AMPLITUDE,
+       AD9910_DEST_POLAR,
 };
 
 enum {
@@ -236,6 +270,9 @@ enum {
        AD9910_PP_FREQ_OFFSET,
        AD9910_PP_PHASE_OFFSET,
        AD9910_PP_AMP_OFFSET,
+       AD9910_DRG_FREQ_STEP,
+       AD9910_DRG_PHASE_STEP,
+       AD9910_DRG_AMP_STEP,
 };
 
 struct ad9910_data {
@@ -475,6 +512,16 @@ static int ad9910_powerdown_set(struct ad9910_state *st, 
bool enable)
        return gpiod_set_value_cansleep(st->gpio_pwdown, enable);
 }
 
+static inline int ad9910_drg_destination_set(struct ad9910_state *st,
+                                            enum ad9910_destination dest,
+                                            bool update)
+{
+       return ad9910_reg32_update(st, AD9910_REG_CFR2,
+                                  AD9910_CFR2_DRG_DEST_MSK,
+                                  FIELD_PREP(AD9910_CFR2_DRG_DEST_MSK, dest),
+                                  update);
+}
+
 static ssize_t ad9910_ext_info_read(struct iio_dev *indio_dev,
                                    uintptr_t private,
                                    const struct iio_chan_spec *chan,
@@ -638,6 +685,140 @@ static ssize_t ad9910_pp_attrs_write(struct iio_dev 
*indio_dev,
        return ret ?: len;
 }
 
+static ssize_t ad9910_drg_attrs_read(struct iio_dev *indio_dev,
+                                    uintptr_t private,
+                                    const struct iio_chan_spec *chan,
+                                    char *buf)
+{
+       struct ad9910_state *st = iio_priv(indio_dev);
+       unsigned int type;
+       int vals[2];
+       u64 tmp64;
+
+       guard(mutex)(&st->lock);
+
+       switch (chan->channel) {
+       case AD9910_CHANNEL_DRG_RAMP_UP:
+               tmp64 = FIELD_GET(AD9910_DRG_STEP_INC_MSK,
+                                 st->reg[AD9910_REG_DRG_STEP].val64);
+               break;
+       case AD9910_CHANNEL_DRG_RAMP_DOWN:
+               tmp64 = FIELD_GET(AD9910_DRG_STEP_DEC_MSK,
+                                 st->reg[AD9910_REG_DRG_STEP].val64);
+               break;
+       default:
+               return -EINVAL;
+       }
+
+       switch (private) {
+       case AD9910_DRG_FREQ_STEP:
+               type = IIO_VAL_INT_PLUS_MICRO;
+               tmp64 *= st->data.sysclk_freq_hz;
+               vals[0] = tmp64 >> 32;
+               vals[1] = ((tmp64 & GENMASK_ULL(31, 0)) * MICRO) >> 32;
+               break;
+       case AD9910_DRG_PHASE_STEP:
+               type = IIO_VAL_INT_PLUS_NANO;
+               tmp64 *= AD9910_PI_NANORAD;
+               tmp64 >>= 31;
+               vals[0] = div_u64_rem(tmp64, NANO, &vals[1]);
+               break;
+       case AD9910_DRG_AMP_STEP:
+               type = IIO_VAL_INT_PLUS_NANO;
+               vals[0] = 0;
+               vals[1] = tmp64 * NANO >> 32;
+               break;
+       default:
+               return -EINVAL;
+       }
+
+       return iio_format_value(buf, type, ARRAY_SIZE(vals), vals);
+}
+
+static ssize_t ad9910_drg_attrs_write(struct iio_dev *indio_dev,
+                                     uintptr_t private,
+                                     const struct iio_chan_spec *chan,
+                                     const char *buf, size_t len)
+{
+       struct ad9910_state *st = iio_priv(indio_dev);
+       enum ad9910_destination dest;
+       int val, val2;
+       u64 tmp64;
+       int ret;
+
+       guard(mutex)(&st->lock);
+
+       switch (private) {
+       case AD9910_DRG_FREQ_STEP:
+               ret = iio_str_to_fixpoint(buf, MICRO / 10, &val, &val2);
+               if (ret)
+                       return ret;
+
+               if (!in_range(val, 0, st->data.sysclk_freq_hz / 2))
+                       return -EINVAL;
+
+               tmp64 = (u64)val * MICRO + val2;
+               tmp64 = ad9910_rational_scale(tmp64, BIT_ULL(32),
+                                             (u64)MICRO * 
st->data.sysclk_freq_hz);
+               dest = AD9910_DEST_FREQUENCY;
+               break;
+       case AD9910_DRG_PHASE_STEP:
+               ret = iio_str_to_fixpoint(buf, NANO / 10, &val, &val2);
+               if (ret)
+                       return ret;
+
+               if (val < 0 || val2 < 0)
+                       return -EINVAL;
+
+               tmp64 = (u64)val * NANO + val2;
+               if (tmp64 > 2ULL * AD9910_PI_NANORAD)
+                       return -EINVAL;
+
+               tmp64 <<= 31;
+               tmp64 = DIV_U64_ROUND_CLOSEST(tmp64, AD9910_PI_NANORAD);
+               dest = AD9910_DEST_PHASE;
+               break;
+       case AD9910_DRG_AMP_STEP:
+               ret = iio_str_to_fixpoint(buf, NANO / 10, &val, &val2);
+               if (ret)
+                       return ret;
+
+               if (val < 0 || val > 1 || (val == 1 && val2 > 0))
+                       return -EINVAL;
+
+               tmp64 = ((u64)val * NANO + val2) << 32;
+               tmp64 = DIV_U64_ROUND_CLOSEST(tmp64, NANO);
+               dest = AD9910_DEST_AMPLITUDE;
+               break;
+       default:
+               return -EINVAL;
+       }
+
+       tmp64 = min(tmp64, U32_MAX);
+       ret = ad9910_drg_destination_set(st, dest, false);
+       if (ret)
+               return ret;
+
+       switch (chan->channel) {
+       case AD9910_CHANNEL_DRG_RAMP_UP:
+               ret = ad9910_reg64_update(st, AD9910_REG_DRG_STEP,
+                                         AD9910_DRG_STEP_INC_MSK,
+                                         FIELD_PREP(AD9910_DRG_STEP_INC_MSK, 
tmp64),
+                                         true);
+               break;
+       case AD9910_CHANNEL_DRG_RAMP_DOWN:
+               ret = ad9910_reg64_update(st, AD9910_REG_DRG_STEP,
+                                         AD9910_DRG_STEP_DEC_MSK,
+                                         FIELD_PREP(AD9910_DRG_STEP_DEC_MSK, 
tmp64),
+                                         true);
+               break;
+       default:
+               return -EINVAL;
+       }
+
+       return ret ?: len;
+}
+
 #define AD9910_EXT_INFO_TMPL(_name, _ident, _shared, _fn_desc) { \
        .name = _name, \
        .read = ad9910_ ## _fn_desc ## _read, \
@@ -652,6 +833,9 @@ static ssize_t ad9910_pp_attrs_write(struct iio_dev 
*indio_dev,
 #define AD9910_PP_EXT_INFO(_name, _ident) \
        AD9910_EXT_INFO_TMPL(_name, _ident, IIO_SEPARATE, pp_attrs)
 
+#define AD9910_DRG_EXT_INFO(_name, _ident) \
+       AD9910_EXT_INFO_TMPL(_name, _ident, IIO_SEPARATE, drg_attrs)
+
 static const struct iio_chan_spec_ext_info ad9910_phy_ext_info[] = {
        AD9910_EXT_INFO("powerdown", AD9910_POWERDOWN, IIO_SEPARATE),
        { }
@@ -665,6 +849,13 @@ static const struct iio_chan_spec_ext_info 
ad9910_pp_ext_info[] = {
        { }
 };
 
+static const struct iio_chan_spec_ext_info ad9910_drg_ramp_ext_info[] = {
+       AD9910_DRG_EXT_INFO("frequency_step", AD9910_DRG_FREQ_STEP),
+       AD9910_DRG_EXT_INFO("phase_step", AD9910_DRG_PHASE_STEP),
+       AD9910_DRG_EXT_INFO("scale_step", AD9910_DRG_AMP_STEP),
+       { }
+};
+
 #define AD9910_PROFILE_CHAN(idx) {                             \
        .type = IIO_ALTVOLTAGE,                                 \
        .indexed = 1,                                           \
@@ -706,6 +897,43 @@ static const struct iio_chan_spec ad9910_channels[] = {
                .info_mask_separate = BIT(IIO_CHAN_INFO_ENABLE),
                .ext_info = ad9910_pp_ext_info,
        },
+       [AD9910_CHAN_IDX_DRG] = {
+               .type = IIO_ALTVOLTAGE,
+               .indexed = 1,
+               .output = 1,
+               .channel = AD9910_CHANNEL_DRG,
+               .address = AD9910_CHAN_IDX_DRG,
+               .scan_index = -1,
+               .info_mask_separate = BIT(IIO_CHAN_INFO_ENABLE),
+       },
+       [AD9910_CHAN_IDX_DRG_RAMP_UP] = {
+               .type = IIO_ALTVOLTAGE,
+               .indexed = 1,
+               .output = 1,
+               .channel = AD9910_CHANNEL_DRG_RAMP_UP,
+               .address = AD9910_CHAN_IDX_DRG_RAMP_UP,
+               .scan_index = -1,
+               .info_mask_separate = BIT(IIO_CHAN_INFO_ENABLE) |
+                                     BIT(IIO_CHAN_INFO_FREQUENCY) |
+                                     BIT(IIO_CHAN_INFO_PHASE) |
+                                     BIT(IIO_CHAN_INFO_SCALE) |
+                                     BIT(IIO_CHAN_INFO_SAMP_FREQ),
+               .ext_info = ad9910_drg_ramp_ext_info,
+       },
+       [AD9910_CHAN_IDX_DRG_RAMP_DOWN] = {
+               .type = IIO_ALTVOLTAGE,
+               .indexed = 1,
+               .output = 1,
+               .channel = AD9910_CHANNEL_DRG_RAMP_DOWN,
+               .address = AD9910_CHAN_IDX_DRG_RAMP_DOWN,
+               .scan_index = -1,
+               .info_mask_separate = BIT(IIO_CHAN_INFO_ENABLE) |
+                                     BIT(IIO_CHAN_INFO_FREQUENCY) |
+                                     BIT(IIO_CHAN_INFO_PHASE) |
+                                     BIT(IIO_CHAN_INFO_SCALE) |
+                                     BIT(IIO_CHAN_INFO_SAMP_FREQ),
+               .ext_info = ad9910_drg_ramp_ext_info,
+       },
 };
 
 static int ad9910_read_raw(struct iio_dev *indio_dev,
@@ -729,6 +957,18 @@ static int ad9910_read_raw(struct iio_dev *indio_dev,
                        *val = FIELD_GET(AD9910_CFR2_PARALLEL_DATA_PORT_EN_MSK,
                                         st->reg[AD9910_REG_CFR2].val32);
                        break;
+               case AD9910_CHANNEL_DRG:
+                       *val = FIELD_GET(AD9910_CFR2_DRG_ENABLE_MSK,
+                                        st->reg[AD9910_REG_CFR2].val32);
+                       break;
+               case AD9910_CHANNEL_DRG_RAMP_UP:
+                       *val = FIELD_GET(AD9910_CFR2_DRG_NO_DWELL_HIGH_MSK,
+                                        st->reg[AD9910_REG_CFR2].val32);
+                       break;
+               case AD9910_CHANNEL_DRG_RAMP_DOWN:
+                       *val = FIELD_GET(AD9910_CFR2_DRG_NO_DWELL_LOW_MSK,
+                                        st->reg[AD9910_REG_CFR2].val32);
+                       break;
                default:
                        return -EINVAL;
                }
@@ -740,6 +980,14 @@ static int ad9910_read_raw(struct iio_dev *indio_dev,
                        tmp32 = FIELD_GET(AD9910_PROFILE_ST_FTW_MSK,
                                          
st->reg[AD9910_REG_PROFILE(tmp32)].val64);
                        break;
+               case AD9910_CHANNEL_DRG_RAMP_UP:
+                       tmp32 = FIELD_GET(AD9910_DRG_LIMIT_UPPER_MSK,
+                                         st->reg[AD9910_REG_DRG_LIMIT].val64);
+                       break;
+               case AD9910_CHANNEL_DRG_RAMP_DOWN:
+                       tmp32 = FIELD_GET(AD9910_DRG_LIMIT_LOWER_MSK,
+                                         st->reg[AD9910_REG_DRG_LIMIT].val64);
+                       break;
                default:
                        return -EINVAL;
                }
@@ -757,6 +1005,18 @@ static int ad9910_read_raw(struct iio_dev *indio_dev,
                        *val = tmp32 / MICRO;
                        *val2 = tmp32 % MICRO;
                        return IIO_VAL_INT_PLUS_MICRO;
+               case AD9910_CHANNEL_DRG_RAMP_UP:
+                       tmp64 = FIELD_GET(AD9910_DRG_LIMIT_UPPER_MSK,
+                                         st->reg[AD9910_REG_DRG_LIMIT].val64);
+                       tmp64 = (tmp64 * AD9910_PI_NANORAD) >> 31;
+                       *val = div_u64_rem(tmp64, NANO, val2);
+                       return IIO_VAL_INT_PLUS_NANO;
+               case AD9910_CHANNEL_DRG_RAMP_DOWN:
+                       tmp64 = FIELD_GET(AD9910_DRG_LIMIT_LOWER_MSK,
+                                         st->reg[AD9910_REG_DRG_LIMIT].val64);
+                       tmp64 = (tmp64 * AD9910_PI_NANORAD) >> 31;
+                       *val = div_u64_rem(tmp64, NANO, val2);
+                       return IIO_VAL_INT_PLUS_NANO;
                default:
                        return -EINVAL;
                }
@@ -769,6 +1029,18 @@ static int ad9910_read_raw(struct iio_dev *indio_dev,
                        *val = 0;
                        *val2 = tmp64 * MICRO >> 14;
                        return IIO_VAL_INT_PLUS_MICRO;
+               case AD9910_CHANNEL_DRG_RAMP_UP:
+                       tmp64 = FIELD_GET(AD9910_DRG_LIMIT_UPPER_MSK,
+                                         st->reg[AD9910_REG_DRG_LIMIT].val64);
+                       *val = 0;
+                       *val2 = tmp64 * NANO >> 32;
+                       return IIO_VAL_INT_PLUS_NANO;
+               case AD9910_CHANNEL_DRG_RAMP_DOWN:
+                       tmp64 = FIELD_GET(AD9910_DRG_LIMIT_LOWER_MSK,
+                                         st->reg[AD9910_REG_DRG_LIMIT].val64);
+                       *val = 0;
+                       *val2 = tmp64 * NANO >> 32;
+                       return IIO_VAL_INT_PLUS_NANO;
                default:
                        return -EINVAL;
                }
@@ -777,9 +1049,23 @@ static int ad9910_read_raw(struct iio_dev *indio_dev,
                case AD9910_CHANNEL_PHY:
                        *val = st->data.sysclk_freq_hz;
                        return IIO_VAL_INT;
+               case AD9910_CHANNEL_DRG_RAMP_UP:
+                       tmp32 = FIELD_GET(AD9910_DRG_RATE_INC_MSK,
+                                         st->reg[AD9910_REG_DRG_RATE].val32);
+                       break;
+               case AD9910_CHANNEL_DRG_RAMP_DOWN:
+                       tmp32 = FIELD_GET(AD9910_DRG_RATE_DEC_MSK,
+                                         st->reg[AD9910_REG_DRG_RATE].val32);
+                       break;
                default:
                        return -EINVAL;
                }
+               if (!tmp32)
+                       return -ERANGE;
+               tmp32 *= 4;
+               *val = st->data.sysclk_freq_hz / tmp32;
+               *val2 = div_u64((u64)(st->data.sysclk_freq_hz % tmp32) * MICRO, 
tmp32);
+               return IIO_VAL_INT_PLUS_MICRO;
        default:
                return -EINVAL;
        }
@@ -792,6 +1078,7 @@ static int ad9910_write_raw(struct iio_dev *indio_dev,
        struct ad9910_state *st = iio_priv(indio_dev);
        u64 tmp64;
        u32 tmp32;
+       int ret;
 
        guard(mutex)(&st->lock);
 
@@ -813,6 +1100,21 @@ static int ad9910_write_raw(struct iio_dev *indio_dev,
                        return ad9910_reg32_update(st, AD9910_REG_CFR2,
                                                   
AD9910_CFR2_PARALLEL_DATA_PORT_EN_MSK,
                                                   tmp32, true);
+               case AD9910_CHANNEL_DRG:
+                       tmp32 = FIELD_PREP(AD9910_CFR2_DRG_ENABLE_MSK, val);
+                       return ad9910_reg32_update(st, AD9910_REG_CFR2,
+                                                  AD9910_CFR2_DRG_ENABLE_MSK,
+                                                  tmp32, true);
+               case AD9910_CHANNEL_DRG_RAMP_UP:
+                       tmp32 = FIELD_PREP(AD9910_CFR2_DRG_NO_DWELL_HIGH_MSK, 
!!val);
+                       return ad9910_reg32_update(st, AD9910_REG_CFR2,
+                                                  
AD9910_CFR2_DRG_NO_DWELL_HIGH_MSK,
+                                                  tmp32, true);
+               case AD9910_CHANNEL_DRG_RAMP_DOWN:
+                       tmp32 = FIELD_PREP(AD9910_CFR2_DRG_NO_DWELL_LOW_MSK, 
!!val);
+                       return ad9910_reg32_update(st, AD9910_REG_CFR2,
+                                                  
AD9910_CFR2_DRG_NO_DWELL_LOW_MSK,
+                                                  tmp32, true);
                default:
                        return -EINVAL;
                }
@@ -830,6 +1132,28 @@ static int ad9910_write_raw(struct iio_dev *indio_dev,
                        return ad9910_reg64_update(st, 
AD9910_REG_PROFILE(tmp32),
                                                   AD9910_PROFILE_ST_FTW_MSK,
                                                   tmp64, true);
+               case AD9910_CHANNEL_DRG_RAMP_UP:
+                       ret = ad9910_drg_destination_set(st,
+                                                        AD9910_DEST_FREQUENCY,
+                                                        false);
+                       if (ret)
+                               return ret;
+
+                       tmp64 = FIELD_PREP(AD9910_DRG_LIMIT_UPPER_MSK, tmp64);
+                       return ad9910_reg64_update(st, AD9910_REG_DRG_LIMIT,
+                                                  AD9910_DRG_LIMIT_UPPER_MSK,
+                                                  tmp64, true);
+               case AD9910_CHANNEL_DRG_RAMP_DOWN:
+                       ret = ad9910_drg_destination_set(st,
+                                                        AD9910_DEST_FREQUENCY,
+                                                        false);
+                       if (ret)
+                               return ret;
+
+                       tmp64 = FIELD_PREP(AD9910_DRG_LIMIT_LOWER_MSK, tmp64);
+                       return ad9910_reg64_update(st, AD9910_REG_DRG_LIMIT,
+                                                  AD9910_DRG_LIMIT_LOWER_MSK,
+                                                  tmp64, true);
                default:
                        return -EINVAL;
                }
@@ -851,6 +1175,40 @@ static int ad9910_write_raw(struct iio_dev *indio_dev,
                        return ad9910_reg64_update(st, 
AD9910_REG_PROFILE(tmp32),
                                                   AD9910_PROFILE_ST_POW_MSK,
                                                   tmp64, true);
+               case AD9910_CHANNEL_DRG_RAMP_UP:
+                       tmp64 = (u64)val * NANO + val2;
+                       if (tmp64 > 2ULL * AD9910_PI_NANORAD)
+                               return -EINVAL;
+
+                       ret = ad9910_drg_destination_set(st, AD9910_DEST_PHASE,
+                                                        false);
+                       if (ret)
+                               return ret;
+
+                       tmp64 <<= 31;
+                       tmp64 = DIV_U64_ROUND_CLOSEST(tmp64, AD9910_PI_NANORAD);
+                       tmp64 = min(tmp64, U32_MAX);
+                       tmp64 = FIELD_PREP(AD9910_DRG_LIMIT_UPPER_MSK, tmp64);
+                       return ad9910_reg64_update(st, AD9910_REG_DRG_LIMIT,
+                                                  AD9910_DRG_LIMIT_UPPER_MSK,
+                                                  tmp64, true);
+               case AD9910_CHANNEL_DRG_RAMP_DOWN:
+                       tmp64 = (u64)val * NANO + val2;
+                       if (tmp64 > 2ULL * AD9910_PI_NANORAD)
+                               return -EINVAL;
+
+                       ret = ad9910_drg_destination_set(st, AD9910_DEST_PHASE,
+                                                        false);
+                       if (ret)
+                               return ret;
+
+                       tmp64 <<= 31;
+                       tmp64 = DIV_U64_ROUND_CLOSEST(tmp64, AD9910_PI_NANORAD);
+                       tmp64 = min(tmp64, U32_MAX);
+                       tmp64 = FIELD_PREP(AD9910_DRG_LIMIT_LOWER_MSK, tmp64);
+                       return ad9910_reg64_update(st, AD9910_REG_DRG_LIMIT,
+                                                  AD9910_DRG_LIMIT_LOWER_MSK,
+                                                  tmp64, true);
                default:
                        return -EINVAL;
                }
@@ -868,11 +1226,62 @@ static int ad9910_write_raw(struct iio_dev *indio_dev,
                        return ad9910_reg64_update(st, 
AD9910_REG_PROFILE(tmp32),
                                                   AD9910_PROFILE_ST_ASF_MSK,
                                                   tmp64, true);
+               case AD9910_CHANNEL_DRG_RAMP_UP:
+                       ret = ad9910_drg_destination_set(st,
+                                                        AD9910_DEST_AMPLITUDE,
+                                                        false);
+                       if (ret)
+                               return ret;
+
+                       tmp64 = ((u64)val * NANO + val2) << 32;
+                       tmp64 = DIV_U64_ROUND_CLOSEST(tmp64, NANO);
+                       tmp64 = min(tmp64, U32_MAX);
+                       tmp64 = FIELD_PREP(AD9910_DRG_LIMIT_UPPER_MSK, tmp64);
+                       return ad9910_reg64_update(st, AD9910_REG_DRG_LIMIT,
+                                                  AD9910_DRG_LIMIT_UPPER_MSK,
+                                                  tmp64, true);
+               case AD9910_CHANNEL_DRG_RAMP_DOWN:
+                       ret = ad9910_drg_destination_set(st,
+                                                        AD9910_DEST_AMPLITUDE,
+                                                        false);
+                       if (ret)
+                               return ret;
+
+                       tmp64 = ((u64)val * NANO + val2) << 32;
+                       tmp64 = DIV_U64_ROUND_CLOSEST(tmp64, NANO);
+                       tmp64 = min(tmp64, U32_MAX);
+                       tmp64 = FIELD_PREP(AD9910_DRG_LIMIT_LOWER_MSK, tmp64);
+                       return ad9910_reg64_update(st, AD9910_REG_DRG_LIMIT,
+                                                  AD9910_DRG_LIMIT_LOWER_MSK,
+                                                  tmp64, true);
                default:
                        return -EINVAL;
                }
        case IIO_CHAN_INFO_SAMP_FREQ:
-               return ad9910_set_sysclk_freq(st, val, true);
+               if (chan->channel == AD9910_CHANNEL_PHY)
+                       return ad9910_set_sysclk_freq(st, val, true);
+
+               tmp64 = ((u64)val * MICRO + val2) * 4;
+               if (!tmp64)
+                       return -EINVAL;
+
+               tmp64 = DIV64_U64_ROUND_CLOSEST((u64)st->data.sysclk_freq_hz * 
MICRO, tmp64);
+               tmp32 = clamp(tmp64, 1U, AD9910_STEP_RATE_MAX);
+
+               switch (chan->channel) {
+               case AD9910_CHANNEL_DRG_RAMP_UP:
+                       tmp32 = FIELD_PREP(AD9910_DRG_RATE_INC_MSK, tmp32);
+                       return ad9910_reg32_update(st, AD9910_REG_DRG_RATE,
+                                                  AD9910_DRG_RATE_INC_MSK,
+                                                  tmp32, true);
+               case AD9910_CHANNEL_DRG_RAMP_DOWN:
+                       tmp32 = FIELD_PREP(AD9910_DRG_RATE_DEC_MSK, tmp32);
+                       return ad9910_reg32_update(st, AD9910_REG_DRG_RATE,
+                                                  AD9910_DRG_RATE_DEC_MSK,
+                                                  tmp32, true);
+               default:
+                       return -EINVAL;
+               }
        default:
                return -EINVAL;
        }
@@ -892,11 +1301,16 @@ static int ad9910_write_raw_get_fmt(struct iio_dev 
*indio_dev,
                switch (chan->channel) {
                case AD9910_CHANNEL_PROFILE_0 ... AD9910_CHANNEL_PROFILE_7:
                        return IIO_VAL_INT_PLUS_MICRO;
+               case AD9910_CHANNEL_DRG_RAMP_UP:
+               case AD9910_CHANNEL_DRG_RAMP_DOWN:
+                       return IIO_VAL_INT_PLUS_NANO;
                default:
                        return -EINVAL;
                }
        case IIO_CHAN_INFO_SAMP_FREQ:
-               return IIO_VAL_INT;
+               if (chan->channel == AD9910_CHANNEL_PHY)
+                       return IIO_VAL_INT;
+               return IIO_VAL_INT_PLUS_MICRO;
        default:
                return -EINVAL;
        }
@@ -1075,6 +1489,13 @@ static int ad9910_setup(struct ad9910_state *st, struct 
reset_control *dev_rst)
        if (ret)
                return ret;
 
+       /* configure step rate with default values */
+       reg32 = FIELD_PREP(AD9910_DRG_RATE_DEC_MSK, 1) |
+               FIELD_PREP(AD9910_DRG_RATE_INC_MSK, 1);
+       ret = ad9910_reg32_write(st, AD9910_REG_DRG_RATE, reg32, false);
+       if (ret)
+               return ret;
+
        return ad9910_io_update(st);
 }
 

-- 
2.43.0



Reply via email to