int32_t dds_set_scale(dac_core *core,
uint32_t chan,
int32_t scale_micro_units)
{
uint32_t pcore_version;
uint32_t scale_reg;
dac_read(core, DAC_REG_VERSION, &pcore_version);
// only ise projects support binary shift scaling, if you think you need
// this supported in this driver, let us know.
if (DAC_PCORE_VERSION_MAJOR(pcore_version) < 6)
{
printf("%s ERROR: Sorry, binary scale is NOT supported!\n", __func__);
return(-1);
}
scale_reg = scale_micro_units;
if (scale_micro_units < 0)
scale_reg = scale_micro_units * -1;
if (scale_reg >= 1999000)
scale_reg = 1999000;
scale_reg = (uint32_t)(((uint64_t)scale_reg * 0x4000) / 1000000);
if (scale_micro_units < 0)
scale_reg = scale_reg | 0x8000;
dac_write(core, DAC_REG_SYNC_CONTROL, 0);
dac_write(core, DAC_REG_DDS_SCALE(chan), DAC_DDS_SCALE(scale_reg));
dac_write(core, DAC_REG_SYNC_CONTROL, DAC_SYNC);
return(0);
}
/***************************************************************************//**
* @brief dds_set_phase
*******************************************************************************/
void dds_set_scale(struct ad9361_rf_phy *phy, uint32_t chan, int32_t scale_micro_units)
{
uint32_t scale_reg;
uint32_t sign_part;
uint32_t int_part;
uint32_t fract_part;
if (PCORE_VERSION_MAJOR(dds_st[phy->id_no].pcore_version) > 6)
{
if(scale_micro_units >= 1000000)
{
sign_part = 0;
int_part = 1;
fract_part = 0;
dds_st[phy->id_no].cached_scale[chan] = 1000000;
goto set_scale_reg;
}
if(scale_micro_units <= -1000000)
{
sign_part = 1;
int_part = 1;
fract_part = 0;
dds_st[phy->id_no].cached_scale[chan] = -1000000;
goto set_scale_reg;
}
dds_st[phy->id_no].cached_scale[chan] = scale_micro_units;
if(scale_micro_units < 0)
{
sign_part = 1;
int_part = 0;
scale_micro_units *= -1;
}
else
{
sign_part = 0;
int_part = 0;
}
fract_part = (uint32_t)(((uint64_t)scale_micro_units * 0x4000) / 1000000);
set_scale_reg:
scale_reg = (sign_part << 15) | (int_part << 14) | fract_part;
}
else
{
if(scale_micro_units >= 1000000)
{
scale_reg = 0;
scale_micro_units = 1000000;
}
if(scale_micro_units <= 0)
{
scale_reg = 0;
scale_micro_units = 0;
}
dds_st[phy->id_no].cached_scale[chan] = scale_micro_units;
fract_part = (uint32_t)(scale_micro_units);
scale_reg = 500000 / fract_part;
}
dac_stop(phy);
dac_write(phy, DAC_REG_CHAN_CNTRL_1_IIOCHAN(chan), DAC_DDS_SCALE(scale_reg));
dac_start_sync(phy, 0);
}
/***************************************************************************//**
* @brief dds_set_scale
*******************************************************************************/
int32_t dds_set_scale(uint32_t chan, int32_t scale_micro_units)
{
uint32_t pcore_version;
uint32_t scale_reg;
uint32_t sign_part;
uint32_t int_part;
uint32_t fract_part;
dac_read(DAC_REG_VERSION, &pcore_version);
if(DAC_PCORE_VERSION_MAJOR(pcore_version) > 6)
{
if(scale_micro_units >= 1000000)
{
sign_part = 0;
int_part = 1;
fract_part = 0;
goto set_scale_reg;
}
if(scale_micro_units <= -1000000)
{
sign_part = 1;
int_part = 1;
fract_part = 0;
goto set_scale_reg;
}
if(scale_micro_units < 0)
{
sign_part = 1;
int_part = 0;
scale_micro_units *= -1;
}
else
{
sign_part = 0;
int_part = 0;
}
fract_part = (uint32_t)(((uint64_t)scale_micro_units * 0x4000) / 1000000);
set_scale_reg:
scale_reg = (sign_part << 15) | (int_part << 14) | fract_part;
}
else
{
if(scale_micro_units >= 1000000)
{
scale_reg = 0;
scale_micro_units = 1000000;
}
if(scale_micro_units <= 0)
{
scale_reg = 0;
scale_micro_units = 0;
}
fract_part = (uint32_t)(scale_micro_units);
scale_reg = 500000 / fract_part;
}
if(DAC_PCORE_VERSION_MAJOR(pcore_version) < 8)
{
dac_write(DAC_REG_CNTRL_1, 0);
}
dac_write(DAC_REG_CHAN_CNTRL_1_IIOCHAN(chan), DAC_DDS_SCALE(scale_reg));
if(DAC_PCORE_VERSION_MAJOR(pcore_version) < 8)
{
dac_write(DAC_REG_CNTRL_1, DAC_ENABLE);
}
else
{
dac_write(DAC_REG_CNTRL_1, DAC_SYNC);
}
return 0;
}
