omap_drv.c 22 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965
  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. case OMAP_DISPLAY_TYPE_DSI:
  165. return DRM_MODE_CONNECTOR_DSI;
  166. default:
  167. return DRM_MODE_CONNECTOR_Unknown;
  168. }
  169. }
  170. static bool channel_used(struct drm_device *dev, enum omap_channel channel)
  171. {
  172. struct omap_drm_private *priv = dev->dev_private;
  173. int i;
  174. for (i = 0; i < priv->num_crtcs; i++) {
  175. struct drm_crtc *crtc = priv->crtcs[i];
  176. if (omap_crtc_channel(crtc) == channel)
  177. return true;
  178. }
  179. return false;
  180. }
  181. static void omap_disconnect_dssdevs(void)
  182. {
  183. struct omap_dss_device *dssdev = NULL;
  184. for_each_dss_dev(dssdev)
  185. dssdev->driver->disconnect(dssdev);
  186. }
  187. static int omap_connect_dssdevs(void)
  188. {
  189. int r;
  190. struct omap_dss_device *dssdev = NULL;
  191. bool no_displays = true;
  192. for_each_dss_dev(dssdev) {
  193. r = dssdev->driver->connect(dssdev);
  194. if (r == -EPROBE_DEFER) {
  195. omap_dss_put_device(dssdev);
  196. goto cleanup;
  197. } else if (r) {
  198. dev_warn(dssdev->dev, "could not connect display: %s\n",
  199. dssdev->name);
  200. } else {
  201. no_displays = false;
  202. }
  203. }
  204. if (no_displays)
  205. return -EPROBE_DEFER;
  206. return 0;
  207. cleanup:
  208. /*
  209. * if we are deferring probe, we disconnect the devices we previously
  210. * connected
  211. */
  212. omap_disconnect_dssdevs();
  213. return r;
  214. }
  215. static int omap_modeset_create_crtc(struct drm_device *dev, int id,
  216. enum omap_channel channel)
  217. {
  218. struct omap_drm_private *priv = dev->dev_private;
  219. struct drm_plane *plane;
  220. struct drm_crtc *crtc;
  221. plane = omap_plane_init(dev, id, DRM_PLANE_TYPE_PRIMARY);
  222. if (IS_ERR(plane))
  223. return PTR_ERR(plane);
  224. crtc = omap_crtc_init(dev, plane, channel, id);
  225. BUG_ON(priv->num_crtcs >= ARRAY_SIZE(priv->crtcs));
  226. priv->crtcs[id] = crtc;
  227. priv->num_crtcs++;
  228. priv->planes[id] = plane;
  229. priv->num_planes++;
  230. return 0;
  231. }
  232. static int omap_modeset_init_properties(struct drm_device *dev)
  233. {
  234. struct omap_drm_private *priv = dev->dev_private;
  235. if (priv->has_dmm) {
  236. dev->mode_config.rotation_property =
  237. drm_mode_create_rotation_property(dev,
  238. BIT(DRM_ROTATE_0) | BIT(DRM_ROTATE_90) |
  239. BIT(DRM_ROTATE_180) | BIT(DRM_ROTATE_270) |
  240. BIT(DRM_REFLECT_X) | BIT(DRM_REFLECT_Y));
  241. if (!dev->mode_config.rotation_property)
  242. return -ENOMEM;
  243. }
  244. priv->zorder_prop = drm_property_create_range(dev, 0, "zorder", 0, 3);
  245. if (!priv->zorder_prop)
  246. return -ENOMEM;
  247. return 0;
  248. }
  249. static int omap_modeset_init(struct drm_device *dev)
  250. {
  251. struct omap_drm_private *priv = dev->dev_private;
  252. struct omap_dss_device *dssdev = NULL;
  253. int num_ovls = dss_feat_get_num_ovls();
  254. int num_mgrs = dss_feat_get_num_mgrs();
  255. int num_crtcs;
  256. int i, id = 0;
  257. int ret;
  258. drm_mode_config_init(dev);
  259. omap_drm_irq_install(dev);
  260. ret = omap_modeset_init_properties(dev);
  261. if (ret < 0)
  262. return ret;
  263. /*
  264. * We usually don't want to create a CRTC for each manager, at least
  265. * not until we have a way to expose private planes to userspace.
  266. * Otherwise there would not be enough video pipes left for drm planes.
  267. * We use the num_crtc argument to limit the number of crtcs we create.
  268. */
  269. num_crtcs = min3(num_crtc, num_mgrs, num_ovls);
  270. dssdev = NULL;
  271. for_each_dss_dev(dssdev) {
  272. struct drm_connector *connector;
  273. struct drm_encoder *encoder;
  274. enum omap_channel channel;
  275. struct omap_dss_device *out;
  276. if (!omapdss_device_is_connected(dssdev))
  277. continue;
  278. encoder = omap_encoder_init(dev, dssdev);
  279. if (!encoder) {
  280. dev_err(dev->dev, "could not create encoder: %s\n",
  281. dssdev->name);
  282. return -ENOMEM;
  283. }
  284. connector = omap_connector_init(dev,
  285. get_connector_type(dssdev), dssdev, encoder);
  286. if (!connector) {
  287. dev_err(dev->dev, "could not create connector: %s\n",
  288. dssdev->name);
  289. return -ENOMEM;
  290. }
  291. BUG_ON(priv->num_encoders >= ARRAY_SIZE(priv->encoders));
  292. BUG_ON(priv->num_connectors >= ARRAY_SIZE(priv->connectors));
  293. priv->encoders[priv->num_encoders++] = encoder;
  294. priv->connectors[priv->num_connectors++] = connector;
  295. drm_mode_connector_attach_encoder(connector, encoder);
  296. /*
  297. * if we have reached the limit of the crtcs we are allowed to
  298. * create, let's not try to look for a crtc for this
  299. * panel/encoder and onwards, we will, of course, populate the
  300. * the possible_crtcs field for all the encoders with the final
  301. * set of crtcs we create
  302. */
  303. if (id == num_crtcs)
  304. continue;
  305. /*
  306. * get the recommended DISPC channel for this encoder. For now,
  307. * we only try to get create a crtc out of the recommended, the
  308. * other possible channels to which the encoder can connect are
  309. * not considered.
  310. */
  311. out = omapdss_find_output_from_display(dssdev);
  312. channel = out->dispc_channel;
  313. omap_dss_put_device(out);
  314. /*
  315. * if this channel hasn't already been taken by a previously
  316. * allocated crtc, we create a new crtc for it
  317. */
  318. if (!channel_used(dev, channel)) {
  319. ret = omap_modeset_create_crtc(dev, id, channel);
  320. if (ret < 0) {
  321. dev_err(dev->dev,
  322. "could not create CRTC (channel %u)\n",
  323. channel);
  324. return ret;
  325. }
  326. id++;
  327. }
  328. }
  329. /*
  330. * we have allocated crtcs according to the need of the panels/encoders,
  331. * adding more crtcs here if needed
  332. */
  333. for (; id < num_crtcs; id++) {
  334. /* find a free manager for this crtc */
  335. for (i = 0; i < num_mgrs; i++) {
  336. if (!channel_used(dev, i))
  337. break;
  338. }
  339. if (i == num_mgrs) {
  340. /* this shouldn't really happen */
  341. dev_err(dev->dev, "no managers left for crtc\n");
  342. return -ENOMEM;
  343. }
  344. ret = omap_modeset_create_crtc(dev, id, i);
  345. if (ret < 0) {
  346. dev_err(dev->dev,
  347. "could not create CRTC (channel %u)\n", i);
  348. return ret;
  349. }
  350. }
  351. /*
  352. * Create normal planes for the remaining overlays:
  353. */
  354. for (; id < num_ovls; id++) {
  355. struct drm_plane *plane;
  356. plane = omap_plane_init(dev, id, DRM_PLANE_TYPE_OVERLAY);
  357. if (IS_ERR(plane))
  358. return PTR_ERR(plane);
  359. BUG_ON(priv->num_planes >= ARRAY_SIZE(priv->planes));
  360. priv->planes[priv->num_planes++] = plane;
  361. }
  362. for (i = 0; i < priv->num_encoders; i++) {
  363. struct drm_encoder *encoder = priv->encoders[i];
  364. struct omap_dss_device *dssdev =
  365. omap_encoder_get_dssdev(encoder);
  366. struct omap_dss_device *output;
  367. output = omapdss_find_output_from_display(dssdev);
  368. /* figure out which crtc's we can connect the encoder to: */
  369. encoder->possible_crtcs = 0;
  370. for (id = 0; id < priv->num_crtcs; id++) {
  371. struct drm_crtc *crtc = priv->crtcs[id];
  372. enum omap_channel crtc_channel;
  373. crtc_channel = omap_crtc_channel(crtc);
  374. if (output->dispc_channel == crtc_channel) {
  375. encoder->possible_crtcs |= (1 << id);
  376. break;
  377. }
  378. }
  379. omap_dss_put_device(output);
  380. }
  381. DBG("registered %d planes, %d crtcs, %d encoders and %d connectors\n",
  382. priv->num_planes, priv->num_crtcs, priv->num_encoders,
  383. priv->num_connectors);
  384. dev->mode_config.min_width = 32;
  385. dev->mode_config.min_height = 32;
  386. /* note: eventually will need some cpu_is_omapXYZ() type stuff here
  387. * to fill in these limits properly on different OMAP generations..
  388. */
  389. dev->mode_config.max_width = 2048;
  390. dev->mode_config.max_height = 2048;
  391. dev->mode_config.funcs = &omap_mode_config_funcs;
  392. drm_mode_config_reset(dev);
  393. return 0;
  394. }
  395. static void omap_modeset_free(struct drm_device *dev)
  396. {
  397. drm_mode_config_cleanup(dev);
  398. }
  399. /*
  400. * drm ioctl funcs
  401. */
  402. static int ioctl_get_param(struct drm_device *dev, void *data,
  403. struct drm_file *file_priv)
  404. {
  405. struct omap_drm_private *priv = dev->dev_private;
  406. struct drm_omap_param *args = data;
  407. DBG("%p: param=%llu", dev, args->param);
  408. switch (args->param) {
  409. case OMAP_PARAM_CHIPSET_ID:
  410. args->value = priv->omaprev;
  411. break;
  412. default:
  413. DBG("unknown parameter %lld", args->param);
  414. return -EINVAL;
  415. }
  416. return 0;
  417. }
  418. static int ioctl_set_param(struct drm_device *dev, void *data,
  419. struct drm_file *file_priv)
  420. {
  421. struct drm_omap_param *args = data;
  422. switch (args->param) {
  423. default:
  424. DBG("unknown parameter %lld", args->param);
  425. return -EINVAL;
  426. }
  427. return 0;
  428. }
  429. #define OMAP_BO_USER_MASK 0x00ffffff /* flags settable by userspace */
  430. static int ioctl_gem_new(struct drm_device *dev, void *data,
  431. struct drm_file *file_priv)
  432. {
  433. struct drm_omap_gem_new *args = data;
  434. u32 flags = args->flags & OMAP_BO_USER_MASK;
  435. VERB("%p:%p: size=0x%08x, flags=%08x", dev, file_priv,
  436. args->size.bytes, flags);
  437. return omap_gem_new_handle(dev, file_priv, args->size, flags,
  438. &args->handle);
  439. }
  440. static int ioctl_gem_cpu_prep(struct drm_device *dev, void *data,
  441. struct drm_file *file_priv)
  442. {
  443. struct drm_omap_gem_cpu_prep *args = data;
  444. struct drm_gem_object *obj;
  445. int ret;
  446. VERB("%p:%p: handle=%d, op=%x", dev, file_priv, args->handle, args->op);
  447. obj = drm_gem_object_lookup(file_priv, args->handle);
  448. if (!obj)
  449. return -ENOENT;
  450. ret = omap_gem_op_sync(obj, args->op);
  451. if (!ret)
  452. ret = omap_gem_op_start(obj, args->op);
  453. drm_gem_object_unreference_unlocked(obj);
  454. return ret;
  455. }
  456. static int ioctl_gem_cpu_fini(struct drm_device *dev, void *data,
  457. struct drm_file *file_priv)
  458. {
  459. struct drm_omap_gem_cpu_fini *args = data;
  460. struct drm_gem_object *obj;
  461. int ret;
  462. VERB("%p:%p: handle=%d", dev, file_priv, args->handle);
  463. obj = drm_gem_object_lookup(file_priv, args->handle);
  464. if (!obj)
  465. return -ENOENT;
  466. /* XXX flushy, flushy */
  467. ret = 0;
  468. if (!ret)
  469. ret = omap_gem_op_finish(obj, args->op);
  470. drm_gem_object_unreference_unlocked(obj);
  471. return ret;
  472. }
  473. static int ioctl_gem_info(struct drm_device *dev, void *data,
  474. struct drm_file *file_priv)
  475. {
  476. struct drm_omap_gem_info *args = data;
  477. struct drm_gem_object *obj;
  478. int ret = 0;
  479. VERB("%p:%p: handle=%d", dev, file_priv, args->handle);
  480. obj = drm_gem_object_lookup(file_priv, args->handle);
  481. if (!obj)
  482. return -ENOENT;
  483. args->size = omap_gem_mmap_size(obj);
  484. args->offset = omap_gem_mmap_offset(obj);
  485. drm_gem_object_unreference_unlocked(obj);
  486. return ret;
  487. }
  488. static const struct drm_ioctl_desc ioctls[DRM_COMMAND_END - DRM_COMMAND_BASE] = {
  489. DRM_IOCTL_DEF_DRV(OMAP_GET_PARAM, ioctl_get_param, DRM_AUTH),
  490. DRM_IOCTL_DEF_DRV(OMAP_SET_PARAM, ioctl_set_param, DRM_AUTH|DRM_MASTER|DRM_ROOT_ONLY),
  491. DRM_IOCTL_DEF_DRV(OMAP_GEM_NEW, ioctl_gem_new, DRM_AUTH),
  492. DRM_IOCTL_DEF_DRV(OMAP_GEM_CPU_PREP, ioctl_gem_cpu_prep, DRM_AUTH),
  493. DRM_IOCTL_DEF_DRV(OMAP_GEM_CPU_FINI, ioctl_gem_cpu_fini, DRM_AUTH),
  494. DRM_IOCTL_DEF_DRV(OMAP_GEM_INFO, ioctl_gem_info, DRM_AUTH),
  495. };
  496. /*
  497. * drm driver funcs
  498. */
  499. /**
  500. * load - setup chip and create an initial config
  501. * @dev: DRM device
  502. * @flags: startup flags
  503. *
  504. * The driver load routine has to do several things:
  505. * - initialize the memory manager
  506. * - allocate initial config memory
  507. * - setup the DRM framebuffer with the allocated memory
  508. */
  509. static int dev_load(struct drm_device *dev, unsigned long flags)
  510. {
  511. struct omap_drm_platform_data *pdata = dev->dev->platform_data;
  512. struct omap_drm_private *priv;
  513. unsigned int i;
  514. int ret;
  515. DBG("load: dev=%p", dev);
  516. priv = kzalloc(sizeof(*priv), GFP_KERNEL);
  517. if (!priv)
  518. return -ENOMEM;
  519. priv->omaprev = pdata->omaprev;
  520. dev->dev_private = priv;
  521. priv->wq = alloc_ordered_workqueue("omapdrm", 0);
  522. init_waitqueue_head(&priv->commit.wait);
  523. spin_lock_init(&priv->commit.lock);
  524. spin_lock_init(&priv->list_lock);
  525. INIT_LIST_HEAD(&priv->obj_list);
  526. omap_gem_init(dev);
  527. ret = omap_modeset_init(dev);
  528. if (ret) {
  529. dev_err(dev->dev, "omap_modeset_init failed: ret=%d\n", ret);
  530. dev->dev_private = NULL;
  531. kfree(priv);
  532. return ret;
  533. }
  534. /* Initialize vblank handling, start with all CRTCs disabled. */
  535. ret = drm_vblank_init(dev, priv->num_crtcs);
  536. if (ret)
  537. dev_warn(dev->dev, "could not init vblank\n");
  538. for (i = 0; i < priv->num_crtcs; i++)
  539. drm_crtc_vblank_off(priv->crtcs[i]);
  540. priv->fbdev = omap_fbdev_init(dev);
  541. /* store off drm_device for use in pm ops */
  542. dev_set_drvdata(dev->dev, dev);
  543. drm_kms_helper_poll_init(dev);
  544. return 0;
  545. }
  546. static int dev_unload(struct drm_device *dev)
  547. {
  548. struct omap_drm_private *priv = dev->dev_private;
  549. DBG("unload: dev=%p", dev);
  550. drm_kms_helper_poll_fini(dev);
  551. if (priv->fbdev)
  552. omap_fbdev_free(dev);
  553. omap_modeset_free(dev);
  554. omap_gem_deinit(dev);
  555. destroy_workqueue(priv->wq);
  556. drm_vblank_cleanup(dev);
  557. omap_drm_irq_uninstall(dev);
  558. kfree(dev->dev_private);
  559. dev->dev_private = NULL;
  560. dev_set_drvdata(dev->dev, NULL);
  561. return 0;
  562. }
  563. static int dev_open(struct drm_device *dev, struct drm_file *file)
  564. {
  565. file->driver_priv = NULL;
  566. DBG("open: dev=%p, file=%p", dev, file);
  567. return 0;
  568. }
  569. /**
  570. * lastclose - clean up after all DRM clients have exited
  571. * @dev: DRM device
  572. *
  573. * Take care of cleaning up after all DRM clients have exited. In the
  574. * mode setting case, we want to restore the kernel's initial mode (just
  575. * in case the last client left us in a bad state).
  576. */
  577. static void dev_lastclose(struct drm_device *dev)
  578. {
  579. int i;
  580. /* we don't support vga_switcheroo.. so just make sure the fbdev
  581. * mode is active
  582. */
  583. struct omap_drm_private *priv = dev->dev_private;
  584. int ret;
  585. DBG("lastclose: dev=%p", dev);
  586. if (dev->mode_config.rotation_property) {
  587. /* need to restore default rotation state.. not sure
  588. * if there is a cleaner way to restore properties to
  589. * default state? Maybe a flag that properties should
  590. * automatically be restored to default state on
  591. * lastclose?
  592. */
  593. for (i = 0; i < priv->num_crtcs; i++) {
  594. drm_object_property_set_value(&priv->crtcs[i]->base,
  595. dev->mode_config.rotation_property, 0);
  596. }
  597. for (i = 0; i < priv->num_planes; i++) {
  598. drm_object_property_set_value(&priv->planes[i]->base,
  599. dev->mode_config.rotation_property, 0);
  600. }
  601. }
  602. if (priv->fbdev) {
  603. ret = drm_fb_helper_restore_fbdev_mode_unlocked(priv->fbdev);
  604. if (ret)
  605. DBG("failed to restore crtc mode");
  606. }
  607. }
  608. static const struct vm_operations_struct omap_gem_vm_ops = {
  609. .fault = omap_gem_fault,
  610. .open = drm_gem_vm_open,
  611. .close = drm_gem_vm_close,
  612. };
  613. static const struct file_operations omapdriver_fops = {
  614. .owner = THIS_MODULE,
  615. .open = drm_open,
  616. .unlocked_ioctl = drm_ioctl,
  617. .release = drm_release,
  618. .mmap = omap_gem_mmap,
  619. .poll = drm_poll,
  620. .read = drm_read,
  621. .llseek = noop_llseek,
  622. };
  623. static struct drm_driver omap_drm_driver = {
  624. .driver_features = DRIVER_MODESET | DRIVER_GEM | DRIVER_PRIME |
  625. DRIVER_ATOMIC,
  626. .load = dev_load,
  627. .unload = dev_unload,
  628. .open = dev_open,
  629. .lastclose = dev_lastclose,
  630. .set_busid = drm_platform_set_busid,
  631. .get_vblank_counter = drm_vblank_no_hw_counter,
  632. .enable_vblank = omap_irq_enable_vblank,
  633. .disable_vblank = omap_irq_disable_vblank,
  634. #ifdef CONFIG_DEBUG_FS
  635. .debugfs_init = omap_debugfs_init,
  636. .debugfs_cleanup = omap_debugfs_cleanup,
  637. #endif
  638. .prime_handle_to_fd = drm_gem_prime_handle_to_fd,
  639. .prime_fd_to_handle = drm_gem_prime_fd_to_handle,
  640. .gem_prime_export = omap_gem_prime_export,
  641. .gem_prime_import = omap_gem_prime_import,
  642. .gem_free_object = omap_gem_free_object,
  643. .gem_vm_ops = &omap_gem_vm_ops,
  644. .dumb_create = omap_gem_dumb_create,
  645. .dumb_map_offset = omap_gem_dumb_map_offset,
  646. .dumb_destroy = drm_gem_dumb_destroy,
  647. .ioctls = ioctls,
  648. .num_ioctls = DRM_OMAP_NUM_IOCTLS,
  649. .fops = &omapdriver_fops,
  650. .name = DRIVER_NAME,
  651. .desc = DRIVER_DESC,
  652. .date = DRIVER_DATE,
  653. .major = DRIVER_MAJOR,
  654. .minor = DRIVER_MINOR,
  655. .patchlevel = DRIVER_PATCHLEVEL,
  656. };
  657. static int pdev_probe(struct platform_device *device)
  658. {
  659. int r;
  660. if (omapdss_is_initialized() == false)
  661. return -EPROBE_DEFER;
  662. omap_crtc_pre_init();
  663. r = omap_connect_dssdevs();
  664. if (r) {
  665. omap_crtc_pre_uninit();
  666. return r;
  667. }
  668. DBG("%s", device->name);
  669. return drm_platform_init(&omap_drm_driver, device);
  670. }
  671. static int pdev_remove(struct platform_device *device)
  672. {
  673. DBG("");
  674. drm_put_dev(platform_get_drvdata(device));
  675. omap_disconnect_dssdevs();
  676. omap_crtc_pre_uninit();
  677. return 0;
  678. }
  679. #ifdef CONFIG_PM_SLEEP
  680. static int omap_drm_suspend_all_displays(void)
  681. {
  682. struct omap_dss_device *dssdev = NULL;
  683. for_each_dss_dev(dssdev) {
  684. if (!dssdev->driver)
  685. continue;
  686. if (dssdev->state == OMAP_DSS_DISPLAY_ACTIVE) {
  687. dssdev->driver->disable(dssdev);
  688. dssdev->activate_after_resume = true;
  689. } else {
  690. dssdev->activate_after_resume = false;
  691. }
  692. }
  693. return 0;
  694. }
  695. static int omap_drm_resume_all_displays(void)
  696. {
  697. struct omap_dss_device *dssdev = NULL;
  698. for_each_dss_dev(dssdev) {
  699. if (!dssdev->driver)
  700. continue;
  701. if (dssdev->activate_after_resume) {
  702. dssdev->driver->enable(dssdev);
  703. dssdev->activate_after_resume = false;
  704. }
  705. }
  706. return 0;
  707. }
  708. static int omap_drm_suspend(struct device *dev)
  709. {
  710. struct drm_device *drm_dev = dev_get_drvdata(dev);
  711. drm_kms_helper_poll_disable(drm_dev);
  712. drm_modeset_lock_all(drm_dev);
  713. omap_drm_suspend_all_displays();
  714. drm_modeset_unlock_all(drm_dev);
  715. return 0;
  716. }
  717. static int omap_drm_resume(struct device *dev)
  718. {
  719. struct drm_device *drm_dev = dev_get_drvdata(dev);
  720. drm_modeset_lock_all(drm_dev);
  721. omap_drm_resume_all_displays();
  722. drm_modeset_unlock_all(drm_dev);
  723. drm_kms_helper_poll_enable(drm_dev);
  724. return omap_gem_resume(dev);
  725. }
  726. #endif
  727. static SIMPLE_DEV_PM_OPS(omapdrm_pm_ops, omap_drm_suspend, omap_drm_resume);
  728. static struct platform_driver pdev = {
  729. .driver = {
  730. .name = DRIVER_NAME,
  731. .pm = &omapdrm_pm_ops,
  732. },
  733. .probe = pdev_probe,
  734. .remove = pdev_remove,
  735. };
  736. static struct platform_driver * const drivers[] = {
  737. &omap_dmm_driver,
  738. &pdev,
  739. };
  740. static int __init omap_drm_init(void)
  741. {
  742. DBG("init");
  743. return platform_register_drivers(drivers, ARRAY_SIZE(drivers));
  744. }
  745. static void __exit omap_drm_fini(void)
  746. {
  747. DBG("fini");
  748. platform_unregister_drivers(drivers, ARRAY_SIZE(drivers));
  749. }
  750. /* need late_initcall() so we load after dss_driver's are loaded */
  751. late_initcall(omap_drm_init);
  752. module_exit(omap_drm_fini);
  753. MODULE_AUTHOR("Rob Clark <rob@ti.com>");
  754. MODULE_DESCRIPTION("OMAP DRM Display Driver");
  755. MODULE_ALIAS("platform:" DRIVER_NAME);
  756. MODULE_LICENSE("GPL v2");