Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 82b466e5 authored by qctecmdr's avatar qctecmdr Committed by Gerrit - the friendly Code Review server
Browse files

Merge "Rest replicator registers when enabling it first time"

parents c8694fd0 75d0b9f7
Loading
Loading
Loading
Loading
+16 −0
Original line number Diff line number Diff line
@@ -94,6 +94,18 @@ static int dynamic_replicator_enable(struct replicator_drvdata *drvdata,
	return rc;
}

static bool is_replicator_disabled(struct coresight_device *csdev)
{
	int i;

	for (i = 0; i < csdev->pdata->nr_outport; i++) {
		if (atomic_read(&csdev->refcnt[i]) > 0)
			return false;
	}

	return true;
}

static int replicator_enable(struct coresight_device *csdev, int inport,
			     int outport)
{
@@ -103,6 +115,10 @@ static int replicator_enable(struct coresight_device *csdev, int inport,
	bool first_enable = false;

	spin_lock_irqsave(&drvdata->spinlock, flags);

	if (is_replicator_disabled(csdev))
		dynamic_replicator_reset(drvdata);

	if (atomic_read(&csdev->refcnt[outport]) == 0) {
		if (drvdata->base)
			rc = dynamic_replicator_enable(drvdata, inport,