Skip to content
Projects
Groups
Snippets
Help
Loading...
Sign in
Toggle navigation
F
FMC ADC 100M 14b 4cha - Software
Project
Project
Details
Activity
Cycle Analytics
Repository
Repository
Files
Commits
Branches
Tags
Contributors
Graph
Compare
Charts
Issues
1
Issues
1
List
Board
Labels
Milestones
Merge Requests
0
Merge Requests
0
Wiki
Wiki
image/svg+xml
Discourse
Discourse
Members
Members
Collapse sidebar
Close sidebar
Activity
Graph
Charts
Create a new issue
Commits
Issue Boards
Open sidebar
Projects
FMC ADC 100M 14b 4cha - Software
Commits
59f4ed1e
Commit
59f4ed1e
authored
Aug 06, 2020
by
Federico Vaga
Browse files
Options
Browse Files
Download
Email Patches
Plain Diff
drv: re-order code to better handle DAC gain periodic update
Signed-off-by:
Federico Vaga
<
federico.vaga@cern.ch
>
parent
4cd5d639
Hide whitespace changes
Inline
Side-by-side
Showing
4 changed files
with
138 additions
and
118 deletions
+138
-118
fa-calibration.c
kernel/fa-calibration.c
+120
-11
fa-core.c
kernel/fa-core.c
+4
-93
fa-zio-drv.c
kernel/fa-zio-drv.c
+12
-12
fmc-adc-100m14b4cha.h
kernel/fmc-adc-100m14b4cha.h
+2
-2
No files found.
kernel/fa-calibration.c
View file @
59f4ed1e
...
...
@@ -94,10 +94,16 @@ static int fa_calib_adc_gain_fix(int range, int gain_c, int32_t delta_temp)
return
gain_c
-
error
;
}
static
int
fa_calib_adc_gain_fix
(
struct
fa_dev
*
fa
,
int
range
,
int
gain
,
uint32_t
temperature
)
/**
* Compute the correct gain
* @range: voltage range
* @gain_c: calibration value
* @delta_temp: temperature difference: (current temp. - calibration temp.)
* the unit must be milli-degree
*/
static
int
fa_calib_dac_gain_fix
(
int
range
,
int
gain_c
,
int32_t
delta_temp
)
{
return
gain
;
return
gain_c
;
}
static
void
fa_calib_adc_config_chan
(
struct
fa_dev
*
fa
,
unsigned
int
chan
,
...
...
@@ -117,21 +123,125 @@ static void fa_calib_adc_config_chan(struct fa_dev *fa, unsigned int chan,
fa_calib_offset_set
(
fa
,
chan
,
offset
);
}
int
fa_calib_adc_config
(
struct
fa_dev
*
fa
)
/**
* It sets the DAC voltage to apply an offset on the input channel
* @fa ADC device
* @chan channel number
* @val DAC values (-5V: 0x0000, 0V: 0x8000, +5V: 0x7FFF)
*
* Return: 0 on success, otherwise a negative error number
*/
static
int
fa_dac_offset_set
(
struct
fa_dev
*
fa
,
unsigned
int
chan
,
uint32_t
val
)
{
return
fa_spi_xfer
(
fa
,
FA_SPI_SS_DAC
(
chan
),
16
,
val
,
NULL
);
}
static
int64_t
fa_dac_offset_raw_get
(
int32_t
offset
)
{
int64_t
hwval
;
hwval
=
offset
*
0x8000LL
/
5000000
;
if
(
hwval
==
0x8000
)
hwval
=
0x7fff
;
/* -32768 .. 32767 */
return
hwval
;
}
static
int64_t
fa_dac_offset_raw_calibrate
(
int32_t
raw_offset
,
int
gain
,
int
offset
)
{
int64_t
hwval
;
hwval
=
((
raw_offset
+
offset
)
*
gain
)
>>
15
;
/* signed */
hwval
+=
0x8000
;
/* offset binary */
if
(
hwval
<
0
)
hwval
=
0
;
if
(
hwval
>
0xffff
)
hwval
=
0xffff
;
return
hwval
;
}
#define DAC_SAT_LOW -5000000
#define DAC_SAT_UP 5000000
static
int
fa_dac_offset_get
(
struct
fa_dev
*
fa
,
unsigned
int
chan
)
{
int32_t
off_uv
=
fa
->
user_offset
[
chan
]
+
fa
->
zero_offset
[
chan
];
if
(
off_uv
<
DAC_SAT_LOW
)
{
dev_warn
(
&
fa
->
pdev
->
dev
,
"DAC lower saturation %d
\n
"
,
DAC_SAT_LOW
);
off_uv
=
DAC_SAT_LOW
;
}
if
(
off_uv
>
DAC_SAT_UP
)
{
dev_warn
(
&
fa
->
pdev
->
dev
,
"DAC upper saturation %d
\n
"
,
DAC_SAT_UP
);
off_uv
=
DAC_SAT_UP
;
}
return
off_uv
;
}
static
int
fa_calib_dac_config_chan
(
struct
fa_dev
*
fa
,
unsigned
int
chan
,
uint32_t
temperature
)
{
int
range
=
fa
->
range
[
chan
];
int32_t
off_uv
=
fa_dac_offset_get
(
fa
,
chan
);
int32_t
off_uv_raw
=
fa_dac_offset_raw_get
(
off_uv
);
struct
fa_calib_stanza
*
cal
=
&
fa
->
calib
.
dac
[
range
];
int32_t
delta_temp
=
temperature
-
cal
->
temperature
;
int
offset
=
cal
->
offset
[
chan
];
int
gain
=
fa_calib_dac_gain_fix
(
range
,
cal
->
gain
[
chan
],
delta_temp
);
int
hwval
;
hwval
=
fa_dac_offset_raw_calibrate
(
off_uv_raw
,
gain
,
offset
);
return
fa_dac_offset_set
(
fa
,
chan
,
hwval
);
}
void
fa_calib_dac_config
(
struct
fa_dev
*
fa
,
uint32_t
temperature
)
{
int
i
;
uint32_t
temperature
;
temperature
=
fa_temperature_read
(
fa
);
dev_dbg
(
&
fa
->
pdev
->
dev
,
"%s: {temperature: %d}
\n
"
,
__func__
,
temperature
);
if
(
temperature
==
0xFFFFFFFF
)
temperature
=
fa_temperature_read
(
fa
);
dev_dbg
(
&
fa
->
pdev
->
dev
,
"%s: {temperature: %d}
\n
"
,
__func__
,
temperature
);
spin_lock
(
&
fa
->
zdev
->
cset
->
lock
);
for
(
i
=
0
;
i
<
FA100M14B4C_NCHAN
;
++
i
)
fa_calib_dac_config_chan
(
fa
,
i
,
temperature
);
spin_unlock
(
&
fa
->
zdev
->
cset
->
lock
);
}
static
void
fa_calib_adc_config
(
struct
fa_dev
*
fa
,
uint32_t
temperature
)
{
int
err
;
int
i
;
if
(
temperature
==
0xFFFFFFFF
)
temperature
=
fa_temperature_read
(
fa
);
dev_dbg
(
&
fa
->
pdev
->
dev
,
"%s: {temperature: %d}
\n
"
,
__func__
,
temperature
);
spin_lock
(
&
fa
->
zdev
->
cset
->
lock
);
for
(
i
=
0
;
i
<
FA100M14B4C_NCHAN
;
++
i
)
fa_calib_adc_config_chan
(
fa
,
i
,
temperature
);
spin_unlock
(
&
fa
->
zdev
->
cset
->
lock
);
return
fa_calib_apply
(
fa
);
err
=
fa_calib_apply
(
fa
);
if
(
err
)
dev_err
(
&
fa
->
pdev
->
dev
,
"Can't apply calibration values
\n
"
);
}
void
fa_calib_config
(
struct
fa_dev
*
fa
)
{
uint32_t
temperature
;
temperature
=
fa_temperature_read
(
fa
);
fa_calib_adc_config
(
fa
,
temperature
);
fa_calib_dac_config
(
fa
,
temperature
);
}
/**
* Periodically update gain calibration values
* @fa: FMC ADC device
...
...
@@ -145,7 +255,7 @@ static void fa_calib_gain_update(unsigned long arg)
{
struct
fa_dev
*
fa
=
(
void
*
)
arg
;
fa_calib_
adc_
config
(
fa
);
fa_calib_config
(
fa
);
mod_timer
(
&
fa
->
calib_timer
,
jiffies
+
HZ
*
fa_calib_period_s
);
}
...
...
@@ -251,7 +361,6 @@ static void fa_apply_calib(struct fa_dev *fa)
int
range
=
fa_readl
(
fa
,
fa
->
fa_adc_csr_base
,
&
zfad_regs
[
reg
]);
zfad_set_range
(
fa
,
chan
,
zfad_convert_hw_range
(
range
));
zfad_apply_offset
(
chan
);
}
}
...
...
@@ -334,7 +443,7 @@ int fa_calib_init(struct fa_dev *fa)
fa_calib_write
(
fa
,
&
calib
);
/* Prepare the timely recalibration */
fa_calib_
adc_
config
(
fa
);
fa_calib_config
(
fa
);
setup_timer
(
&
fa
->
calib_timer
,
fa_calib_gain_update
,
(
unsigned
long
)
fa
);
if
(
fa_calib_period_s
)
mod_timer
(
&
fa
->
calib_timer
,
jiffies
+
HZ
*
fa_calib_period_s
);
...
...
kernel/fa-core.c
View file @
59f4ed1e
...
...
@@ -144,95 +144,6 @@ int zfad_pattern_data_enable(struct fa_dev *fa, uint16_t pattern,
return
0
;
}
/**
* It sets the DAC voltage to apply an offset on the input channel
* @fa ADC device
* @chan channel number
* @val DAC values (-5V: 0x0000, 0V: 0x8000, +5V: 0x7FFF)
*
* Return: 0 on success, otherwise a negative error number
*/
static
int
fa_dac_offset_set
(
struct
fa_dev
*
fa
,
unsigned
int
chan
,
uint32_t
val
)
{
return
fa_spi_xfer
(
fa
,
FA_SPI_SS_DAC
(
chan
),
16
,
val
,
NULL
);
}
static
int64_t
fa_dac_offset_raw_get
(
int32_t
offset
)
{
int64_t
hwval
;
hwval
=
offset
*
0x8000LL
/
5000000
;
if
(
hwval
==
0x8000
)
hwval
=
0x7fff
;
/* -32768 .. 32767 */
return
hwval
;
}
static
int64_t
fa_dac_offset_raw_calibrate
(
int32_t
raw_offset
,
int
gain
,
int
offset
)
{
int64_t
hwval
;
hwval
=
((
raw_offset
+
offset
)
*
gain
)
>>
15
;
/* signed */
hwval
+=
0x8000
;
/* offset binary */
if
(
hwval
<
0
)
hwval
=
0
;
if
(
hwval
>
0xffff
)
hwval
=
0xffff
;
return
hwval
;
}
#define DAC_SAT_LOW -5000000
#define DAC_SAT_UP 5000000
static
int
fa_dac_offset_get
(
struct
fa_dev
*
fa
,
unsigned
int
chan
)
{
int32_t
off_uv
=
fa
->
user_offset
[
chan
]
+
fa
->
zero_offset
[
chan
];
if
(
off_uv
<
DAC_SAT_LOW
)
{
dev_warn
(
&
fa
->
pdev
->
dev
,
"DAC lower saturation %d
\n
"
,
DAC_SAT_LOW
);
off_uv
=
DAC_SAT_LOW
;
}
if
(
off_uv
>
DAC_SAT_UP
)
{
dev_warn
(
&
fa
->
pdev
->
dev
,
"DAC upper saturation %d
\n
"
,
DAC_SAT_UP
);
off_uv
=
DAC_SAT_UP
;
}
return
off_uv
;
}
/*
* zfad_apply_user_offset
* @chan: the channel where apply offset
*
* Apply user offset to the channel input. Before apply the user offset it must
* be corrected with offset and gain calibration value.
*
* Offset values are taken from `struct fa_dev`, so they must be there before
* calling this function
*/
int
zfad_apply_offset
(
struct
zio_channel
*
chan
)
{
struct
fa_dev
*
fa
=
get_zfadc
(
&
chan
->
cset
->
zdev
->
head
.
dev
);
int32_t
off_uv
=
fa_dac_offset_get
(
fa
,
chan
->
index
);
int32_t
off_uv_raw
=
fa_dac_offset_raw_get
(
off_uv
);
struct
fa_calib_stanza
*
cal
;
int
hwval
;
int
range
;
spin_lock
(
&
fa
->
zdev
->
cset
->
lock
);
range
=
fa
->
range
[
chan
->
index
];
spin_unlock
(
&
fa
->
zdev
->
cset
->
lock
);
cal
=
&
fa
->
calib
.
dac
[
range
];
hwval
=
fa_dac_offset_raw_calibrate
(
off_uv_raw
,
cal
->
gain
[
chan
->
index
],
cal
->
offset
[
chan
->
index
]);
return
fa_dac_offset_set
(
fa
,
chan
->
index
,
hwval
);
}
/*
* zfad_reset_offset
* @fa: the fmc-adc descriptor
...
...
@@ -246,8 +157,8 @@ void zfad_reset_offset(struct fa_dev *fa)
for
(
i
=
0
;
i
<
FA100M14B4C_NCHAN
;
++
i
)
{
fa
->
user_offset
[
i
]
=
0
;
fa
->
zero_offset
[
i
]
=
0
;
zfad_apply_offset
(
&
fa
->
zdev
->
cset
->
chan
[
i
]);
}
fa_calib_dac_config
(
fa
,
~
0
);
}
/*
...
...
@@ -297,9 +208,9 @@ int zfad_set_range(struct fa_dev *fa, struct zio_channel *chan,
spin_lock
(
&
fa
->
zdev
->
cset
->
lock
);
fa
->
range
[
chan
->
index
]
=
range
;
spin_unlock
(
&
fa
->
zdev
->
cset
->
lock
);
/* recalculate user offset for the new range */
zfad_apply_offset
(
chan
);
return
fa_calib_adc_config
(
fa
)
;
fa_calib_config
(
fa
);
return
0
;
}
/*
...
...
kernel/fa-zio-drv.c
View file @
59f4ed1e
...
...
@@ -204,10 +204,10 @@ static int zfad_conf_set(struct device *dev, struct zio_attribute *zattr,
i
--
;
chan
=
to_zio_cset
(
dev
)
->
chan
+
i
;
spin_lock
(
&
fa
->
zdev
->
cset
->
lock
);
fa
->
zero_offset
[
i
]
=
usr_val
;
err
=
zfad_apply_offset
(
chan
);
if
(
err
==
-
EIO
)
fa
->
zero_offset
[
chan
->
index
]
=
0
;
spin_unlock
(
&
fa
->
zdev
->
cset
->
lock
);
fa_calib_dac_config
(
fa
,
~
0
);
return
err
;
case
ZFA_CHx_SAT
:
/* TODO when TLV */
...
...
@@ -237,18 +237,18 @@ static int zfad_conf_set(struct device *dev, struct zio_attribute *zattr,
i
--
;
chan
=
to_zio_cset
(
dev
)
->
chan
+
i
;
spin_lock
(
&
fa
->
zdev
->
cset
->
lock
);
fa
->
user_offset
[
chan
->
index
]
=
usr_val
;
err
=
zfad_apply_offset
(
chan
);
if
(
err
==
-
EIO
)
fa
->
user_offset
[
chan
->
index
]
=
0
;
return
err
;
spin_unlock
(
&
fa
->
zdev
->
cset
->
lock
);
fa_calib_dac_config
(
fa
,
~
0
);
return
0
;
case
ZFA_CHx_OFFSET
:
chan
=
to_zio_chan
(
dev
),
chan
=
to_zio_chan
(
dev
);
spin_lock
(
&
fa
->
zdev
->
cset
->
lock
);
fa
->
user_offset
[
chan
->
index
]
=
usr_val
;
err
=
zfad_apply_offset
(
chan
);
if
(
err
==
-
EIO
)
fa
->
user_offset
[
chan
->
index
]
=
0
;
return
err
;
spin_unlock
(
&
fa
->
zdev
->
cset
->
lock
);
fa_calib_dac_config
(
fa
,
~
0
);
return
0
;
case
ZFA_CTL_DAC_CLR_N
:
zfad_reset_offset
(
fa
);
return
0
;
...
...
kernel/fmc-adc-100m14b4cha.h
View file @
59f4ed1e
...
...
@@ -600,7 +600,6 @@ extern const struct zfa_field_desc zfad_regs[];
/* Functions exported by fa-core.c */
extern
int
zfad_fsm_command
(
struct
fa_dev
*
fa
,
uint32_t
command
);
extern
int
zfad_apply_offset
(
struct
zio_channel
*
chan
);
extern
void
zfad_reset_offset
(
struct
fa_dev
*
fa
);
extern
int
zfad_convert_hw_range
(
uint32_t
bitmask
);
extern
uint32_t
fa_temperature_read
(
struct
fa_dev
*
fa
);
...
...
@@ -643,7 +642,8 @@ extern void fa_spi_exit(struct fa_dev *fd);
/* function exporetd by fa-calibration.c */
extern
int
fa_calib_init
(
struct
fa_dev
*
fa
);
extern
void
fa_calib_exit
(
struct
fa_dev
*
fa
);
extern
int
fa_calib_adc_config
(
struct
fa_dev
*
fa
);
extern
void
fa_calib_config
(
struct
fa_dev
*
fa
);
extern
void
fa_calib_dac_config
(
struct
fa_dev
*
fa
,
uint32_t
temperature
);
/* functions exported by fa-debug.c */
extern
int
fa_debug_init
(
struct
fa_dev
*
fa
);
...
...
Write
Preview
Markdown
is supported
0%
Try again
or
attach a new file
Attach a file
Cancel
You are about to add
0
people
to the discussion. Proceed with caution.
Finish editing this message first!
Cancel
Please
register
or
sign in
to comment