1 files changed, 82 insertions, 21 deletions

diff --git a/overlay/rc6.c b/overlay/rc6.c
index 500639ac..d7047c2f 100644
--- a/overlay/rc6.c
+++ b/overlay/rc6.c
@@ -32,17 +32,58 @@
 #include <errno.h>
 
 #include "rc6.h"
+#include "perf.h"
 
-int rc6_init(struct rc6 *rc6)
+static int perf_i915_open(int config, int group)
+{
+	struct perf_event_attr attr;
+
+	memset(&attr, 0, sizeof (attr));
+
+	attr.type = i915_type_id();
+	if (attr.type == 0)
+		return -ENOENT;
+	attr.config = config;
+
+	attr.read_format = PERF_FORMAT_TOTAL_TIME_ENABLED;
+	if (group == -1)
+		attr.read_format |= PERF_FORMAT_GROUP;
+
+	return perf_event_open(&attr, -1, 0, group, 0);
+}
+
+#define RC6	(1<<0)
+#define RC6p	(1<<1)
+#define RC6pp	(1<<2)
+
+static int perf_open(unsigned *flags)
 {
-	struct stat st;
 	int fd;
 
+	fd = perf_i915_open(I915_PERF_RC6_RESIDENCY, -1);
+	if (fd < 0)
+		return -1;
+
+	*flags |= RC6;
+	if (perf_i915_open(I915_PERF_RC6p_RESIDENCY, fd) >= 0)
+		*flags |= RC6p;
+
+	if (perf_i915_open(I915_PERF_RC6pp_RESIDENCY, fd) >= 0)
+		*flags |= RC6pp;
+
+	return fd;
+}
+
+int rc6_init(struct rc6 *rc6)
+{
 	memset(rc6, 0, sizeof(*rc6));
 
-	fd = stat("/sys/class/drm/card0/power", &st);
-	if (fd == -1)
-		return rc6->error = errno;
+	rc6->fd = perf_open(&rc6->flags);
+	if (rc6->fd == -1) {
+		struct stat st;
+		if (stat("/sys/class/drm/card0/power", &st) < 0)
+			return rc6->error = errno;
+	}
 
 	return 0;
 }
@@ -54,13 +95,13 @@ static uint64_t file_to_u64(const char *path)
 
 	fd = open(path, 0);
 	if (fd < 0)
-		return 0;
+		return -1;
 
 	len = read(fd, buf, sizeof(buf)-1);
 	close(fd);
 
 	if (len < 0)
-		return 0;
+		return -1;
 
 	buf[len] = '\0';
 
@@ -82,37 +123,57 @@ int rc6_update(struct rc6 *rc6)
 	struct rc6_stat *s = &rc6->stat[rc6->count++&1];
 	struct rc6_stat *d = &rc6->stat[rc6->count&1];
 	uint64_t d_time, d_rc6, d_rc6p, d_rc6pp;
-	struct stat st;
 
 	if (rc6->error)
 		return rc6->error;
 
-	if (stat("/sys/class/drm/card0/power/rc6_residency_ms", &st) < 0)
-		return rc6->error = ENOENT;
+	if (rc6->fd == -1) {
+		struct stat st;
 
-	rc6->enabled = file_to_u64("/sys/class/drm/card0/power/rc6_enable");
-	if (rc6->enabled == 0)
-		return EAGAIN;
+		if (stat("/sys/class/drm/card0/power/rc6_residency_ms", &st) < 0)
+			return rc6->error = ENOENT;
+
+		s->rc6_residency = file_to_u64("/sys/class/drm/card0/power/rc6_residency_ms");
+		s->rc6p_residency = file_to_u64("/sys/class/drm/card0/power/rc6p_residency_ms");
+		s->rc6pp_residency = file_to_u64("/sys/class/drm/card0/power/rc6pp_residency_ms");
+		s->timestamp = clock_ms_to_u64();
+	} else {
+		uint64_t data[5];
+		int len;
 
-	s->rc6_residency = file_to_u64("/sys/class/drm/card0/power/rc6_residency_ms");
-	s->rc6p_residency = file_to_u64("/sys/class/drm/card0/power/rc6p_residency_ms");
-	s->rc6pp_residency = file_to_u64("/sys/class/drm/card0/power/rc6pp_residency_ms");
-	s->timestamp = clock_ms_to_u64();
+		len = read(rc6->fd, data, sizeof(data));
+		if (len < 0)
+			return rc6->error = errno;
+
+		s->timestamp = data[1] / (1000*1000);
+
+		len = 2;
+		if (rc6->flags & RC6)
+			s->rc6_residency = data[len++];
+		if (rc6->flags & RC6p)
+			s->rc6p_residency = data[len++];
+		if (rc6->flags & RC6pp)
+			s->rc6pp_residency = data[len++];
+	}
 
 	if (rc6->count == 1)
 		return EAGAIN;
 
 	d_time = s->timestamp - d->timestamp;
+	if (d_time == 0) {
+		rc6->count--;
+		return EAGAIN;
+	}
 
 	d_rc6 = s->rc6_residency - d->rc6_residency;
-	rc6->rc6 = 100 * d_rc6 / d_time;
+	rc6->rc6 = (100 * d_rc6 + d_time/2) / d_time;
 
 	d_rc6p = s->rc6p_residency - d->rc6p_residency;
-	rc6->rc6p = 100 * d_rc6p / d_time;
+	rc6->rc6p = (100 * d_rc6p + d_time/2) / d_time;
 
 	d_rc6pp = s->rc6pp_residency - d->rc6pp_residency;
-	rc6->rc6pp = 100 * d_rc6pp / d_time;
+	rc6->rc6pp = (100 * d_rc6pp + d_time/2) / d_time;
 
-	rc6->rc6_combined = 100 * (d_rc6 + d_rc6p + d_rc6pp) / d_time;
+	rc6->rc6_combined = (100 * (d_rc6 + d_rc6p + d_rc6pp) + d_time/2) / d_time;
 	return 0;
 }