The FLD_MOD function is an equivalent to what FIELD_MODIFY + GENMASK
provide, so let's drop it and switch to the latter.

Signed-off-by: Maxime Ripard <mrip...@kernel.org>
---
 drivers/gpu/drm/tidss/tidss_dispc.c | 36 ++++++++++++++----------------------
 1 file changed, 14 insertions(+), 22 deletions(-)

diff --git a/drivers/gpu/drm/tidss/tidss_dispc.c 
b/drivers/gpu/drm/tidss/tidss_dispc.c
index 
50d5eda0670e6e090d05af6a2c05e5b88f28c322..fef56aed3f6edb6630d079f354821ada5fad327d
 100644
--- a/drivers/gpu/drm/tidss/tidss_dispc.c
+++ b/drivers/gpu/drm/tidss/tidss_dispc.c
@@ -607,29 +607,21 @@ void tidss_disable_oldi(struct tidss_device *tidss, u32 
hw_videoport)
 /*
  * TRM gives bitfields as start:end, where start is the higher bit
  * number. For example 7:0
  */
 
-#define FLD_MOD(orig, val, start, end)                                 \
-       ({                                                              \
-               int _start = (start), _end = (end);                     \
-               u32 _masked_val = (orig) & ~GENMASK(_start, _end);      \
-               u32 _new_val = _masked_val | FIELD_PREP(GENMASK(_start, _end), 
(val)); \
-               _new_val;                                               \
-       })
-
 #define REG_GET(dispc, idx, start, end)                                        
\
        ((u32)FIELD_GET(GENMASK((start), (end)),                        \
                        dispc_read((dispc), (idx))))
 
 #define REG_FLD_MOD(dispc, idx, val, start, end)                       \
        ({                                                              \
                struct dispc_device *_dispc = (dispc);                  \
                u32 _idx = (idx);                                       \
-               u32 _curr = dispc_read(_dispc, _idx);                   \
-               u32 _new = FLD_MOD(_curr, (val), (start), (end));       \
-               dispc_write(_dispc, _idx, _new);                        \
+               u32 _reg = dispc_read(_dispc, _idx);                    \
+               FIELD_MODIFY(GENMASK((start), (end)), &_reg, (val));    \
+               dispc_write(_dispc, _idx, _reg);                        \
        })
 
 #define VID_REG_GET(dispc, hw_plane, idx, start, end)                  \
        ((u32)FIELD_GET(GENMASK((start), (end)),                        \
                        dispc_vid_read((dispc), (hw_plane), (idx))))
@@ -637,13 +629,13 @@ void tidss_disable_oldi(struct tidss_device *tidss, u32 
hw_videoport)
 #define VID_REG_FLD_MOD(dispc, hw_plane, idx, val, start, end)         \
        ({                                                              \
                struct dispc_device *_dispc = (dispc);                  \
                u32 _hw_plane = (hw_plane);                             \
                u32 _idx = (idx);                                       \
-               u32 _curr = dispc_vid_read(_dispc, _hw_plane, _idx);    \
-               u32 _new = FLD_MOD(_curr, (val), (start), (end));       \
-               dispc_vid_write(_dispc, _hw_plane, _idx, _new);         \
+               u32 _reg = dispc_vid_read(_dispc, _hw_plane, _idx);     \
+               FIELD_MODIFY(GENMASK((start), (end)), &_reg, (val));    \
+               dispc_vid_write(_dispc, _hw_plane, _idx, _reg);         \
        })
 
 #define VP_REG_GET(dispc, vp, idx, start, end)                         \
        ((u32)FIELD_GET(GENMASK((start), (end)),                        \
                        dispc_vp_read((dispc), (vp), (idx))))
@@ -651,23 +643,23 @@ void tidss_disable_oldi(struct tidss_device *tidss, u32 
hw_videoport)
 #define VP_REG_FLD_MOD(dispc, vp, idx, val, start, end)                        
\
        ({                                                              \
                struct dispc_device *_dispc = (dispc);                  \
                u32 _vp = (vp);                                         \
                u32 _idx = (idx);                                       \
-               u32 _curr = dispc_vp_read(_dispc, _vp, _idx);           \
-               u32 _new = FLD_MOD(_curr, (val), (start), (end));       \
-               dispc_vp_write(_dispc, _vp, _idx, _new);                \
+               u32 _reg = dispc_vp_read(_dispc, _vp, _idx);            \
+               FIELD_MODIFY(GENMASK((start), (end)), &_reg, (val));    \
+               dispc_vp_write(_dispc, _vp, _idx, _reg);                \
        })
 
 #define OVR_REG_FLD_MOD(dispc, ovr, idx, val, start, end)              \
        ({                                                              \
                struct dispc_device *_dispc = (dispc);                  \
-               u32 _ovr = (ovr);                                               
\
+               u32 _ovr = (ovr);                                       \
                u32 _idx = (idx);                                       \
-               u32 _curr = dispc_ovr_read(_dispc, _ovr, _idx);         \
-               u32 _new = FLD_MOD(_curr, (val), (start), (end));       \
-               dispc_ovr_write(_dispc, _ovr, _idx, _new);              \
+               u32 _reg = dispc_ovr_read(_dispc, _ovr, _idx);          \
+               FIELD_MODIFY(GENMASK((start), (end)), &_reg, (val));    \
+               dispc_ovr_write(_dispc, _ovr, _idx, _reg);              \
        })
 
 static dispc_irq_t dispc_vp_irq_from_raw(u32 stat, u32 hw_videoport)
 {
        dispc_irq_t vp_stat = 0;
@@ -1160,11 +1152,11 @@ static void dispc_enable_am65x_oldi(struct dispc_device 
*dispc, u32 hw_videoport
                dev_warn(dispc->dev, "%s: %d port width not supported\n",
                         __func__, fmt->data_width);
 
        oldi_cfg |= BIT(7); /* DEPOL */
 
-       oldi_cfg = FLD_MOD(oldi_cfg, fmt->am65x_oldi_mode_reg_val, 3, 1);
+       FIELD_MODIFY(GENMASK(3, 1), &oldi_cfg, fmt->am65x_oldi_mode_reg_val);
 
        oldi_cfg |= BIT(12); /* SOFTRST */
 
        oldi_cfg |= BIT(0); /* ENABLE */
 

-- 
2.50.1

Reply via email to