Commit 0a416f20 authored by Federico Vaga's avatar Federico Vaga

drv: don't do anything if test data is not enabled

Signed-off-by: Federico Vaga's avatarFederico Vaga <federico.vaga@cern.ch>
parent 8f269c14
......@@ -538,6 +538,11 @@ void ft_test_data(struct fmctdc_dev *ft,
{
uint32_t tmp = 0;
ft_writel(ft, 0, TDC_REG_FAKE_TS_CSR);
if (!enable)
return;
if (chan >= ft->zdev->n_cset) {
dev_err(&ft->fmc->dev, "%s Invalid channel %d\n",
__func__, chan);
......@@ -550,15 +555,14 @@ void ft_test_data(struct fmctdc_dev *ft,
return;
}
tmp |= (enable ? TDC_FAKE_TS_EN : 0);
tmp |= TDC_FAKE_TS_EN;
tmp |= ((chan << TDC_FAKE_TS_CHAN_SHIFT) & TDC_FAKE_TS_CHAN_MASK);
tmp |= ((period << TDC_FAKE_TS_PERIOD_SHIFT) & TDC_FAKE_TS_PERIOD_MASK);
ft_writel(ft, tmp, TDC_REG_FAKE_TS_CSR);
if (enable)
dev_warn(&ft->fmc->dev,
"Channel 0 is running in test mode 0x%x\n",
tmp);
dev_warn(&ft->fmc->dev,
"Channel 0 is running in test mode 0x%x\n",
tmp);
}
/* probe and remove are called by the FMC bus core */
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment