framebuffer.c


1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80

#include "kvm/framebuffer.h"
#include "kvm/kvm.h"

#include <linux/kernel.h>
#include <linux/list.h>
#include <stdlib.h>
#include <sys/mman.h>
#include <errno.h>

static LIST_HEAD(framebuffers);

struct framebuffer *fb__register(struct framebuffer *fb)
{
	INIT_LIST_HEAD(&fb->node);
	list_add(&fb->node, &framebuffers);

	return fb;
}

int fb__attach(struct framebuffer *fb, struct fb_target_operations *ops)
{
	if (fb->nr_targets >= FB_MAX_TARGETS)
		return -ENOSPC;

	fb->targets[fb->nr_targets++] = ops;

	return 0;
}

static int start_targets(struct framebuffer *fb)
{
	unsigned long i;

	for (i = 0; i < fb->nr_targets; i++) {
		struct fb_target_operations *ops = fb->targets[i];
		int err = 0;

		if (ops->start)
			err = ops->start(fb);

		if (err)
			return err;
	}

	return 0;
}

int fb__init(struct kvm *kvm)
{
	struct framebuffer *fb;

	list_for_each_entry(fb, &framebuffers, node) {
		int err;

		err = start_targets(fb);
		if (err)
			return err;
	}

	return 0;
}
firmware_init(fb__init);

int fb__exit(struct kvm *kvm)
{
	struct framebuffer *fb;

	list_for_each_entry(fb, &framebuffers, node) {
		u32 i;

		for (i = 0; i < fb->nr_targets; i++)
			if (fb->targets[i]->stop)
				fb->targets[i]->stop(fb);

		munmap(fb->mem, fb->mem_size);
	}

	return 0;
}
firmware_exit(fb__exit);