Commit 5cfca891 authored by Rasmus Villemoes's avatar Rasmus Villemoes Committed by Li Yang

soc: fsl: qe: support fsl,qe-snums property

Add driver support for the newly introduced fsl,qe-snums property.

Conveniently, of_property_read_variable_u8_array does exactly what we
need: If the property fsl,qe-snums is found (and has an allowed size),
the array of values get copied to snums, and the return value is the
number of snums - we cannot assign directly to num_of_snums, since we
need to check whether the return value is negative.
Reviewed-by: default avatarChristophe Leroy <christophe.leroy@c-s.fr>
Reviewed-by: default avatarQiang Zhao <qiang.zhao@nxp.com>
Signed-off-by: default avatarRasmus Villemoes <rasmus.villemoes@prevas.dk>
Signed-off-by: default avatarLi Yang <leoyang.li@nxp.com>
parent 8f762fe5
...@@ -283,7 +283,6 @@ EXPORT_SYMBOL(qe_clock_source); ...@@ -283,7 +283,6 @@ EXPORT_SYMBOL(qe_clock_source);
*/ */
static void qe_snums_init(void) static void qe_snums_init(void)
{ {
int i;
static const u8 snum_init_76[] = { static const u8 snum_init_76[] = {
0x04, 0x05, 0x0C, 0x0D, 0x14, 0x15, 0x1C, 0x1D, 0x04, 0x05, 0x0C, 0x0D, 0x14, 0x15, 0x1C, 0x1D,
0x24, 0x25, 0x2C, 0x2D, 0x34, 0x35, 0x88, 0x89, 0x24, 0x25, 0x2C, 0x2D, 0x34, 0x35, 0x88, 0x89,
...@@ -304,7 +303,21 @@ static void qe_snums_init(void) ...@@ -304,7 +303,21 @@ static void qe_snums_init(void)
0x28, 0x29, 0x38, 0x39, 0x48, 0x49, 0x58, 0x59, 0x28, 0x29, 0x38, 0x39, 0x48, 0x49, 0x58, 0x59,
0x68, 0x69, 0x78, 0x79, 0x80, 0x81, 0x68, 0x69, 0x78, 0x79, 0x80, 0x81,
}; };
struct device_node *qe;
const u8 *snum_init; const u8 *snum_init;
int i;
bitmap_zero(snum_state, QE_NUM_OF_SNUM);
qe = qe_get_device_node();
if (qe) {
i = of_property_read_variable_u8_array(qe, "fsl,qe-snums",
snums, 1, QE_NUM_OF_SNUM);
of_node_put(qe);
if (i > 0) {
qe_num_of_snum = i;
return;
}
}
qe_num_of_snum = qe_get_num_of_snums(); qe_num_of_snum = qe_get_num_of_snums();
...@@ -313,7 +326,6 @@ static void qe_snums_init(void) ...@@ -313,7 +326,6 @@ static void qe_snums_init(void)
else else
snum_init = snum_init_46; snum_init = snum_init_46;
bitmap_zero(snum_state, QE_NUM_OF_SNUM);
memcpy(snums, snum_init, qe_num_of_snum); memcpy(snums, snum_init, qe_num_of_snum);
} }
......
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