4 static int get_next_ulong(char **str_p
, unsigned long *val
, char *sep
, int base
)
9 if (!str_p
|| !(*str_p
))
12 p_val
= strsep(str_p
, sep
);
17 ret
= kstrtoul(p_val
, base
, val
);
24 int fbtft_gamma_parse_str(struct fbtft_par
*par
, unsigned long *curves
,
25 const char *str
, int size
)
27 char *str_p
, *curve_p
= NULL
;
29 unsigned long val
= 0;
31 int curve_counter
, value_counter
;
33 fbtft_par_dbg(DEBUG_SYSFS
, par
, "%s() str=\n", __func__
);
38 fbtft_par_dbg(DEBUG_SYSFS
, par
, "%s\n", str
);
40 tmp
= kmemdup(str
, size
+ 1, GFP_KERNEL
);
44 /* replace optional separators */
58 if (curve_counter
== par
->gamma
.num_curves
) {
59 dev_err(par
->info
->device
, "Gamma: Too many curves\n");
63 curve_p
= strsep(&str_p
, "\n");
66 if (value_counter
== par
->gamma
.num_values
) {
67 dev_err(par
->info
->device
,
68 "Gamma: Too many values\n");
72 ret
= get_next_ulong(&curve_p
, &val
, " ", 16);
75 curves
[curve_counter
* par
->gamma
.num_values
+ value_counter
] = val
;
78 if (value_counter
!= par
->gamma
.num_values
) {
79 dev_err(par
->info
->device
, "Gamma: Too few values\n");
85 if (curve_counter
!= par
->gamma
.num_curves
) {
86 dev_err(par
->info
->device
, "Gamma: Too few curves\n");
97 sprintf_gamma(struct fbtft_par
*par
, unsigned long *curves
, char *buf
)
102 mutex_lock(&par
->gamma
.lock
);
103 for (i
= 0; i
< par
->gamma
.num_curves
; i
++) {
104 for (j
= 0; j
< par
->gamma
.num_values
; j
++)
105 len
+= scnprintf(&buf
[len
], PAGE_SIZE
,
106 "%04lx ", curves
[i
* par
->gamma
.num_values
+ j
]);
109 mutex_unlock(&par
->gamma
.lock
);
114 static ssize_t
store_gamma_curve(struct device
*device
,
115 struct device_attribute
*attr
,
116 const char *buf
, size_t count
)
118 struct fb_info
*fb_info
= dev_get_drvdata(device
);
119 struct fbtft_par
*par
= fb_info
->par
;
120 unsigned long tmp_curves
[FBTFT_GAMMA_MAX_VALUES_TOTAL
];
123 ret
= fbtft_gamma_parse_str(par
, tmp_curves
, buf
, count
);
127 ret
= par
->fbtftops
.set_gamma(par
, tmp_curves
);
131 mutex_lock(&par
->gamma
.lock
);
132 memcpy(par
->gamma
.curves
, tmp_curves
,
133 par
->gamma
.num_curves
* par
->gamma
.num_values
* sizeof(tmp_curves
[0]));
134 mutex_unlock(&par
->gamma
.lock
);
139 static ssize_t
show_gamma_curve(struct device
*device
,
140 struct device_attribute
*attr
, char *buf
)
142 struct fb_info
*fb_info
= dev_get_drvdata(device
);
143 struct fbtft_par
*par
= fb_info
->par
;
145 return sprintf_gamma(par
, par
->gamma
.curves
, buf
);
148 static struct device_attribute gamma_device_attrs
[] = {
149 __ATTR(gamma
, 0660, show_gamma_curve
, store_gamma_curve
),
152 void fbtft_expand_debug_value(unsigned long *debug
)
154 switch (*debug
& 0x7) {
156 *debug
|= DEBUG_LEVEL_1
;
159 *debug
|= DEBUG_LEVEL_2
;
162 *debug
|= DEBUG_LEVEL_3
;
165 *debug
|= DEBUG_LEVEL_4
;
168 *debug
|= DEBUG_LEVEL_5
;
171 *debug
|= DEBUG_LEVEL_6
;
179 static ssize_t
store_debug(struct device
*device
,
180 struct device_attribute
*attr
,
181 const char *buf
, size_t count
)
183 struct fb_info
*fb_info
= dev_get_drvdata(device
);
184 struct fbtft_par
*par
= fb_info
->par
;
187 ret
= kstrtoul(buf
, 10, &par
->debug
);
190 fbtft_expand_debug_value(&par
->debug
);
195 static ssize_t
show_debug(struct device
*device
,
196 struct device_attribute
*attr
, char *buf
)
198 struct fb_info
*fb_info
= dev_get_drvdata(device
);
199 struct fbtft_par
*par
= fb_info
->par
;
201 return snprintf(buf
, PAGE_SIZE
, "%lu\n", par
->debug
);
204 static struct device_attribute debug_device_attr
= \
205 __ATTR(debug
, 0660, show_debug
, store_debug
);
207 void fbtft_sysfs_init(struct fbtft_par
*par
)
209 device_create_file(par
->info
->dev
, &debug_device_attr
);
210 if (par
->gamma
.curves
&& par
->fbtftops
.set_gamma
)
211 device_create_file(par
->info
->dev
, &gamma_device_attrs
[0]);
214 void fbtft_sysfs_exit(struct fbtft_par
*par
)
216 device_remove_file(par
->info
->dev
, &debug_device_attr
);
217 if (par
->gamma
.curves
&& par
->fbtftops
.set_gamma
)
218 device_remove_file(par
->info
->dev
, &gamma_device_attrs
[0]);