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
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
|
/* driver/video/starfive/starfive_display_dev.c
**
** This program is free software; you can redistribute it and/or modify
** it under the terms of the GNU General Public License version 2 as
** published by the Free Software Foundation.
**
** Copyright (C) 2020 StarFive, Inc.
**
** PURPOSE: This files contains the driver of LCD controller and VPP.
**
** CHANGE HISTORY:
** Version Date Author Description
** 0.1.0 2020-11-10 starfive created
**
*/
#include <linux/of_device.h>
#include <linux/of.h>
#include <linux/mutex.h>
#include "starfive_display_dev.h"
struct sf_fb_display_dev_data {
struct sf_fb_display_dev* dev;
struct list_head list;
};
static DEFINE_MUTEX(sf_fb_display_dev_lock);
static LIST_HEAD(sf_fb_display_dev_list);
int sf_fb_display_dev_register(struct sf_fb_display_dev* dev)
{
struct sf_fb_display_dev_data *display_dev;
display_dev = kzalloc(sizeof(struct sf_fb_display_dev_data), GFP_KERNEL);
if (!display_dev)
return -ENOMEM;
INIT_LIST_HEAD(&display_dev->list);
display_dev->dev = dev;
mutex_lock(&sf_fb_display_dev_lock);
list_add_tail(&display_dev->list, &sf_fb_display_dev_list);
mutex_unlock(&sf_fb_display_dev_lock);
return 0;
}
EXPORT_SYMBOL(sf_fb_display_dev_register);
int sf_fb_display_dev_unregister(struct sf_fb_display_dev* dev)
{
struct sf_fb_display_dev_data *display_dev;
mutex_lock(&sf_fb_display_dev_lock);
list_for_each_entry(display_dev, &sf_fb_display_dev_list, list) {
if (display_dev->dev == dev) {
list_del_init(&display_dev->list);
kfree(display_dev);
}
}
mutex_unlock(&sf_fb_display_dev_lock);
return 0;
}
EXPORT_SYMBOL(sf_fb_display_dev_unregister);
static int build_dev_list(struct sf_fb_data *fb_data)
{
int rc = 0;
rc = of_platform_populate(fb_data->dev->of_node, NULL, NULL, fb_data->dev);
if (rc) {
dev_err(fb_data->dev, "%s: failed to add child nodes, rc=%d\n",
__func__, rc);
}
return rc;
}
struct sf_fb_display_dev* sf_fb_display_dev_get_by_name(char *dev_name)
{
struct sf_fb_display_dev_data *display_dev;
struct sf_fb_display_dev *dev = NULL;
char *connect_panel_name;
connect_panel_name = dev_name;
mutex_lock(&sf_fb_display_dev_lock);
list_for_each_entry(display_dev, &sf_fb_display_dev_list, list) {
if(!strcmp(connect_panel_name, display_dev->dev->name)) {
dev = display_dev->dev;
printk(KERN_INFO "select displayer: %s\n", dev->name);
break;
}
}
if (!dev) {
display_dev = list_first_entry(&sf_fb_display_dev_list, typeof(*display_dev), list);
dev = display_dev->dev;
printk(KERN_INFO "default get first displayer(%s)! \n", display_dev->dev->name);
}
mutex_unlock(&sf_fb_display_dev_lock);
return dev;
}
EXPORT_SYMBOL(sf_fb_display_dev_get_by_name);
struct sf_fb_display_dev* sf_fb_display_dev_get(struct sf_fb_data *fb_data)
{
struct sf_fb_display_dev_data *display_dev;
struct sf_fb_display_dev *dev = NULL;
char *connect_panel_name;
build_dev_list(fb_data);
connect_panel_name = fb_data->dis_dev_name;
mutex_lock(&sf_fb_display_dev_lock);
list_for_each_entry(display_dev, &sf_fb_display_dev_list, list) {
if(!strcmp(connect_panel_name, display_dev->dev->name)) {
dev = display_dev->dev;
dev_info(fb_data->dev, "select displayer: %s\n", dev->name);
break;
}
}
if (!dev) {
display_dev = list_first_entry(&sf_fb_display_dev_list, typeof(*display_dev), list);
dev = display_dev->dev;
dev_info(fb_data->dev,"default get first displayer(%s)! \n", display_dev->dev->name);
}
mutex_unlock(&sf_fb_display_dev_lock);
return dev;
}
EXPORT_SYMBOL(sf_fb_display_dev_get);
MODULE_AUTHOR("StarFive Technology Co., Ltd.");
MODULE_DESCRIPTION("framebuffer device for StarFive");
MODULE_LICENSE("GPL");
|
