@@ -25,6 +25,11 @@
#include <linux/clk.h>
#include <linux/io.h>
+#include <linux/slab.h>
+
+#include <drm/drm_atomic.h>
+#include <drm/drm_atomic_state_helper.h>
+#include <drm/drm_device.h>
#include "rcar_du_drv.h"
#include "rcar_du_group.h"
@@ -361,3 +366,142 @@ int rcar_du_group_set_routing(struct rcar_du_group *rgrp)
return rcar_du_set_dpad0_vsp1_routing(rgrp->dev);
}
+
+/* -----------------------------------------------------------------------------
+ * Group State Handling
+ */
+
+static struct drm_private_state *
+rcar_du_group_atomic_duplicate_state(struct drm_private_obj *obj)
+{
+ struct rcar_du_group_state *state;
+
+ if (WARN_ON(!obj->state))
+ return NULL;
+
+ state = kzalloc(sizeof(*state), GFP_KERNEL);
+ if (!state)
+ return NULL;
+
+ __drm_atomic_helper_private_obj_duplicate_state(obj, &state->state);
+
+ return &state->state;
+}
+
+static void rcar_du_group_atomic_destroy_state(struct drm_private_obj *obj,
+ struct drm_private_state *state)
+{
+ kfree(to_rcar_group_state(state));
+}
+
+static const struct drm_private_state_funcs rcar_du_group_state_funcs = {
+ .atomic_duplicate_state = rcar_du_group_atomic_duplicate_state,
+ .atomic_destroy_state = rcar_du_group_atomic_destroy_state,
+};
+
+/**
+ * rcar_du_get_old_group_state - get old group state, if it exists
+ * @state: global atomic state object
+ * @rgrp: group to grab
+ *
+ * This function returns the old group state for the given group, or
+ * NULL if the group is not part of the global atomic state.
+ */
+struct rcar_du_group_state *
+rcar_du_get_old_group_state(struct drm_atomic_state *state,
+ struct rcar_du_group *rgrp)
+{
+ struct drm_private_obj *obj = &rgrp->private;
+ struct drm_private_state *pstate;
+ unsigned int i;
+
+ for (i = 0; i < state->num_private_objs; i++) {
+ if (obj == state->private_objs[i].ptr) {
+ pstate = state->private_objs[i].old_state;
+ return to_rcar_group_state(pstate);
+ }
+ }
+
+ return NULL;
+}
+
+/**
+ * rcar_du_get_new_group_state - get new group state, if it exists
+ * @state: global atomic state object
+ * @rgrp: group to grab
+ *
+ * This function returns the new group state for the given group, or
+ * NULL if the group is not part of the global atomic state.
+ */
+struct rcar_du_group_state *
+rcar_du_get_new_group_state(struct drm_atomic_state *state,
+ struct rcar_du_group *rgrp)
+{
+ struct drm_private_obj *obj = &rgrp->private;
+ struct drm_private_state *pstate;
+ unsigned int i;
+
+ for (i = 0; i < state->num_private_objs; i++) {
+ if (obj == state->private_objs[i].ptr) {
+ pstate = state->private_objs[i].new_state;
+ return to_rcar_group_state(pstate);
+ }
+ }
+
+ return NULL;
+}
+
+/* -----------------------------------------------------------------------------
+ * Init and Cleanup
+ */
+
+/*
+ * rcar_du_group_init - Initialise and reset a group object
+ *
+ * Return 0 in case of success or a negative error code otherwise.
+ */
+int rcar_du_group_init(struct rcar_du_device *rcdu, struct rcar_du_group *rgrp,
+ unsigned int index)
+{
+ static const unsigned int mmio_offsets[] = {
+ DU0_REG_OFFSET, DU2_REG_OFFSET
+ };
+
+ struct rcar_du_group_state *state;
+
+ state = kzalloc(sizeof(*state), GFP_KERNEL);
+ if (!state)
+ return -ENOMEM;
+
+ drm_atomic_private_obj_init(&rcdu->ddev, &rgrp->private, &state->state,
+ &rcar_du_group_state_funcs);
+
+ mutex_init(&rgrp->lock);
+
+ rgrp->dev = rcdu;
+ rgrp->mmio_offset = mmio_offsets[index];
+ rgrp->index = index;
+ /* Extract the channel mask for this group only. */
+ rgrp->channels_mask = (rcdu->info->channels_mask >> (2 * index))
+ & GENMASK(1, 0);
+ rgrp->num_crtcs = hweight8(rgrp->channels_mask);
+
+ /*
+ * If we have more than one CRTC in this group pre-associate
+ * the low-order planes with CRTC 0 and the high-order planes
+ * with CRTC 1 to minimize flicker occurring when the
+ * association is changed.
+ */
+ rgrp->dptsr_planes = rgrp->num_crtcs > 1
+ ? (rcdu->info->gen >= 3 ? 0x04 : 0xf0)
+ : 0;
+
+ return 0;
+}
+
+void rcar_du_group_cleanup(struct rcar_du_group *rgrp)
+{
+ mutex_destroy(&rgrp->lock);
+
+ drm_atomic_private_obj_fini(&rgrp->private);
+}
@@ -12,12 +12,15 @@
#include <linux/mutex.h>
+#include <drm/drm_atomic.h>
+
#include "rcar_du_plane.h"
struct rcar_du_device;
/*
* struct rcar_du_group - CRTCs and planes group
+ * @private: The base drm private object
* @dev: the DU device
* @mmio_offset: registers offset in the device memory map
* @index: group index
@@ -33,6 +36,8 @@ struct rcar_du_device;
* @need_restart: the group needs to be restarted due to a configuration change
*/
struct rcar_du_group {
+ struct drm_private_obj private;
+
struct rcar_du_device *dev;
unsigned int mmio_offset;
unsigned int index;
@@ -51,6 +56,19 @@ struct rcar_du_group {
bool need_restart;
};
+#define to_rcar_group(s) container_of(s, struct rcar_du_group, private)
+
+/**
+ * struct rcar_du_group_state - Driver-specific group state
+ * @state: base DRM private state
+ */
+struct rcar_du_group_state {
+ struct drm_private_state state;
+};
+
+#define to_rcar_group_state(s) \
+ container_of(s, struct rcar_du_group_state, state)
+
u32 rcar_du_group_read(struct rcar_du_group *rgrp, u32 reg);
void rcar_du_group_write(struct rcar_du_group *rgrp, u32 reg, u32 data);
@@ -62,4 +80,15 @@ int rcar_du_group_set_routing(struct rcar_du_group *rgrp);
int rcar_du_set_dpad0_vsp1_routing(struct rcar_du_device *rcdu);
+struct rcar_du_group_state *
+rcar_du_get_old_group_state(struct drm_atomic_state *state,
+ struct rcar_du_group *rgrp);
+struct rcar_du_group_state *
+rcar_du_get_new_group_state(struct drm_atomic_state *state,
+ struct rcar_du_group *rgrp);
+
+int rcar_du_group_init(struct rcar_du_device *rcdu, struct rcar_du_group *rgrp,
+ unsigned int index);
+void rcar_du_group_cleanup(struct rcar_du_group *rgrp);
+
#endif /* __RCAR_DU_GROUP_H__ */
@@ -26,6 +26,7 @@
#include "rcar_du_crtc.h"
#include "rcar_du_drv.h"
#include "rcar_du_encoder.h"
+#include "rcar_du_group.h"
#include "rcar_du_kms.h"
#include "rcar_du_regs.h"
#include "rcar_du_vsp.h"
@@ -765,10 +766,6 @@ static void rcar_du_modeset_cleanup(struct drm_device *dev, void *res)
int rcar_du_modeset_init(struct rcar_du_device *rcdu)
{
- static const unsigned int mmio_offsets[] = {
- DU0_REG_OFFSET, DU2_REG_OFFSET
- };
-
struct drm_device *dev = &rcdu->ddev;
struct drm_encoder *encoder;
struct rcar_du_group *rgrp;
@@ -821,25 +818,9 @@ int rcar_du_modeset_init(struct rcar_du_device *rcdu)
/* Initialize the groups. */
for_each_rcdu_group(rcdu, rgrp, i) {
- mutex_init(&rgrp->lock);
-
- rgrp->dev = rcdu;
- rgrp->mmio_offset = mmio_offsets[i];
- rgrp->index = i;
- /* Extract the channel mask for this group only. */
- rgrp->channels_mask = (rcdu->info->channels_mask >> (2 * i))
- & GENMASK(1, 0);
- rgrp->num_crtcs = hweight8(rgrp->channels_mask);
-
- /*
- * If we have more than one CRTCs in this group pre-associate
- * the low-order planes with CRTC 0 and the high-order planes
- * with CRTC 1 to minimize flicker occurring when the
- * association is changed.
- */
- rgrp->dptsr_planes = rgrp->num_crtcs > 1
- ? (rcdu->info->gen >= 3 ? 0x04 : 0xf0)
- : 0;
+ ret = rcar_du_group_init(rcdu, rgrp, i);
+ if (ret < 0)
+ return ret;
if (!rcar_du_has(rcdu, RCAR_DU_FEATURE_VSP1_SOURCE)) {
ret = rcar_du_planes_init(rgrp);