manager-sysfs.c 12 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525
  1. /*
  2. * Copyright (C) 2009 Nokia Corporation
  3. * Author: Tomi Valkeinen <tomi.valkeinen@nokia.com>
  4. *
  5. * Some code and ideas taken from drivers/video/omap/ driver
  6. * by Imre Deak.
  7. *
  8. * This program is free software; you can redistribute it and/or modify it
  9. * under the terms of the GNU General Public License version 2 as published by
  10. * the Free Software Foundation.
  11. *
  12. * This program is distributed in the hope that it will be useful, but WITHOUT
  13. * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  14. * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
  15. * more details.
  16. *
  17. * You should have received a copy of the GNU General Public License along with
  18. * this program. If not, see <http://www.gnu.org/licenses/>.
  19. */
  20. #define DSS_SUBSYS_NAME "MANAGER"
  21. #include <linux/kernel.h>
  22. #include <linux/slab.h>
  23. #include <linux/module.h>
  24. #include <linux/platform_device.h>
  25. #include <linux/jiffies.h>
  26. #include <video/omapfb_dss.h>
  27. #include "dss.h"
  28. #include "dss_features.h"
  29. static ssize_t manager_name_show(struct omap_overlay_manager *mgr, char *buf)
  30. {
  31. return snprintf(buf, PAGE_SIZE, "%s\n", mgr->name);
  32. }
  33. static ssize_t manager_display_show(struct omap_overlay_manager *mgr, char *buf)
  34. {
  35. struct omap_dss_device *dssdev = mgr->get_device(mgr);
  36. return snprintf(buf, PAGE_SIZE, "%s\n", dssdev ?
  37. dssdev->name : "<none>");
  38. }
  39. static int manager_display_match(struct omap_dss_device *dssdev, void *data)
  40. {
  41. const char *str = data;
  42. return sysfs_streq(dssdev->name, str);
  43. }
  44. static ssize_t manager_display_store(struct omap_overlay_manager *mgr,
  45. const char *buf, size_t size)
  46. {
  47. int r = 0;
  48. size_t len = size;
  49. struct omap_dss_device *dssdev = NULL;
  50. struct omap_dss_device *old_dssdev;
  51. if (buf[size-1] == '\n')
  52. --len;
  53. if (len > 0)
  54. dssdev = omap_dss_find_device((void *)buf,
  55. manager_display_match);
  56. if (len > 0 && dssdev == NULL)
  57. return -EINVAL;
  58. if (dssdev) {
  59. DSSDBG("display %s found\n", dssdev->name);
  60. if (omapdss_device_is_connected(dssdev)) {
  61. DSSERR("new display is already connected\n");
  62. r = -EINVAL;
  63. goto put_device;
  64. }
  65. if (omapdss_device_is_enabled(dssdev)) {
  66. DSSERR("new display is not disabled\n");
  67. r = -EINVAL;
  68. goto put_device;
  69. }
  70. }
  71. old_dssdev = mgr->get_device(mgr);
  72. if (old_dssdev) {
  73. if (omapdss_device_is_enabled(old_dssdev)) {
  74. DSSERR("old display is not disabled\n");
  75. r = -EINVAL;
  76. goto put_device;
  77. }
  78. old_dssdev->driver->disconnect(old_dssdev);
  79. }
  80. if (dssdev) {
  81. r = dssdev->driver->connect(dssdev);
  82. if (r) {
  83. DSSERR("failed to connect new device\n");
  84. goto put_device;
  85. }
  86. old_dssdev = mgr->get_device(mgr);
  87. if (old_dssdev != dssdev) {
  88. DSSERR("failed to connect device to this manager\n");
  89. dssdev->driver->disconnect(dssdev);
  90. goto put_device;
  91. }
  92. r = mgr->apply(mgr);
  93. if (r) {
  94. DSSERR("failed to apply dispc config\n");
  95. goto put_device;
  96. }
  97. }
  98. put_device:
  99. if (dssdev)
  100. omap_dss_put_device(dssdev);
  101. return r ? r : size;
  102. }
  103. static ssize_t manager_default_color_show(struct omap_overlay_manager *mgr,
  104. char *buf)
  105. {
  106. struct omap_overlay_manager_info info;
  107. mgr->get_manager_info(mgr, &info);
  108. return snprintf(buf, PAGE_SIZE, "%#x\n", info.default_color);
  109. }
  110. static ssize_t manager_default_color_store(struct omap_overlay_manager *mgr,
  111. const char *buf, size_t size)
  112. {
  113. struct omap_overlay_manager_info info;
  114. u32 color;
  115. int r;
  116. r = kstrtouint(buf, 0, &color);
  117. if (r)
  118. return r;
  119. mgr->get_manager_info(mgr, &info);
  120. info.default_color = color;
  121. r = mgr->set_manager_info(mgr, &info);
  122. if (r)
  123. return r;
  124. r = mgr->apply(mgr);
  125. if (r)
  126. return r;
  127. return size;
  128. }
  129. static const char *trans_key_type_str[] = {
  130. "gfx-destination",
  131. "video-source",
  132. };
  133. static ssize_t manager_trans_key_type_show(struct omap_overlay_manager *mgr,
  134. char *buf)
  135. {
  136. enum omap_dss_trans_key_type key_type;
  137. struct omap_overlay_manager_info info;
  138. mgr->get_manager_info(mgr, &info);
  139. key_type = info.trans_key_type;
  140. BUG_ON(key_type >= ARRAY_SIZE(trans_key_type_str));
  141. return snprintf(buf, PAGE_SIZE, "%s\n", trans_key_type_str[key_type]);
  142. }
  143. static ssize_t manager_trans_key_type_store(struct omap_overlay_manager *mgr,
  144. const char *buf, size_t size)
  145. {
  146. struct omap_overlay_manager_info info;
  147. int r;
  148. r = sysfs_match_string(trans_key_type_str, buf);
  149. if (r < 0)
  150. return r;
  151. mgr->get_manager_info(mgr, &info);
  152. info.trans_key_type = r;
  153. r = mgr->set_manager_info(mgr, &info);
  154. if (r)
  155. return r;
  156. r = mgr->apply(mgr);
  157. if (r)
  158. return r;
  159. return size;
  160. }
  161. static ssize_t manager_trans_key_value_show(struct omap_overlay_manager *mgr,
  162. char *buf)
  163. {
  164. struct omap_overlay_manager_info info;
  165. mgr->get_manager_info(mgr, &info);
  166. return snprintf(buf, PAGE_SIZE, "%#x\n", info.trans_key);
  167. }
  168. static ssize_t manager_trans_key_value_store(struct omap_overlay_manager *mgr,
  169. const char *buf, size_t size)
  170. {
  171. struct omap_overlay_manager_info info;
  172. u32 key_value;
  173. int r;
  174. r = kstrtouint(buf, 0, &key_value);
  175. if (r)
  176. return r;
  177. mgr->get_manager_info(mgr, &info);
  178. info.trans_key = key_value;
  179. r = mgr->set_manager_info(mgr, &info);
  180. if (r)
  181. return r;
  182. r = mgr->apply(mgr);
  183. if (r)
  184. return r;
  185. return size;
  186. }
  187. static ssize_t manager_trans_key_enabled_show(struct omap_overlay_manager *mgr,
  188. char *buf)
  189. {
  190. struct omap_overlay_manager_info info;
  191. mgr->get_manager_info(mgr, &info);
  192. return snprintf(buf, PAGE_SIZE, "%d\n", info.trans_enabled);
  193. }
  194. static ssize_t manager_trans_key_enabled_store(struct omap_overlay_manager *mgr,
  195. const char *buf, size_t size)
  196. {
  197. struct omap_overlay_manager_info info;
  198. bool enable;
  199. int r;
  200. r = strtobool(buf, &enable);
  201. if (r)
  202. return r;
  203. mgr->get_manager_info(mgr, &info);
  204. info.trans_enabled = enable;
  205. r = mgr->set_manager_info(mgr, &info);
  206. if (r)
  207. return r;
  208. r = mgr->apply(mgr);
  209. if (r)
  210. return r;
  211. return size;
  212. }
  213. static ssize_t manager_alpha_blending_enabled_show(
  214. struct omap_overlay_manager *mgr, char *buf)
  215. {
  216. struct omap_overlay_manager_info info;
  217. if(!dss_has_feature(FEAT_ALPHA_FIXED_ZORDER))
  218. return -ENODEV;
  219. mgr->get_manager_info(mgr, &info);
  220. return snprintf(buf, PAGE_SIZE, "%d\n",
  221. info.partial_alpha_enabled);
  222. }
  223. static ssize_t manager_alpha_blending_enabled_store(
  224. struct omap_overlay_manager *mgr,
  225. const char *buf, size_t size)
  226. {
  227. struct omap_overlay_manager_info info;
  228. bool enable;
  229. int r;
  230. if(!dss_has_feature(FEAT_ALPHA_FIXED_ZORDER))
  231. return -ENODEV;
  232. r = strtobool(buf, &enable);
  233. if (r)
  234. return r;
  235. mgr->get_manager_info(mgr, &info);
  236. info.partial_alpha_enabled = enable;
  237. r = mgr->set_manager_info(mgr, &info);
  238. if (r)
  239. return r;
  240. r = mgr->apply(mgr);
  241. if (r)
  242. return r;
  243. return size;
  244. }
  245. static ssize_t manager_cpr_enable_show(struct omap_overlay_manager *mgr,
  246. char *buf)
  247. {
  248. struct omap_overlay_manager_info info;
  249. mgr->get_manager_info(mgr, &info);
  250. return snprintf(buf, PAGE_SIZE, "%d\n", info.cpr_enable);
  251. }
  252. static ssize_t manager_cpr_enable_store(struct omap_overlay_manager *mgr,
  253. const char *buf, size_t size)
  254. {
  255. struct omap_overlay_manager_info info;
  256. int r;
  257. bool enable;
  258. if (!dss_has_feature(FEAT_CPR))
  259. return -ENODEV;
  260. r = strtobool(buf, &enable);
  261. if (r)
  262. return r;
  263. mgr->get_manager_info(mgr, &info);
  264. if (info.cpr_enable == enable)
  265. return size;
  266. info.cpr_enable = enable;
  267. r = mgr->set_manager_info(mgr, &info);
  268. if (r)
  269. return r;
  270. r = mgr->apply(mgr);
  271. if (r)
  272. return r;
  273. return size;
  274. }
  275. static ssize_t manager_cpr_coef_show(struct omap_overlay_manager *mgr,
  276. char *buf)
  277. {
  278. struct omap_overlay_manager_info info;
  279. mgr->get_manager_info(mgr, &info);
  280. return snprintf(buf, PAGE_SIZE,
  281. "%d %d %d %d %d %d %d %d %d\n",
  282. info.cpr_coefs.rr,
  283. info.cpr_coefs.rg,
  284. info.cpr_coefs.rb,
  285. info.cpr_coefs.gr,
  286. info.cpr_coefs.gg,
  287. info.cpr_coefs.gb,
  288. info.cpr_coefs.br,
  289. info.cpr_coefs.bg,
  290. info.cpr_coefs.bb);
  291. }
  292. static ssize_t manager_cpr_coef_store(struct omap_overlay_manager *mgr,
  293. const char *buf, size_t size)
  294. {
  295. struct omap_overlay_manager_info info;
  296. struct omap_dss_cpr_coefs coefs;
  297. int r, i;
  298. s16 *arr;
  299. if (!dss_has_feature(FEAT_CPR))
  300. return -ENODEV;
  301. if (sscanf(buf, "%hd %hd %hd %hd %hd %hd %hd %hd %hd",
  302. &coefs.rr, &coefs.rg, &coefs.rb,
  303. &coefs.gr, &coefs.gg, &coefs.gb,
  304. &coefs.br, &coefs.bg, &coefs.bb) != 9)
  305. return -EINVAL;
  306. arr = (s16[]){ coefs.rr, coefs.rg, coefs.rb,
  307. coefs.gr, coefs.gg, coefs.gb,
  308. coefs.br, coefs.bg, coefs.bb };
  309. for (i = 0; i < 9; ++i) {
  310. if (arr[i] < -512 || arr[i] > 511)
  311. return -EINVAL;
  312. }
  313. mgr->get_manager_info(mgr, &info);
  314. info.cpr_coefs = coefs;
  315. r = mgr->set_manager_info(mgr, &info);
  316. if (r)
  317. return r;
  318. r = mgr->apply(mgr);
  319. if (r)
  320. return r;
  321. return size;
  322. }
  323. struct manager_attribute {
  324. struct attribute attr;
  325. ssize_t (*show)(struct omap_overlay_manager *, char *);
  326. ssize_t (*store)(struct omap_overlay_manager *, const char *, size_t);
  327. };
  328. #define MANAGER_ATTR(_name, _mode, _show, _store) \
  329. struct manager_attribute manager_attr_##_name = \
  330. __ATTR(_name, _mode, _show, _store)
  331. static MANAGER_ATTR(name, S_IRUGO, manager_name_show, NULL);
  332. static MANAGER_ATTR(display, S_IRUGO|S_IWUSR,
  333. manager_display_show, manager_display_store);
  334. static MANAGER_ATTR(default_color, S_IRUGO|S_IWUSR,
  335. manager_default_color_show, manager_default_color_store);
  336. static MANAGER_ATTR(trans_key_type, S_IRUGO|S_IWUSR,
  337. manager_trans_key_type_show, manager_trans_key_type_store);
  338. static MANAGER_ATTR(trans_key_value, S_IRUGO|S_IWUSR,
  339. manager_trans_key_value_show, manager_trans_key_value_store);
  340. static MANAGER_ATTR(trans_key_enabled, S_IRUGO|S_IWUSR,
  341. manager_trans_key_enabled_show,
  342. manager_trans_key_enabled_store);
  343. static MANAGER_ATTR(alpha_blending_enabled, S_IRUGO|S_IWUSR,
  344. manager_alpha_blending_enabled_show,
  345. manager_alpha_blending_enabled_store);
  346. static MANAGER_ATTR(cpr_enable, S_IRUGO|S_IWUSR,
  347. manager_cpr_enable_show,
  348. manager_cpr_enable_store);
  349. static MANAGER_ATTR(cpr_coef, S_IRUGO|S_IWUSR,
  350. manager_cpr_coef_show,
  351. manager_cpr_coef_store);
  352. static struct attribute *manager_sysfs_attrs[] = {
  353. &manager_attr_name.attr,
  354. &manager_attr_display.attr,
  355. &manager_attr_default_color.attr,
  356. &manager_attr_trans_key_type.attr,
  357. &manager_attr_trans_key_value.attr,
  358. &manager_attr_trans_key_enabled.attr,
  359. &manager_attr_alpha_blending_enabled.attr,
  360. &manager_attr_cpr_enable.attr,
  361. &manager_attr_cpr_coef.attr,
  362. NULL
  363. };
  364. static ssize_t manager_attr_show(struct kobject *kobj, struct attribute *attr,
  365. char *buf)
  366. {
  367. struct omap_overlay_manager *manager;
  368. struct manager_attribute *manager_attr;
  369. manager = container_of(kobj, struct omap_overlay_manager, kobj);
  370. manager_attr = container_of(attr, struct manager_attribute, attr);
  371. if (!manager_attr->show)
  372. return -ENOENT;
  373. return manager_attr->show(manager, buf);
  374. }
  375. static ssize_t manager_attr_store(struct kobject *kobj, struct attribute *attr,
  376. const char *buf, size_t size)
  377. {
  378. struct omap_overlay_manager *manager;
  379. struct manager_attribute *manager_attr;
  380. manager = container_of(kobj, struct omap_overlay_manager, kobj);
  381. manager_attr = container_of(attr, struct manager_attribute, attr);
  382. if (!manager_attr->store)
  383. return -ENOENT;
  384. return manager_attr->store(manager, buf, size);
  385. }
  386. static const struct sysfs_ops manager_sysfs_ops = {
  387. .show = manager_attr_show,
  388. .store = manager_attr_store,
  389. };
  390. static struct kobj_type manager_ktype = {
  391. .sysfs_ops = &manager_sysfs_ops,
  392. .default_attrs = manager_sysfs_attrs,
  393. };
  394. int dss_manager_kobj_init(struct omap_overlay_manager *mgr,
  395. struct platform_device *pdev)
  396. {
  397. return kobject_init_and_add(&mgr->kobj, &manager_ktype,
  398. &pdev->dev.kobj, "manager%d", mgr->id);
  399. }
  400. void dss_manager_kobj_uninit(struct omap_overlay_manager *mgr)
  401. {
  402. kobject_del(&mgr->kobj);
  403. kobject_put(&mgr->kobj);
  404. memset(&mgr->kobj, 0, sizeof(mgr->kobj));
  405. }