From: Luis Garcia <g...@luigi311.com>

Use the v4l2_link_freq_to_bitmap() helper to figure out which
driver-supported link freq can be used on a given system.

Signed-off-by: Luis Garcia <g...@luigi311.com>
Reviewed-by: Pavel Machek <pa...@ucw.cz>
---
 drivers/media/i2c/imx258.c | 12 ++++++++++++
 1 file changed, 12 insertions(+)

diff --git a/drivers/media/i2c/imx258.c b/drivers/media/i2c/imx258.c
index 5de71cb7c1ae..65846dff775e 100644
--- a/drivers/media/i2c/imx258.c
+++ b/drivers/media/i2c/imx258.c
@@ -693,6 +693,7 @@ struct imx258 {
        /* Current mode */
        const struct imx258_mode *cur_mode;
 
+       unsigned long link_freq_bitmap;
        const struct imx258_link_freq_config *link_freq_configs;
        const s64 *link_freq_menu_items;
        unsigned int lane_mode_idx;
@@ -1552,6 +1553,17 @@ static int imx258_probe(struct i2c_client *client)
                return ret;
        }
 
+       ret = v4l2_link_freq_to_bitmap(&client->dev,
+                                      ep.link_frequencies,
+                                      ep.nr_of_link_frequencies,
+                                      imx258->link_freq_menu_items,
+                                      ARRAY_SIZE(link_freq_menu_items_19_2),
+                                      &imx258->link_freq_bitmap);
+       if (ret) {
+               dev_err(&client->dev, "Link frequency not supported\n");
+               goto error_endpoint_free;
+       }
+
        /* Get number of data lanes */
        switch (ep.bus.mipi_csi2.num_data_lanes) {
        case 2:
-- 
2.44.0


Reply via email to