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, ...@@ -538,6 +538,11 @@ void ft_test_data(struct fmctdc_dev *ft,
{ {
uint32_t tmp = 0; uint32_t tmp = 0;
ft_writel(ft, 0, TDC_REG_FAKE_TS_CSR);
if (!enable)
return;
if (chan >= ft->zdev->n_cset) { if (chan >= ft->zdev->n_cset) {
dev_err(&ft->fmc->dev, "%s Invalid channel %d\n", dev_err(&ft->fmc->dev, "%s Invalid channel %d\n",
__func__, chan); __func__, chan);
...@@ -550,15 +555,14 @@ void ft_test_data(struct fmctdc_dev *ft, ...@@ -550,15 +555,14 @@ void ft_test_data(struct fmctdc_dev *ft,
return; 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 |= ((chan << TDC_FAKE_TS_CHAN_SHIFT) & TDC_FAKE_TS_CHAN_MASK);
tmp |= ((period << TDC_FAKE_TS_PERIOD_SHIFT) & TDC_FAKE_TS_PERIOD_MASK); tmp |= ((period << TDC_FAKE_TS_PERIOD_SHIFT) & TDC_FAKE_TS_PERIOD_MASK);
ft_writel(ft, tmp, TDC_REG_FAKE_TS_CSR); ft_writel(ft, tmp, TDC_REG_FAKE_TS_CSR);
if (enable) dev_warn(&ft->fmc->dev,
dev_warn(&ft->fmc->dev, "Channel 0 is running in test mode 0x%x\n",
"Channel 0 is running in test mode 0x%x\n", tmp);
tmp);
} }
/* probe and remove are called by the FMC bus core */ /* 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