omap_drv.c 22 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963
  1. /*
  2. * drivers/gpu/drm/omapdrm/omap_drv.c
  3. *
  4. * Copyright (C) 2011 Texas Instruments
  5. * Author: Rob Clark <rob@ti.com>
  6. *
  7. * This program is free software; you can redistribute it and/or modify it
  8. * under the terms of the GNU General Public License version 2 as published by
  9. * the Free Software Foundation.
  10. *
  11. * This program is distributed in the hope that it will be useful, but WITHOUT
  12. * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  13. * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
  14. * more details.
  15. *
  16. * You should have received a copy of the GNU General Public License along with
  17. * this program. If not, see <http://www.gnu.org/licenses/>.
  18. */
  19. #include <linux/wait.h>
  20. #include <drm/drm_atomic.h>
  21. #include <drm/drm_atomic_helper.h>
  22. #include <drm/drm_crtc_helper.h>
  23. #include <drm/drm_fb_helper.h>
  24. #include "omap_dmm_tiler.h"
  25. #include "omap_drv.h"
  26. #define DRIVER_NAME MODULE_NAME
  27. #define DRIVER_DESC "OMAP DRM"
  28. #define DRIVER_DATE "20110917"
  29. #define DRIVER_MAJOR 1
  30. #define DRIVER_MINOR 0
  31. #define DRIVER_PATCHLEVEL 0
  32. static int num_crtc = CONFIG_DRM_OMAP_NUM_CRTCS;
  33. MODULE_PARM_DESC(num_crtc, "Number of overlays to use as CRTCs");
  34. module_param(num_crtc, int, 0600);
  35. /*
  36. * mode config funcs
  37. */
  38. /* Notes about mapping DSS and DRM entities:
  39. * CRTC: overlay
  40. * encoder: manager.. with some extension to allow one primary CRTC
  41. * and zero or more video CRTC's to be mapped to one encoder?
  42. * connector: dssdev.. manager can be attached/detached from different
  43. * devices
  44. */
  45. static void omap_fb_output_poll_changed(struct drm_device *dev)
  46. {
  47. struct omap_drm_private *priv = dev->dev_private;
  48. DBG("dev=%p", dev);
  49. if (priv->fbdev)
  50. drm_fb_helper_hotplug_event(priv->fbdev);
  51. }
  52. struct omap_atomic_state_commit {
  53. struct work_struct work;
  54. struct drm_device *dev;
  55. struct drm_atomic_state *state;
  56. u32 crtcs;
  57. };
  58. static void omap_atomic_wait_for_completion(struct drm_device *dev,
  59. struct drm_atomic_state *old_state)
  60. {
  61. struct drm_crtc_state *old_crtc_state;
  62. struct drm_crtc *crtc;
  63. unsigned int i;
  64. int ret;
  65. for_each_crtc_in_state(old_state, crtc, old_crtc_state, i) {
  66. if (!crtc->state->enable)
  67. continue;
  68. ret = omap_crtc_wait_pending(crtc);
  69. if (!ret)
  70. dev_warn(dev->dev,
  71. "atomic complete timeout (pipe %u)!\n", i);
  72. }
  73. }
  74. static void omap_atomic_complete(struct omap_atomic_state_commit *commit)
  75. {
  76. struct drm_device *dev = commit->dev;
  77. struct omap_drm_private *priv = dev->dev_private;
  78. struct drm_atomic_state *old_state = commit->state;
  79. /* Apply the atomic update. */
  80. dispc_runtime_get();
  81. drm_atomic_helper_commit_modeset_disables(dev, old_state);
  82. drm_atomic_helper_commit_planes(dev, old_state, false);
  83. drm_atomic_helper_commit_modeset_enables(dev, old_state);
  84. omap_atomic_wait_for_completion(dev, old_state);
  85. drm_atomic_helper_cleanup_planes(dev, old_state);
  86. dispc_runtime_put();
  87. drm_atomic_state_free(old_state);
  88. /* Complete the commit, wake up any waiter. */
  89. spin_lock(&priv->commit.lock);
  90. priv->commit.pending &= ~commit->crtcs;
  91. spin_unlock(&priv->commit.lock);
  92. wake_up_all(&priv->commit.wait);
  93. kfree(commit);
  94. }
  95. static void omap_atomic_work(struct work_struct *work)
  96. {
  97. struct omap_atomic_state_commit *commit =
  98. container_of(work, struct omap_atomic_state_commit, work);
  99. omap_atomic_complete(commit);
  100. }
  101. static bool omap_atomic_is_pending(struct omap_drm_private *priv,
  102. struct omap_atomic_state_commit *commit)
  103. {
  104. bool pending;
  105. spin_lock(&priv->commit.lock);
  106. pending = priv->commit.pending & commit->crtcs;
  107. spin_unlock(&priv->commit.lock);
  108. return pending;
  109. }
  110. static int omap_atomic_commit(struct drm_device *dev,
  111. struct drm_atomic_state *state, bool nonblock)
  112. {
  113. struct omap_drm_private *priv = dev->dev_private;
  114. struct omap_atomic_state_commit *commit;
  115. unsigned int i;
  116. int ret;
  117. ret = drm_atomic_helper_prepare_planes(dev, state);
  118. if (ret)
  119. return ret;
  120. /* Allocate the commit object. */
  121. commit = kzalloc(sizeof(*commit), GFP_KERNEL);
  122. if (commit == NULL) {
  123. ret = -ENOMEM;
  124. goto error;
  125. }
  126. INIT_WORK(&commit->work, omap_atomic_work);
  127. commit->dev = dev;
  128. commit->state = state;
  129. /* Wait until all affected CRTCs have completed previous commits and
  130. * mark them as pending.
  131. */
  132. for (i = 0; i < dev->mode_config.num_crtc; ++i) {
  133. if (state->crtcs[i])
  134. commit->crtcs |= 1 << drm_crtc_index(state->crtcs[i]);
  135. }
  136. wait_event(priv->commit.wait, !omap_atomic_is_pending(priv, commit));
  137. spin_lock(&priv->commit.lock);
  138. priv->commit.pending |= commit->crtcs;
  139. spin_unlock(&priv->commit.lock);
  140. /* Swap the state, this is the point of no return. */
  141. drm_atomic_helper_swap_state(dev, state);
  142. if (nonblock)
  143. schedule_work(&commit->work);
  144. else
  145. omap_atomic_complete(commit);
  146. return 0;
  147. error:
  148. drm_atomic_helper_cleanup_planes(dev, state);
  149. return ret;
  150. }
  151. static const struct drm_mode_config_funcs omap_mode_config_funcs = {
  152. .fb_create = omap_framebuffer_create,
  153. .output_poll_changed = omap_fb_output_poll_changed,
  154. .atomic_check = drm_atomic_helper_check,
  155. .atomic_commit = omap_atomic_commit,
  156. };
  157. static int get_connector_type(struct omap_dss_device *dssdev)
  158. {
  159. switch (dssdev->type) {
  160. case OMAP_DISPLAY_TYPE_HDMI:
  161. return DRM_MODE_CONNECTOR_HDMIA;
  162. case OMAP_DISPLAY_TYPE_DVI:
  163. return DRM_MODE_CONNECTOR_DVID;
  164. default:
  165. return DRM_MODE_CONNECTOR_Unknown;
  166. }
  167. }
  168. static bool channel_used(struct drm_device *dev, enum omap_channel channel)
  169. {
  170. struct omap_drm_private *priv = dev->dev_private;
  171. int i;
  172. for (i = 0; i < priv->num_crtcs; i++) {
  173. struct drm_crtc *crtc = priv->crtcs[i];
  174. if (omap_crtc_channel(crtc) == channel)
  175. return true;
  176. }
  177. return false;
  178. }
  179. static void omap_disconnect_dssdevs(void)
  180. {
  181. struct omap_dss_device *dssdev = NULL;
  182. for_each_dss_dev(dssdev)
  183. dssdev->driver->disconnect(dssdev);
  184. }
  185. static int omap_connect_dssdevs(void)
  186. {
  187. int r;
  188. struct omap_dss_device *dssdev = NULL;
  189. bool no_displays = true;
  190. for_each_dss_dev(dssdev) {
  191. r = dssdev->driver->connect(dssdev);
  192. if (r == -EPROBE_DEFER) {
  193. omap_dss_put_device(dssdev);
  194. goto cleanup;
  195. } else if (r) {
  196. dev_warn(dssdev->dev, "could not connect display: %s\n",
  197. dssdev->name);
  198. } else {
  199. no_displays = false;
  200. }
  201. }
  202. if (no_displays)
  203. return -EPROBE_DEFER;
  204. return 0;
  205. cleanup:
  206. /*
  207. * if we are deferring probe, we disconnect the devices we previously
  208. * connected
  209. */
  210. omap_disconnect_dssdevs();
  211. return r;
  212. }
  213. static int omap_modeset_create_crtc(struct drm_device *dev, int id,
  214. enum omap_channel channel)
  215. {
  216. struct omap_drm_private *priv = dev->dev_private;
  217. struct drm_plane *plane;
  218. struct drm_crtc *crtc;
  219. plane = omap_plane_init(dev, id, DRM_PLANE_TYPE_PRIMARY);
  220. if (IS_ERR(plane))
  221. return PTR_ERR(plane);
  222. crtc = omap_crtc_init(dev, plane, channel, id);
  223. BUG_ON(priv->num_crtcs >= ARRAY_SIZE(priv->crtcs));
  224. priv->crtcs[id] = crtc;
  225. priv->num_crtcs++;
  226. priv->planes[id] = plane;
  227. priv->num_planes++;
  228. return 0;
  229. }
  230. static int omap_modeset_init_properties(struct drm_device *dev)
  231. {
  232. struct omap_drm_private *priv = dev->dev_private;
  233. if (priv->has_dmm) {
  234. dev->mode_config.rotation_property =
  235. drm_mode_create_rotation_property(dev,
  236. BIT(DRM_ROTATE_0) | BIT(DRM_ROTATE_90) |
  237. BIT(DRM_ROTATE_180) | BIT(DRM_ROTATE_270) |
  238. BIT(DRM_REFLECT_X) | BIT(DRM_REFLECT_Y));
  239. if (!dev->mode_config.rotation_property)
  240. return -ENOMEM;
  241. }
  242. priv->zorder_prop = drm_property_create_range(dev, 0, "zorder", 0, 3);
  243. if (!priv->zorder_prop)
  244. return -ENOMEM;
  245. return 0;
  246. }
  247. static int omap_modeset_init(struct drm_device *dev)
  248. {
  249. struct omap_drm_private *priv = dev->dev_private;
  250. struct omap_dss_device *dssdev = NULL;
  251. int num_ovls = dss_feat_get_num_ovls();
  252. int num_mgrs = dss_feat_get_num_mgrs();
  253. int num_crtcs;
  254. int i, id = 0;
  255. int ret;
  256. drm_mode_config_init(dev);
  257. omap_drm_irq_install(dev);
  258. ret = omap_modeset_init_properties(dev);
  259. if (ret < 0)
  260. return ret;
  261. /*
  262. * We usually don't want to create a CRTC for each manager, at least
  263. * not until we have a way to expose private planes to userspace.
  264. * Otherwise there would not be enough video pipes left for drm planes.
  265. * We use the num_crtc argument to limit the number of crtcs we create.
  266. */
  267. num_crtcs = min3(num_crtc, num_mgrs, num_ovls);
  268. dssdev = NULL;
  269. for_each_dss_dev(dssdev) {
  270. struct drm_connector *connector;
  271. struct drm_encoder *encoder;
  272. enum omap_channel channel;
  273. struct omap_dss_device *out;
  274. if (!omapdss_device_is_connected(dssdev))
  275. continue;
  276. encoder = omap_encoder_init(dev, dssdev);
  277. if (!encoder) {
  278. dev_err(dev->dev, "could not create encoder: %s\n",
  279. dssdev->name);
  280. return -ENOMEM;
  281. }
  282. connector = omap_connector_init(dev,
  283. get_connector_type(dssdev), dssdev, encoder);
  284. if (!connector) {
  285. dev_err(dev->dev, "could not create connector: %s\n",
  286. dssdev->name);
  287. return -ENOMEM;
  288. }
  289. BUG_ON(priv->num_encoders >= ARRAY_SIZE(priv->encoders));
  290. BUG_ON(priv->num_connectors >= ARRAY_SIZE(priv->connectors));
  291. priv->encoders[priv->num_encoders++] = encoder;
  292. priv->connectors[priv->num_connectors++] = connector;
  293. drm_mode_connector_attach_encoder(connector, encoder);
  294. /*
  295. * if we have reached the limit of the crtcs we are allowed to
  296. * create, let's not try to look for a crtc for this
  297. * panel/encoder and onwards, we will, of course, populate the
  298. * the possible_crtcs field for all the encoders with the final
  299. * set of crtcs we create
  300. */
  301. if (id == num_crtcs)
  302. continue;
  303. /*
  304. * get the recommended DISPC channel for this encoder. For now,
  305. * we only try to get create a crtc out of the recommended, the
  306. * other possible channels to which the encoder can connect are
  307. * not considered.
  308. */
  309. out = omapdss_find_output_from_display(dssdev);
  310. channel = out->dispc_channel;
  311. omap_dss_put_device(out);
  312. /*
  313. * if this channel hasn't already been taken by a previously
  314. * allocated crtc, we create a new crtc for it
  315. */
  316. if (!channel_used(dev, channel)) {
  317. ret = omap_modeset_create_crtc(dev, id, channel);
  318. if (ret < 0) {
  319. dev_err(dev->dev,
  320. "could not create CRTC (channel %u)\n",
  321. channel);
  322. return ret;
  323. }
  324. id++;
  325. }
  326. }
  327. /*
  328. * we have allocated crtcs according to the need of the panels/encoders,
  329. * adding more crtcs here if needed
  330. */
  331. for (; id < num_crtcs; id++) {
  332. /* find a free manager for this crtc */
  333. for (i = 0; i < num_mgrs; i++) {
  334. if (!channel_used(dev, i))
  335. break;
  336. }
  337. if (i == num_mgrs) {
  338. /* this shouldn't really happen */
  339. dev_err(dev->dev, "no managers left for crtc\n");
  340. return -ENOMEM;
  341. }
  342. ret = omap_modeset_create_crtc(dev, id, i);
  343. if (ret < 0) {
  344. dev_err(dev->dev,
  345. "could not create CRTC (channel %u)\n", i);
  346. return ret;
  347. }
  348. }
  349. /*
  350. * Create normal planes for the remaining overlays:
  351. */
  352. for (; id < num_ovls; id++) {
  353. struct drm_plane *plane;
  354. plane = omap_plane_init(dev, id, DRM_PLANE_TYPE_OVERLAY);
  355. if (IS_ERR(plane))
  356. return PTR_ERR(plane);
  357. BUG_ON(priv->num_planes >= ARRAY_SIZE(priv->planes));
  358. priv->planes[priv->num_planes++] = plane;
  359. }
  360. for (i = 0; i < priv->num_encoders; i++) {
  361. struct drm_encoder *encoder = priv->encoders[i];
  362. struct omap_dss_device *dssdev =
  363. omap_encoder_get_dssdev(encoder);
  364. struct omap_dss_device *output;
  365. output = omapdss_find_output_from_display(dssdev);
  366. /* figure out which crtc's we can connect the encoder to: */
  367. encoder->possible_crtcs = 0;
  368. for (id = 0; id < priv->num_crtcs; id++) {
  369. struct drm_crtc *crtc = priv->crtcs[id];
  370. enum omap_channel crtc_channel;
  371. crtc_channel = omap_crtc_channel(crtc);
  372. if (output->dispc_channel == crtc_channel) {
  373. encoder->possible_crtcs |= (1 << id);
  374. break;
  375. }
  376. }
  377. omap_dss_put_device(output);
  378. }
  379. DBG("registered %d planes, %d crtcs, %d encoders and %d connectors\n",
  380. priv->num_planes, priv->num_crtcs, priv->num_encoders,
  381. priv->num_connectors);
  382. dev->mode_config.min_width = 32;
  383. dev->mode_config.min_height = 32;
  384. /* note: eventually will need some cpu_is_omapXYZ() type stuff here
  385. * to fill in these limits properly on different OMAP generations..
  386. */
  387. dev->mode_config.max_width = 2048;
  388. dev->mode_config.max_height = 2048;
  389. dev->mode_config.funcs = &omap_mode_config_funcs;
  390. drm_mode_config_reset(dev);
  391. return 0;
  392. }
  393. static void omap_modeset_free(struct drm_device *dev)
  394. {
  395. drm_mode_config_cleanup(dev);
  396. }
  397. /*
  398. * drm ioctl funcs
  399. */
  400. static int ioctl_get_param(struct drm_device *dev, void *data,
  401. struct drm_file *file_priv)
  402. {
  403. struct omap_drm_private *priv = dev->dev_private;
  404. struct drm_omap_param *args = data;
  405. DBG("%p: param=%llu", dev, args->param);
  406. switch (args->param) {
  407. case OMAP_PARAM_CHIPSET_ID:
  408. args->value = priv->omaprev;
  409. break;
  410. default:
  411. DBG("unknown parameter %lld", args->param);
  412. return -EINVAL;
  413. }
  414. return 0;
  415. }
  416. static int ioctl_set_param(struct drm_device *dev, void *data,
  417. struct drm_file *file_priv)
  418. {
  419. struct drm_omap_param *args = data;
  420. switch (args->param) {
  421. default:
  422. DBG("unknown parameter %lld", args->param);
  423. return -EINVAL;
  424. }
  425. return 0;
  426. }
  427. #define OMAP_BO_USER_MASK 0x00ffffff /* flags settable by userspace */
  428. static int ioctl_gem_new(struct drm_device *dev, void *data,
  429. struct drm_file *file_priv)
  430. {
  431. struct drm_omap_gem_new *args = data;
  432. u32 flags = args->flags & OMAP_BO_USER_MASK;
  433. VERB("%p:%p: size=0x%08x, flags=%08x", dev, file_priv,
  434. args->size.bytes, flags);
  435. return omap_gem_new_handle(dev, file_priv, args->size, flags,
  436. &args->handle);
  437. }
  438. static int ioctl_gem_cpu_prep(struct drm_device *dev, void *data,
  439. struct drm_file *file_priv)
  440. {
  441. struct drm_omap_gem_cpu_prep *args = data;
  442. struct drm_gem_object *obj;
  443. int ret;
  444. VERB("%p:%p: handle=%d, op=%x", dev, file_priv, args->handle, args->op);
  445. obj = drm_gem_object_lookup(file_priv, args->handle);
  446. if (!obj)
  447. return -ENOENT;
  448. ret = omap_gem_op_sync(obj, args->op);
  449. if (!ret)
  450. ret = omap_gem_op_start(obj, args->op);
  451. drm_gem_object_unreference_unlocked(obj);
  452. return ret;
  453. }
  454. static int ioctl_gem_cpu_fini(struct drm_device *dev, void *data,
  455. struct drm_file *file_priv)
  456. {
  457. struct drm_omap_gem_cpu_fini *args = data;
  458. struct drm_gem_object *obj;
  459. int ret;
  460. VERB("%p:%p: handle=%d", dev, file_priv, args->handle);
  461. obj = drm_gem_object_lookup(file_priv, args->handle);
  462. if (!obj)
  463. return -ENOENT;
  464. /* XXX flushy, flushy */
  465. ret = 0;
  466. if (!ret)
  467. ret = omap_gem_op_finish(obj, args->op);
  468. drm_gem_object_unreference_unlocked(obj);
  469. return ret;
  470. }
  471. static int ioctl_gem_info(struct drm_device *dev, void *data,
  472. struct drm_file *file_priv)
  473. {
  474. struct drm_omap_gem_info *args = data;
  475. struct drm_gem_object *obj;
  476. int ret = 0;
  477. VERB("%p:%p: handle=%d", dev, file_priv, args->handle);
  478. obj = drm_gem_object_lookup(file_priv, args->handle);
  479. if (!obj)
  480. return -ENOENT;
  481. args->size = omap_gem_mmap_size(obj);
  482. args->offset = omap_gem_mmap_offset(obj);
  483. drm_gem_object_unreference_unlocked(obj);
  484. return ret;
  485. }
  486. static const struct drm_ioctl_desc ioctls[DRM_COMMAND_END - DRM_COMMAND_BASE] = {
  487. DRM_IOCTL_DEF_DRV(OMAP_GET_PARAM, ioctl_get_param, DRM_AUTH),
  488. DRM_IOCTL_DEF_DRV(OMAP_SET_PARAM, ioctl_set_param, DRM_AUTH|DRM_MASTER|DRM_ROOT_ONLY),
  489. DRM_IOCTL_DEF_DRV(OMAP_GEM_NEW, ioctl_gem_new, DRM_AUTH),
  490. DRM_IOCTL_DEF_DRV(OMAP_GEM_CPU_PREP, ioctl_gem_cpu_prep, DRM_AUTH),
  491. DRM_IOCTL_DEF_DRV(OMAP_GEM_CPU_FINI, ioctl_gem_cpu_fini, DRM_AUTH),
  492. DRM_IOCTL_DEF_DRV(OMAP_GEM_INFO, ioctl_gem_info, DRM_AUTH),
  493. };
  494. /*
  495. * drm driver funcs
  496. */
  497. /**
  498. * load - setup chip and create an initial config
  499. * @dev: DRM device
  500. * @flags: startup flags
  501. *
  502. * The driver load routine has to do several things:
  503. * - initialize the memory manager
  504. * - allocate initial config memory
  505. * - setup the DRM framebuffer with the allocated memory
  506. */
  507. static int dev_load(struct drm_device *dev, unsigned long flags)
  508. {
  509. struct omap_drm_platform_data *pdata = dev->dev->platform_data;
  510. struct omap_drm_private *priv;
  511. unsigned int i;
  512. int ret;
  513. DBG("load: dev=%p", dev);
  514. priv = kzalloc(sizeof(*priv), GFP_KERNEL);
  515. if (!priv)
  516. return -ENOMEM;
  517. priv->omaprev = pdata->omaprev;
  518. dev->dev_private = priv;
  519. priv->wq = alloc_ordered_workqueue("omapdrm", 0);
  520. init_waitqueue_head(&priv->commit.wait);
  521. spin_lock_init(&priv->commit.lock);
  522. spin_lock_init(&priv->list_lock);
  523. INIT_LIST_HEAD(&priv->obj_list);
  524. omap_gem_init(dev);
  525. ret = omap_modeset_init(dev);
  526. if (ret) {
  527. dev_err(dev->dev, "omap_modeset_init failed: ret=%d\n", ret);
  528. dev->dev_private = NULL;
  529. kfree(priv);
  530. return ret;
  531. }
  532. /* Initialize vblank handling, start with all CRTCs disabled. */
  533. ret = drm_vblank_init(dev, priv->num_crtcs);
  534. if (ret)
  535. dev_warn(dev->dev, "could not init vblank\n");
  536. for (i = 0; i < priv->num_crtcs; i++)
  537. drm_crtc_vblank_off(priv->crtcs[i]);
  538. priv->fbdev = omap_fbdev_init(dev);
  539. /* store off drm_device for use in pm ops */
  540. dev_set_drvdata(dev->dev, dev);
  541. drm_kms_helper_poll_init(dev);
  542. return 0;
  543. }
  544. static int dev_unload(struct drm_device *dev)
  545. {
  546. struct omap_drm_private *priv = dev->dev_private;
  547. DBG("unload: dev=%p", dev);
  548. drm_kms_helper_poll_fini(dev);
  549. if (priv->fbdev)
  550. omap_fbdev_free(dev);
  551. omap_modeset_free(dev);
  552. omap_gem_deinit(dev);
  553. destroy_workqueue(priv->wq);
  554. drm_vblank_cleanup(dev);
  555. omap_drm_irq_uninstall(dev);
  556. kfree(dev->dev_private);
  557. dev->dev_private = NULL;
  558. dev_set_drvdata(dev->dev, NULL);
  559. return 0;
  560. }
  561. static int dev_open(struct drm_device *dev, struct drm_file *file)
  562. {
  563. file->driver_priv = NULL;
  564. DBG("open: dev=%p, file=%p", dev, file);
  565. return 0;
  566. }
  567. /**
  568. * lastclose - clean up after all DRM clients have exited
  569. * @dev: DRM device
  570. *
  571. * Take care of cleaning up after all DRM clients have exited. In the
  572. * mode setting case, we want to restore the kernel's initial mode (just
  573. * in case the last client left us in a bad state).
  574. */
  575. static void dev_lastclose(struct drm_device *dev)
  576. {
  577. int i;
  578. /* we don't support vga_switcheroo.. so just make sure the fbdev
  579. * mode is active
  580. */
  581. struct omap_drm_private *priv = dev->dev_private;
  582. int ret;
  583. DBG("lastclose: dev=%p", dev);
  584. if (dev->mode_config.rotation_property) {
  585. /* need to restore default rotation state.. not sure
  586. * if there is a cleaner way to restore properties to
  587. * default state? Maybe a flag that properties should
  588. * automatically be restored to default state on
  589. * lastclose?
  590. */
  591. for (i = 0; i < priv->num_crtcs; i++) {
  592. drm_object_property_set_value(&priv->crtcs[i]->base,
  593. dev->mode_config.rotation_property, 0);
  594. }
  595. for (i = 0; i < priv->num_planes; i++) {
  596. drm_object_property_set_value(&priv->planes[i]->base,
  597. dev->mode_config.rotation_property, 0);
  598. }
  599. }
  600. if (priv->fbdev) {
  601. ret = drm_fb_helper_restore_fbdev_mode_unlocked(priv->fbdev);
  602. if (ret)
  603. DBG("failed to restore crtc mode");
  604. }
  605. }
  606. static const struct vm_operations_struct omap_gem_vm_ops = {
  607. .fault = omap_gem_fault,
  608. .open = drm_gem_vm_open,
  609. .close = drm_gem_vm_close,
  610. };
  611. static const struct file_operations omapdriver_fops = {
  612. .owner = THIS_MODULE,
  613. .open = drm_open,
  614. .unlocked_ioctl = drm_ioctl,
  615. .release = drm_release,
  616. .mmap = omap_gem_mmap,
  617. .poll = drm_poll,
  618. .read = drm_read,
  619. .llseek = noop_llseek,
  620. };
  621. static struct drm_driver omap_drm_driver = {
  622. .driver_features = DRIVER_MODESET | DRIVER_GEM | DRIVER_PRIME |
  623. DRIVER_ATOMIC,
  624. .load = dev_load,
  625. .unload = dev_unload,
  626. .open = dev_open,
  627. .lastclose = dev_lastclose,
  628. .set_busid = drm_platform_set_busid,
  629. .get_vblank_counter = drm_vblank_no_hw_counter,
  630. .enable_vblank = omap_irq_enable_vblank,
  631. .disable_vblank = omap_irq_disable_vblank,
  632. #ifdef CONFIG_DEBUG_FS
  633. .debugfs_init = omap_debugfs_init,
  634. .debugfs_cleanup = omap_debugfs_cleanup,
  635. #endif
  636. .prime_handle_to_fd = drm_gem_prime_handle_to_fd,
  637. .prime_fd_to_handle = drm_gem_prime_fd_to_handle,
  638. .gem_prime_export = omap_gem_prime_export,
  639. .gem_prime_import = omap_gem_prime_import,
  640. .gem_free_object = omap_gem_free_object,
  641. .gem_vm_ops = &omap_gem_vm_ops,
  642. .dumb_create = omap_gem_dumb_create,
  643. .dumb_map_offset = omap_gem_dumb_map_offset,
  644. .dumb_destroy = drm_gem_dumb_destroy,
  645. .ioctls = ioctls,
  646. .num_ioctls = DRM_OMAP_NUM_IOCTLS,
  647. .fops = &omapdriver_fops,
  648. .name = DRIVER_NAME,
  649. .desc = DRIVER_DESC,
  650. .date = DRIVER_DATE,
  651. .major = DRIVER_MAJOR,
  652. .minor = DRIVER_MINOR,
  653. .patchlevel = DRIVER_PATCHLEVEL,
  654. };
  655. static int pdev_probe(struct platform_device *device)
  656. {
  657. int r;
  658. if (omapdss_is_initialized() == false)
  659. return -EPROBE_DEFER;
  660. omap_crtc_pre_init();
  661. r = omap_connect_dssdevs();
  662. if (r) {
  663. omap_crtc_pre_uninit();
  664. return r;
  665. }
  666. DBG("%s", device->name);
  667. return drm_platform_init(&omap_drm_driver, device);
  668. }
  669. static int pdev_remove(struct platform_device *device)
  670. {
  671. DBG("");
  672. drm_put_dev(platform_get_drvdata(device));
  673. omap_disconnect_dssdevs();
  674. omap_crtc_pre_uninit();
  675. return 0;
  676. }
  677. #ifdef CONFIG_PM_SLEEP
  678. static int omap_drm_suspend_all_displays(void)
  679. {
  680. struct omap_dss_device *dssdev = NULL;
  681. for_each_dss_dev(dssdev) {
  682. if (!dssdev->driver)
  683. continue;
  684. if (dssdev->state == OMAP_DSS_DISPLAY_ACTIVE) {
  685. dssdev->driver->disable(dssdev);
  686. dssdev->activate_after_resume = true;
  687. } else {
  688. dssdev->activate_after_resume = false;
  689. }
  690. }
  691. return 0;
  692. }
  693. static int omap_drm_resume_all_displays(void)
  694. {
  695. struct omap_dss_device *dssdev = NULL;
  696. for_each_dss_dev(dssdev) {
  697. if (!dssdev->driver)
  698. continue;
  699. if (dssdev->activate_after_resume) {
  700. dssdev->driver->enable(dssdev);
  701. dssdev->activate_after_resume = false;
  702. }
  703. }
  704. return 0;
  705. }
  706. static int omap_drm_suspend(struct device *dev)
  707. {
  708. struct drm_device *drm_dev = dev_get_drvdata(dev);
  709. drm_kms_helper_poll_disable(drm_dev);
  710. drm_modeset_lock_all(drm_dev);
  711. omap_drm_suspend_all_displays();
  712. drm_modeset_unlock_all(drm_dev);
  713. return 0;
  714. }
  715. static int omap_drm_resume(struct device *dev)
  716. {
  717. struct drm_device *drm_dev = dev_get_drvdata(dev);
  718. drm_modeset_lock_all(drm_dev);
  719. omap_drm_resume_all_displays();
  720. drm_modeset_unlock_all(drm_dev);
  721. drm_kms_helper_poll_enable(drm_dev);
  722. return omap_gem_resume(dev);
  723. }
  724. #endif
  725. static SIMPLE_DEV_PM_OPS(omapdrm_pm_ops, omap_drm_suspend, omap_drm_resume);
  726. static struct platform_driver pdev = {
  727. .driver = {
  728. .name = DRIVER_NAME,
  729. .pm = &omapdrm_pm_ops,
  730. },
  731. .probe = pdev_probe,
  732. .remove = pdev_remove,
  733. };
  734. static struct platform_driver * const drivers[] = {
  735. &omap_dmm_driver,
  736. &pdev,
  737. };
  738. static int __init omap_drm_init(void)
  739. {
  740. DBG("init");
  741. return platform_register_drivers(drivers, ARRAY_SIZE(drivers));
  742. }
  743. static void __exit omap_drm_fini(void)
  744. {
  745. DBG("fini");
  746. platform_unregister_drivers(drivers, ARRAY_SIZE(drivers));
  747. }
  748. /* need late_initcall() so we load after dss_driver's are loaded */
  749. late_initcall(omap_drm_init);
  750. module_exit(omap_drm_fini);
  751. MODULE_AUTHOR("Rob Clark <rob@ti.com>");
  752. MODULE_DESCRIPTION("OMAP DRM Display Driver");
  753. MODULE_ALIAS("platform:" DRIVER_NAME);
  754. MODULE_LICENSE("GPL v2");