omapfb-main.c 56 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506
  1. /*
  2. * linux/drivers/video/omap2/omapfb-main.c
  3. *
  4. * Copyright (C) 2008 Nokia Corporation
  5. * Author: Tomi Valkeinen <tomi.valkeinen@nokia.com>
  6. *
  7. * Some code and ideas taken from drivers/video/omap/ driver
  8. * by Imre Deak.
  9. *
  10. * This program is free software; you can redistribute it and/or modify it
  11. * under the terms of the GNU General Public License version 2 as published by
  12. * the Free Software Foundation.
  13. *
  14. * This program is distributed in the hope that it will be useful, but WITHOUT
  15. * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  16. * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
  17. * more details.
  18. *
  19. * You should have received a copy of the GNU General Public License along with
  20. * this program. If not, see <http://www.gnu.org/licenses/>.
  21. */
  22. #include <linux/module.h>
  23. #include <linux/delay.h>
  24. #include <linux/slab.h>
  25. #include <linux/fb.h>
  26. #include <linux/dma-mapping.h>
  27. #include <linux/vmalloc.h>
  28. #include <linux/device.h>
  29. #include <linux/platform_device.h>
  30. #include <linux/omapfb.h>
  31. #include <video/omapdss.h>
  32. #include <plat/vram.h>
  33. #include <plat/vrfb.h>
  34. #include "omapfb.h"
  35. #define MODULE_NAME "omapfb"
  36. #define OMAPFB_PLANE_XRES_MIN 8
  37. #define OMAPFB_PLANE_YRES_MIN 8
  38. static char *def_mode;
  39. static char *def_vram;
  40. static bool def_vrfb;
  41. static int def_rotate;
  42. static bool def_mirror;
  43. static bool auto_update;
  44. static unsigned int auto_update_freq;
  45. module_param(auto_update, bool, 0);
  46. module_param(auto_update_freq, uint, 0644);
  47. #ifdef DEBUG
  48. bool omapfb_debug;
  49. module_param_named(debug, omapfb_debug, bool, 0644);
  50. static bool omapfb_test_pattern;
  51. module_param_named(test, omapfb_test_pattern, bool, 0644);
  52. #endif
  53. static int omapfb_fb_init(struct omapfb2_device *fbdev, struct fb_info *fbi);
  54. static int omapfb_get_recommended_bpp(struct omapfb2_device *fbdev,
  55. struct omap_dss_device *dssdev);
  56. #ifdef DEBUG
  57. static void draw_pixel(struct fb_info *fbi, int x, int y, unsigned color)
  58. {
  59. struct fb_var_screeninfo *var = &fbi->var;
  60. struct fb_fix_screeninfo *fix = &fbi->fix;
  61. void __iomem *addr = fbi->screen_base;
  62. const unsigned bytespp = var->bits_per_pixel >> 3;
  63. const unsigned line_len = fix->line_length / bytespp;
  64. int r = (color >> 16) & 0xff;
  65. int g = (color >> 8) & 0xff;
  66. int b = (color >> 0) & 0xff;
  67. if (var->bits_per_pixel == 16) {
  68. u16 __iomem *p = (u16 __iomem *)addr;
  69. p += y * line_len + x;
  70. r = r * 32 / 256;
  71. g = g * 64 / 256;
  72. b = b * 32 / 256;
  73. __raw_writew((r << 11) | (g << 5) | (b << 0), p);
  74. } else if (var->bits_per_pixel == 24) {
  75. u8 __iomem *p = (u8 __iomem *)addr;
  76. p += (y * line_len + x) * 3;
  77. __raw_writeb(b, p + 0);
  78. __raw_writeb(g, p + 1);
  79. __raw_writeb(r, p + 2);
  80. } else if (var->bits_per_pixel == 32) {
  81. u32 __iomem *p = (u32 __iomem *)addr;
  82. p += y * line_len + x;
  83. __raw_writel(color, p);
  84. }
  85. }
  86. static void fill_fb(struct fb_info *fbi)
  87. {
  88. struct fb_var_screeninfo *var = &fbi->var;
  89. const short w = var->xres_virtual;
  90. const short h = var->yres_virtual;
  91. void __iomem *addr = fbi->screen_base;
  92. int y, x;
  93. if (!addr)
  94. return;
  95. DBG("fill_fb %dx%d, line_len %d bytes\n", w, h, fbi->fix.line_length);
  96. for (y = 0; y < h; y++) {
  97. for (x = 0; x < w; x++) {
  98. if (x < 20 && y < 20)
  99. draw_pixel(fbi, x, y, 0xffffff);
  100. else if (x < 20 && (y > 20 && y < h - 20))
  101. draw_pixel(fbi, x, y, 0xff);
  102. else if (y < 20 && (x > 20 && x < w - 20))
  103. draw_pixel(fbi, x, y, 0xff00);
  104. else if (x > w - 20 && (y > 20 && y < h - 20))
  105. draw_pixel(fbi, x, y, 0xff0000);
  106. else if (y > h - 20 && (x > 20 && x < w - 20))
  107. draw_pixel(fbi, x, y, 0xffff00);
  108. else if (x == 20 || x == w - 20 ||
  109. y == 20 || y == h - 20)
  110. draw_pixel(fbi, x, y, 0xffffff);
  111. else if (x == y || w - x == h - y)
  112. draw_pixel(fbi, x, y, 0xff00ff);
  113. else if (w - x == y || x == h - y)
  114. draw_pixel(fbi, x, y, 0x00ffff);
  115. else if (x > 20 && y > 20 && x < w - 20 && y < h - 20) {
  116. int t = x * 3 / w;
  117. unsigned r = 0, g = 0, b = 0;
  118. unsigned c;
  119. if (var->bits_per_pixel == 16) {
  120. if (t == 0)
  121. b = (y % 32) * 256 / 32;
  122. else if (t == 1)
  123. g = (y % 64) * 256 / 64;
  124. else if (t == 2)
  125. r = (y % 32) * 256 / 32;
  126. } else {
  127. if (t == 0)
  128. b = (y % 256);
  129. else if (t == 1)
  130. g = (y % 256);
  131. else if (t == 2)
  132. r = (y % 256);
  133. }
  134. c = (r << 16) | (g << 8) | (b << 0);
  135. draw_pixel(fbi, x, y, c);
  136. } else {
  137. draw_pixel(fbi, x, y, 0);
  138. }
  139. }
  140. }
  141. }
  142. #endif
  143. static unsigned omapfb_get_vrfb_offset(const struct omapfb_info *ofbi, int rot)
  144. {
  145. const struct vrfb *vrfb = &ofbi->region->vrfb;
  146. unsigned offset;
  147. switch (rot) {
  148. case FB_ROTATE_UR:
  149. offset = 0;
  150. break;
  151. case FB_ROTATE_CW:
  152. offset = vrfb->yoffset;
  153. break;
  154. case FB_ROTATE_UD:
  155. offset = vrfb->yoffset * OMAP_VRFB_LINE_LEN + vrfb->xoffset;
  156. break;
  157. case FB_ROTATE_CCW:
  158. offset = vrfb->xoffset * OMAP_VRFB_LINE_LEN;
  159. break;
  160. default:
  161. BUG();
  162. return 0;
  163. }
  164. offset *= vrfb->bytespp;
  165. return offset;
  166. }
  167. static u32 omapfb_get_region_rot_paddr(const struct omapfb_info *ofbi, int rot)
  168. {
  169. if (ofbi->rotation_type == OMAP_DSS_ROT_VRFB) {
  170. return ofbi->region->vrfb.paddr[rot]
  171. + omapfb_get_vrfb_offset(ofbi, rot);
  172. } else {
  173. return ofbi->region->paddr;
  174. }
  175. }
  176. static u32 omapfb_get_region_paddr(const struct omapfb_info *ofbi)
  177. {
  178. if (ofbi->rotation_type == OMAP_DSS_ROT_VRFB)
  179. return ofbi->region->vrfb.paddr[0];
  180. else
  181. return ofbi->region->paddr;
  182. }
  183. static void __iomem *omapfb_get_region_vaddr(const struct omapfb_info *ofbi)
  184. {
  185. if (ofbi->rotation_type == OMAP_DSS_ROT_VRFB)
  186. return ofbi->region->vrfb.vaddr[0];
  187. else
  188. return ofbi->region->vaddr;
  189. }
  190. static struct omapfb_colormode omapfb_colormodes[] = {
  191. {
  192. .dssmode = OMAP_DSS_COLOR_UYVY,
  193. .bits_per_pixel = 16,
  194. .nonstd = OMAPFB_COLOR_YUV422,
  195. }, {
  196. .dssmode = OMAP_DSS_COLOR_YUV2,
  197. .bits_per_pixel = 16,
  198. .nonstd = OMAPFB_COLOR_YUY422,
  199. }, {
  200. .dssmode = OMAP_DSS_COLOR_ARGB16,
  201. .bits_per_pixel = 16,
  202. .red = { .length = 4, .offset = 8, .msb_right = 0 },
  203. .green = { .length = 4, .offset = 4, .msb_right = 0 },
  204. .blue = { .length = 4, .offset = 0, .msb_right = 0 },
  205. .transp = { .length = 4, .offset = 12, .msb_right = 0 },
  206. }, {
  207. .dssmode = OMAP_DSS_COLOR_RGB16,
  208. .bits_per_pixel = 16,
  209. .red = { .length = 5, .offset = 11, .msb_right = 0 },
  210. .green = { .length = 6, .offset = 5, .msb_right = 0 },
  211. .blue = { .length = 5, .offset = 0, .msb_right = 0 },
  212. .transp = { .length = 0, .offset = 0, .msb_right = 0 },
  213. }, {
  214. .dssmode = OMAP_DSS_COLOR_RGB24P,
  215. .bits_per_pixel = 24,
  216. .red = { .length = 8, .offset = 16, .msb_right = 0 },
  217. .green = { .length = 8, .offset = 8, .msb_right = 0 },
  218. .blue = { .length = 8, .offset = 0, .msb_right = 0 },
  219. .transp = { .length = 0, .offset = 0, .msb_right = 0 },
  220. }, {
  221. .dssmode = OMAP_DSS_COLOR_RGB24U,
  222. .bits_per_pixel = 32,
  223. .red = { .length = 8, .offset = 16, .msb_right = 0 },
  224. .green = { .length = 8, .offset = 8, .msb_right = 0 },
  225. .blue = { .length = 8, .offset = 0, .msb_right = 0 },
  226. .transp = { .length = 0, .offset = 0, .msb_right = 0 },
  227. }, {
  228. .dssmode = OMAP_DSS_COLOR_ARGB32,
  229. .bits_per_pixel = 32,
  230. .red = { .length = 8, .offset = 16, .msb_right = 0 },
  231. .green = { .length = 8, .offset = 8, .msb_right = 0 },
  232. .blue = { .length = 8, .offset = 0, .msb_right = 0 },
  233. .transp = { .length = 8, .offset = 24, .msb_right = 0 },
  234. }, {
  235. .dssmode = OMAP_DSS_COLOR_RGBA32,
  236. .bits_per_pixel = 32,
  237. .red = { .length = 8, .offset = 24, .msb_right = 0 },
  238. .green = { .length = 8, .offset = 16, .msb_right = 0 },
  239. .blue = { .length = 8, .offset = 8, .msb_right = 0 },
  240. .transp = { .length = 8, .offset = 0, .msb_right = 0 },
  241. }, {
  242. .dssmode = OMAP_DSS_COLOR_RGBX32,
  243. .bits_per_pixel = 32,
  244. .red = { .length = 8, .offset = 24, .msb_right = 0 },
  245. .green = { .length = 8, .offset = 16, .msb_right = 0 },
  246. .blue = { .length = 8, .offset = 8, .msb_right = 0 },
  247. .transp = { .length = 0, .offset = 0, .msb_right = 0 },
  248. },
  249. };
  250. static bool cmp_var_to_colormode(struct fb_var_screeninfo *var,
  251. struct omapfb_colormode *color)
  252. {
  253. bool cmp_component(struct fb_bitfield *f1, struct fb_bitfield *f2)
  254. {
  255. return f1->length == f2->length &&
  256. f1->offset == f2->offset &&
  257. f1->msb_right == f2->msb_right;
  258. }
  259. if (var->bits_per_pixel == 0 ||
  260. var->red.length == 0 ||
  261. var->blue.length == 0 ||
  262. var->green.length == 0)
  263. return 0;
  264. return var->bits_per_pixel == color->bits_per_pixel &&
  265. cmp_component(&var->red, &color->red) &&
  266. cmp_component(&var->green, &color->green) &&
  267. cmp_component(&var->blue, &color->blue) &&
  268. cmp_component(&var->transp, &color->transp);
  269. }
  270. static void assign_colormode_to_var(struct fb_var_screeninfo *var,
  271. struct omapfb_colormode *color)
  272. {
  273. var->bits_per_pixel = color->bits_per_pixel;
  274. var->nonstd = color->nonstd;
  275. var->red = color->red;
  276. var->green = color->green;
  277. var->blue = color->blue;
  278. var->transp = color->transp;
  279. }
  280. static int fb_mode_to_dss_mode(struct fb_var_screeninfo *var,
  281. enum omap_color_mode *mode)
  282. {
  283. enum omap_color_mode dssmode;
  284. int i;
  285. /* first match with nonstd field */
  286. if (var->nonstd) {
  287. for (i = 0; i < ARRAY_SIZE(omapfb_colormodes); ++i) {
  288. struct omapfb_colormode *m = &omapfb_colormodes[i];
  289. if (var->nonstd == m->nonstd) {
  290. assign_colormode_to_var(var, m);
  291. *mode = m->dssmode;
  292. return 0;
  293. }
  294. }
  295. return -EINVAL;
  296. }
  297. /* then try exact match of bpp and colors */
  298. for (i = 0; i < ARRAY_SIZE(omapfb_colormodes); ++i) {
  299. struct omapfb_colormode *m = &omapfb_colormodes[i];
  300. if (cmp_var_to_colormode(var, m)) {
  301. assign_colormode_to_var(var, m);
  302. *mode = m->dssmode;
  303. return 0;
  304. }
  305. }
  306. /* match with bpp if user has not filled color fields
  307. * properly */
  308. switch (var->bits_per_pixel) {
  309. case 1:
  310. dssmode = OMAP_DSS_COLOR_CLUT1;
  311. break;
  312. case 2:
  313. dssmode = OMAP_DSS_COLOR_CLUT2;
  314. break;
  315. case 4:
  316. dssmode = OMAP_DSS_COLOR_CLUT4;
  317. break;
  318. case 8:
  319. dssmode = OMAP_DSS_COLOR_CLUT8;
  320. break;
  321. case 12:
  322. dssmode = OMAP_DSS_COLOR_RGB12U;
  323. break;
  324. case 16:
  325. dssmode = OMAP_DSS_COLOR_RGB16;
  326. break;
  327. case 24:
  328. dssmode = OMAP_DSS_COLOR_RGB24P;
  329. break;
  330. case 32:
  331. dssmode = OMAP_DSS_COLOR_RGB24U;
  332. break;
  333. default:
  334. return -EINVAL;
  335. }
  336. for (i = 0; i < ARRAY_SIZE(omapfb_colormodes); ++i) {
  337. struct omapfb_colormode *m = &omapfb_colormodes[i];
  338. if (dssmode == m->dssmode) {
  339. assign_colormode_to_var(var, m);
  340. *mode = m->dssmode;
  341. return 0;
  342. }
  343. }
  344. return -EINVAL;
  345. }
  346. static int check_fb_res_bounds(struct fb_var_screeninfo *var)
  347. {
  348. int xres_min = OMAPFB_PLANE_XRES_MIN;
  349. int xres_max = 2048;
  350. int yres_min = OMAPFB_PLANE_YRES_MIN;
  351. int yres_max = 2048;
  352. /* XXX: some applications seem to set virtual res to 0. */
  353. if (var->xres_virtual == 0)
  354. var->xres_virtual = var->xres;
  355. if (var->yres_virtual == 0)
  356. var->yres_virtual = var->yres;
  357. if (var->xres_virtual < xres_min || var->yres_virtual < yres_min)
  358. return -EINVAL;
  359. if (var->xres < xres_min)
  360. var->xres = xres_min;
  361. if (var->yres < yres_min)
  362. var->yres = yres_min;
  363. if (var->xres > xres_max)
  364. var->xres = xres_max;
  365. if (var->yres > yres_max)
  366. var->yres = yres_max;
  367. if (var->xres > var->xres_virtual)
  368. var->xres = var->xres_virtual;
  369. if (var->yres > var->yres_virtual)
  370. var->yres = var->yres_virtual;
  371. return 0;
  372. }
  373. static void shrink_height(unsigned long max_frame_size,
  374. struct fb_var_screeninfo *var)
  375. {
  376. DBG("can't fit FB into memory, reducing y\n");
  377. var->yres_virtual = max_frame_size /
  378. (var->xres_virtual * var->bits_per_pixel >> 3);
  379. if (var->yres_virtual < OMAPFB_PLANE_YRES_MIN)
  380. var->yres_virtual = OMAPFB_PLANE_YRES_MIN;
  381. if (var->yres > var->yres_virtual)
  382. var->yres = var->yres_virtual;
  383. }
  384. static void shrink_width(unsigned long max_frame_size,
  385. struct fb_var_screeninfo *var)
  386. {
  387. DBG("can't fit FB into memory, reducing x\n");
  388. var->xres_virtual = max_frame_size / var->yres_virtual /
  389. (var->bits_per_pixel >> 3);
  390. if (var->xres_virtual < OMAPFB_PLANE_XRES_MIN)
  391. var->xres_virtual = OMAPFB_PLANE_XRES_MIN;
  392. if (var->xres > var->xres_virtual)
  393. var->xres = var->xres_virtual;
  394. }
  395. static int check_vrfb_fb_size(unsigned long region_size,
  396. const struct fb_var_screeninfo *var)
  397. {
  398. unsigned long min_phys_size = omap_vrfb_min_phys_size(var->xres_virtual,
  399. var->yres_virtual, var->bits_per_pixel >> 3);
  400. return min_phys_size > region_size ? -EINVAL : 0;
  401. }
  402. static int check_fb_size(const struct omapfb_info *ofbi,
  403. struct fb_var_screeninfo *var)
  404. {
  405. unsigned long max_frame_size = ofbi->region->size;
  406. int bytespp = var->bits_per_pixel >> 3;
  407. unsigned long line_size = var->xres_virtual * bytespp;
  408. if (ofbi->rotation_type == OMAP_DSS_ROT_VRFB) {
  409. /* One needs to check for both VRFB and OMAPFB limitations. */
  410. if (check_vrfb_fb_size(max_frame_size, var))
  411. shrink_height(omap_vrfb_max_height(
  412. max_frame_size, var->xres_virtual, bytespp) *
  413. line_size, var);
  414. if (check_vrfb_fb_size(max_frame_size, var)) {
  415. DBG("cannot fit FB to memory\n");
  416. return -EINVAL;
  417. }
  418. return 0;
  419. }
  420. DBG("max frame size %lu, line size %lu\n", max_frame_size, line_size);
  421. if (line_size * var->yres_virtual > max_frame_size)
  422. shrink_height(max_frame_size, var);
  423. if (line_size * var->yres_virtual > max_frame_size) {
  424. shrink_width(max_frame_size, var);
  425. line_size = var->xres_virtual * bytespp;
  426. }
  427. if (line_size * var->yres_virtual > max_frame_size) {
  428. DBG("cannot fit FB to memory\n");
  429. return -EINVAL;
  430. }
  431. return 0;
  432. }
  433. /*
  434. * Consider if VRFB assisted rotation is in use and if the virtual space for
  435. * the zero degree view needs to be mapped. The need for mapping also acts as
  436. * the trigger for setting up the hardware on the context in question. This
  437. * ensures that one does not attempt to access the virtual view before the
  438. * hardware is serving the address translations.
  439. */
  440. static int setup_vrfb_rotation(struct fb_info *fbi)
  441. {
  442. struct omapfb_info *ofbi = FB2OFB(fbi);
  443. struct omapfb2_mem_region *rg = ofbi->region;
  444. struct vrfb *vrfb = &rg->vrfb;
  445. struct fb_var_screeninfo *var = &fbi->var;
  446. struct fb_fix_screeninfo *fix = &fbi->fix;
  447. unsigned bytespp;
  448. bool yuv_mode;
  449. enum omap_color_mode mode;
  450. int r;
  451. bool reconf;
  452. if (!rg->size || ofbi->rotation_type != OMAP_DSS_ROT_VRFB)
  453. return 0;
  454. DBG("setup_vrfb_rotation\n");
  455. r = fb_mode_to_dss_mode(var, &mode);
  456. if (r)
  457. return r;
  458. bytespp = var->bits_per_pixel >> 3;
  459. yuv_mode = mode == OMAP_DSS_COLOR_YUV2 || mode == OMAP_DSS_COLOR_UYVY;
  460. /* We need to reconfigure VRFB if the resolution changes, if yuv mode
  461. * is enabled/disabled, or if bytes per pixel changes */
  462. /* XXX we shouldn't allow this when framebuffer is mmapped */
  463. reconf = false;
  464. if (yuv_mode != vrfb->yuv_mode)
  465. reconf = true;
  466. else if (bytespp != vrfb->bytespp)
  467. reconf = true;
  468. else if (vrfb->xres != var->xres_virtual ||
  469. vrfb->yres != var->yres_virtual)
  470. reconf = true;
  471. if (vrfb->vaddr[0] && reconf) {
  472. fbi->screen_base = NULL;
  473. fix->smem_start = 0;
  474. fix->smem_len = 0;
  475. iounmap(vrfb->vaddr[0]);
  476. vrfb->vaddr[0] = NULL;
  477. DBG("setup_vrfb_rotation: reset fb\n");
  478. }
  479. if (vrfb->vaddr[0])
  480. return 0;
  481. omap_vrfb_setup(&rg->vrfb, rg->paddr,
  482. var->xres_virtual,
  483. var->yres_virtual,
  484. bytespp, yuv_mode);
  485. /* Now one can ioremap the 0 angle view */
  486. r = omap_vrfb_map_angle(vrfb, var->yres_virtual, 0);
  487. if (r)
  488. return r;
  489. /* used by open/write in fbmem.c */
  490. fbi->screen_base = ofbi->region->vrfb.vaddr[0];
  491. fix->smem_start = ofbi->region->vrfb.paddr[0];
  492. switch (var->nonstd) {
  493. case OMAPFB_COLOR_YUV422:
  494. case OMAPFB_COLOR_YUY422:
  495. fix->line_length =
  496. (OMAP_VRFB_LINE_LEN * var->bits_per_pixel) >> 2;
  497. break;
  498. default:
  499. fix->line_length =
  500. (OMAP_VRFB_LINE_LEN * var->bits_per_pixel) >> 3;
  501. break;
  502. }
  503. fix->smem_len = var->yres_virtual * fix->line_length;
  504. return 0;
  505. }
  506. int dss_mode_to_fb_mode(enum omap_color_mode dssmode,
  507. struct fb_var_screeninfo *var)
  508. {
  509. int i;
  510. for (i = 0; i < ARRAY_SIZE(omapfb_colormodes); ++i) {
  511. struct omapfb_colormode *mode = &omapfb_colormodes[i];
  512. if (dssmode == mode->dssmode) {
  513. assign_colormode_to_var(var, mode);
  514. return 0;
  515. }
  516. }
  517. return -ENOENT;
  518. }
  519. void set_fb_fix(struct fb_info *fbi)
  520. {
  521. struct fb_fix_screeninfo *fix = &fbi->fix;
  522. struct fb_var_screeninfo *var = &fbi->var;
  523. struct omapfb_info *ofbi = FB2OFB(fbi);
  524. struct omapfb2_mem_region *rg = ofbi->region;
  525. DBG("set_fb_fix\n");
  526. /* used by open/write in fbmem.c */
  527. fbi->screen_base = (char __iomem *)omapfb_get_region_vaddr(ofbi);
  528. /* used by mmap in fbmem.c */
  529. if (ofbi->rotation_type == OMAP_DSS_ROT_VRFB) {
  530. switch (var->nonstd) {
  531. case OMAPFB_COLOR_YUV422:
  532. case OMAPFB_COLOR_YUY422:
  533. fix->line_length =
  534. (OMAP_VRFB_LINE_LEN * var->bits_per_pixel) >> 2;
  535. break;
  536. default:
  537. fix->line_length =
  538. (OMAP_VRFB_LINE_LEN * var->bits_per_pixel) >> 3;
  539. break;
  540. }
  541. fix->smem_len = var->yres_virtual * fix->line_length;
  542. } else {
  543. fix->line_length =
  544. (var->xres_virtual * var->bits_per_pixel) >> 3;
  545. fix->smem_len = rg->size;
  546. }
  547. fix->smem_start = omapfb_get_region_paddr(ofbi);
  548. fix->type = FB_TYPE_PACKED_PIXELS;
  549. if (var->nonstd)
  550. fix->visual = FB_VISUAL_PSEUDOCOLOR;
  551. else {
  552. switch (var->bits_per_pixel) {
  553. case 32:
  554. case 24:
  555. case 16:
  556. case 12:
  557. fix->visual = FB_VISUAL_TRUECOLOR;
  558. /* 12bpp is stored in 16 bits */
  559. break;
  560. case 1:
  561. case 2:
  562. case 4:
  563. case 8:
  564. fix->visual = FB_VISUAL_PSEUDOCOLOR;
  565. break;
  566. }
  567. }
  568. fix->accel = FB_ACCEL_NONE;
  569. fix->xpanstep = 1;
  570. fix->ypanstep = 1;
  571. }
  572. /* check new var and possibly modify it to be ok */
  573. int check_fb_var(struct fb_info *fbi, struct fb_var_screeninfo *var)
  574. {
  575. struct omapfb_info *ofbi = FB2OFB(fbi);
  576. struct omap_dss_device *display = fb2display(fbi);
  577. enum omap_color_mode mode = 0;
  578. int i;
  579. int r;
  580. DBG("check_fb_var %d\n", ofbi->id);
  581. WARN_ON(!atomic_read(&ofbi->region->lock_count));
  582. r = fb_mode_to_dss_mode(var, &mode);
  583. if (r) {
  584. DBG("cannot convert var to omap dss mode\n");
  585. return r;
  586. }
  587. for (i = 0; i < ofbi->num_overlays; ++i) {
  588. if ((ofbi->overlays[i]->supported_modes & mode) == 0) {
  589. DBG("invalid mode\n");
  590. return -EINVAL;
  591. }
  592. }
  593. if (var->rotate > 3)
  594. return -EINVAL;
  595. if (check_fb_res_bounds(var))
  596. return -EINVAL;
  597. /* When no memory is allocated ignore the size check */
  598. if (ofbi->region->size != 0 && check_fb_size(ofbi, var))
  599. return -EINVAL;
  600. if (var->xres + var->xoffset > var->xres_virtual)
  601. var->xoffset = var->xres_virtual - var->xres;
  602. if (var->yres + var->yoffset > var->yres_virtual)
  603. var->yoffset = var->yres_virtual - var->yres;
  604. DBG("xres = %d, yres = %d, vxres = %d, vyres = %d\n",
  605. var->xres, var->yres,
  606. var->xres_virtual, var->yres_virtual);
  607. if (display && display->driver->get_dimensions) {
  608. u32 w, h;
  609. display->driver->get_dimensions(display, &w, &h);
  610. var->width = DIV_ROUND_CLOSEST(w, 1000);
  611. var->height = DIV_ROUND_CLOSEST(h, 1000);
  612. } else {
  613. var->height = -1;
  614. var->width = -1;
  615. }
  616. var->grayscale = 0;
  617. if (display && display->driver->get_timings) {
  618. struct omap_video_timings timings;
  619. display->driver->get_timings(display, &timings);
  620. /* pixclock in ps, the rest in pixclock */
  621. var->pixclock = timings.pixel_clock != 0 ?
  622. KHZ2PICOS(timings.pixel_clock) :
  623. 0;
  624. var->left_margin = timings.hbp;
  625. var->right_margin = timings.hfp;
  626. var->upper_margin = timings.vbp;
  627. var->lower_margin = timings.vfp;
  628. var->hsync_len = timings.hsw;
  629. var->vsync_len = timings.vsw;
  630. } else {
  631. var->pixclock = 0;
  632. var->left_margin = 0;
  633. var->right_margin = 0;
  634. var->upper_margin = 0;
  635. var->lower_margin = 0;
  636. var->hsync_len = 0;
  637. var->vsync_len = 0;
  638. }
  639. /* TODO: get these from panel->config */
  640. var->vmode = FB_VMODE_NONINTERLACED;
  641. var->sync = 0;
  642. return 0;
  643. }
  644. /*
  645. * ---------------------------------------------------------------------------
  646. * fbdev framework callbacks
  647. * ---------------------------------------------------------------------------
  648. */
  649. static int omapfb_open(struct fb_info *fbi, int user)
  650. {
  651. return 0;
  652. }
  653. static int omapfb_release(struct fb_info *fbi, int user)
  654. {
  655. return 0;
  656. }
  657. static unsigned calc_rotation_offset_dma(const struct fb_var_screeninfo *var,
  658. const struct fb_fix_screeninfo *fix, int rotation)
  659. {
  660. unsigned offset;
  661. offset = var->yoffset * fix->line_length +
  662. var->xoffset * (var->bits_per_pixel >> 3);
  663. return offset;
  664. }
  665. static unsigned calc_rotation_offset_vrfb(const struct fb_var_screeninfo *var,
  666. const struct fb_fix_screeninfo *fix, int rotation)
  667. {
  668. unsigned offset;
  669. if (rotation == FB_ROTATE_UD)
  670. offset = (var->yres_virtual - var->yres) *
  671. fix->line_length;
  672. else if (rotation == FB_ROTATE_CW)
  673. offset = (var->yres_virtual - var->yres) *
  674. (var->bits_per_pixel >> 3);
  675. else
  676. offset = 0;
  677. if (rotation == FB_ROTATE_UR)
  678. offset += var->yoffset * fix->line_length +
  679. var->xoffset * (var->bits_per_pixel >> 3);
  680. else if (rotation == FB_ROTATE_UD)
  681. offset -= var->yoffset * fix->line_length +
  682. var->xoffset * (var->bits_per_pixel >> 3);
  683. else if (rotation == FB_ROTATE_CW)
  684. offset -= var->xoffset * fix->line_length +
  685. var->yoffset * (var->bits_per_pixel >> 3);
  686. else if (rotation == FB_ROTATE_CCW)
  687. offset += var->xoffset * fix->line_length +
  688. var->yoffset * (var->bits_per_pixel >> 3);
  689. return offset;
  690. }
  691. static void omapfb_calc_addr(const struct omapfb_info *ofbi,
  692. const struct fb_var_screeninfo *var,
  693. const struct fb_fix_screeninfo *fix,
  694. int rotation, u32 *paddr)
  695. {
  696. u32 data_start_p;
  697. int offset;
  698. if (ofbi->rotation_type == OMAP_DSS_ROT_VRFB)
  699. data_start_p = omapfb_get_region_rot_paddr(ofbi, rotation);
  700. else
  701. data_start_p = omapfb_get_region_paddr(ofbi);
  702. if (ofbi->rotation_type == OMAP_DSS_ROT_VRFB)
  703. offset = calc_rotation_offset_vrfb(var, fix, rotation);
  704. else
  705. offset = calc_rotation_offset_dma(var, fix, rotation);
  706. data_start_p += offset;
  707. if (offset)
  708. DBG("offset %d, %d = %d\n",
  709. var->xoffset, var->yoffset, offset);
  710. DBG("paddr %x\n", data_start_p);
  711. *paddr = data_start_p;
  712. }
  713. /* setup overlay according to the fb */
  714. int omapfb_setup_overlay(struct fb_info *fbi, struct omap_overlay *ovl,
  715. u16 posx, u16 posy, u16 outw, u16 outh)
  716. {
  717. int r = 0;
  718. struct omapfb_info *ofbi = FB2OFB(fbi);
  719. struct fb_var_screeninfo *var = &fbi->var;
  720. struct fb_fix_screeninfo *fix = &fbi->fix;
  721. enum omap_color_mode mode = 0;
  722. u32 data_start_p = 0;
  723. struct omap_overlay_info info;
  724. int xres, yres;
  725. int screen_width;
  726. int mirror;
  727. int rotation = var->rotate;
  728. int i;
  729. WARN_ON(!atomic_read(&ofbi->region->lock_count));
  730. for (i = 0; i < ofbi->num_overlays; i++) {
  731. if (ovl != ofbi->overlays[i])
  732. continue;
  733. rotation = (rotation + ofbi->rotation[i]) % 4;
  734. break;
  735. }
  736. DBG("setup_overlay %d, posx %d, posy %d, outw %d, outh %d\n", ofbi->id,
  737. posx, posy, outw, outh);
  738. if (rotation == FB_ROTATE_CW || rotation == FB_ROTATE_CCW) {
  739. xres = var->yres;
  740. yres = var->xres;
  741. } else {
  742. xres = var->xres;
  743. yres = var->yres;
  744. }
  745. if (ofbi->region->size)
  746. omapfb_calc_addr(ofbi, var, fix, rotation, &data_start_p);
  747. r = fb_mode_to_dss_mode(var, &mode);
  748. if (r) {
  749. DBG("fb_mode_to_dss_mode failed");
  750. goto err;
  751. }
  752. switch (var->nonstd) {
  753. case OMAPFB_COLOR_YUV422:
  754. case OMAPFB_COLOR_YUY422:
  755. if (ofbi->rotation_type == OMAP_DSS_ROT_VRFB) {
  756. screen_width = fix->line_length
  757. / (var->bits_per_pixel >> 2);
  758. break;
  759. }
  760. default:
  761. screen_width = fix->line_length / (var->bits_per_pixel >> 3);
  762. break;
  763. }
  764. ovl->get_overlay_info(ovl, &info);
  765. if (ofbi->rotation_type == OMAP_DSS_ROT_VRFB)
  766. mirror = 0;
  767. else
  768. mirror = ofbi->mirror;
  769. info.paddr = data_start_p;
  770. info.screen_width = screen_width;
  771. info.width = xres;
  772. info.height = yres;
  773. info.color_mode = mode;
  774. info.rotation_type = ofbi->rotation_type;
  775. info.rotation = rotation;
  776. info.mirror = mirror;
  777. info.pos_x = posx;
  778. info.pos_y = posy;
  779. info.out_width = outw;
  780. info.out_height = outh;
  781. r = ovl->set_overlay_info(ovl, &info);
  782. if (r) {
  783. DBG("ovl->setup_overlay_info failed\n");
  784. goto err;
  785. }
  786. return 0;
  787. err:
  788. DBG("setup_overlay failed\n");
  789. return r;
  790. }
  791. /* apply var to the overlay */
  792. int omapfb_apply_changes(struct fb_info *fbi, int init)
  793. {
  794. int r = 0;
  795. struct omapfb_info *ofbi = FB2OFB(fbi);
  796. struct fb_var_screeninfo *var = &fbi->var;
  797. struct omap_overlay *ovl;
  798. u16 posx, posy;
  799. u16 outw, outh;
  800. int i;
  801. #ifdef DEBUG
  802. if (omapfb_test_pattern)
  803. fill_fb(fbi);
  804. #endif
  805. WARN_ON(!atomic_read(&ofbi->region->lock_count));
  806. for (i = 0; i < ofbi->num_overlays; i++) {
  807. ovl = ofbi->overlays[i];
  808. DBG("apply_changes, fb %d, ovl %d\n", ofbi->id, ovl->id);
  809. if (ofbi->region->size == 0) {
  810. /* the fb is not available. disable the overlay */
  811. omapfb_overlay_enable(ovl, 0);
  812. if (!init && ovl->manager)
  813. ovl->manager->apply(ovl->manager);
  814. continue;
  815. }
  816. if (init || (ovl->caps & OMAP_DSS_OVL_CAP_SCALE) == 0) {
  817. int rotation = (var->rotate + ofbi->rotation[i]) % 4;
  818. if (rotation == FB_ROTATE_CW ||
  819. rotation == FB_ROTATE_CCW) {
  820. outw = var->yres;
  821. outh = var->xres;
  822. } else {
  823. outw = var->xres;
  824. outh = var->yres;
  825. }
  826. } else {
  827. struct omap_overlay_info info;
  828. ovl->get_overlay_info(ovl, &info);
  829. outw = info.out_width;
  830. outh = info.out_height;
  831. }
  832. if (init) {
  833. posx = 0;
  834. posy = 0;
  835. } else {
  836. struct omap_overlay_info info;
  837. ovl->get_overlay_info(ovl, &info);
  838. posx = info.pos_x;
  839. posy = info.pos_y;
  840. }
  841. r = omapfb_setup_overlay(fbi, ovl, posx, posy, outw, outh);
  842. if (r)
  843. goto err;
  844. if (!init && ovl->manager)
  845. ovl->manager->apply(ovl->manager);
  846. }
  847. return 0;
  848. err:
  849. DBG("apply_changes failed\n");
  850. return r;
  851. }
  852. /* checks var and eventually tweaks it to something supported,
  853. * DO NOT MODIFY PAR */
  854. static int omapfb_check_var(struct fb_var_screeninfo *var, struct fb_info *fbi)
  855. {
  856. struct omapfb_info *ofbi = FB2OFB(fbi);
  857. int r;
  858. DBG("check_var(%d)\n", FB2OFB(fbi)->id);
  859. omapfb_get_mem_region(ofbi->region);
  860. r = check_fb_var(fbi, var);
  861. omapfb_put_mem_region(ofbi->region);
  862. return r;
  863. }
  864. /* set the video mode according to info->var */
  865. static int omapfb_set_par(struct fb_info *fbi)
  866. {
  867. struct omapfb_info *ofbi = FB2OFB(fbi);
  868. int r;
  869. DBG("set_par(%d)\n", FB2OFB(fbi)->id);
  870. omapfb_get_mem_region(ofbi->region);
  871. set_fb_fix(fbi);
  872. r = setup_vrfb_rotation(fbi);
  873. if (r)
  874. goto out;
  875. r = omapfb_apply_changes(fbi, 0);
  876. out:
  877. omapfb_put_mem_region(ofbi->region);
  878. return r;
  879. }
  880. static int omapfb_pan_display(struct fb_var_screeninfo *var,
  881. struct fb_info *fbi)
  882. {
  883. struct omapfb_info *ofbi = FB2OFB(fbi);
  884. struct fb_var_screeninfo new_var;
  885. int r;
  886. DBG("pan_display(%d)\n", FB2OFB(fbi)->id);
  887. if (var->xoffset == fbi->var.xoffset &&
  888. var->yoffset == fbi->var.yoffset)
  889. return 0;
  890. new_var = fbi->var;
  891. new_var.xoffset = var->xoffset;
  892. new_var.yoffset = var->yoffset;
  893. fbi->var = new_var;
  894. omapfb_get_mem_region(ofbi->region);
  895. r = omapfb_apply_changes(fbi, 0);
  896. omapfb_put_mem_region(ofbi->region);
  897. return r;
  898. }
  899. static void mmap_user_open(struct vm_area_struct *vma)
  900. {
  901. struct omapfb2_mem_region *rg = vma->vm_private_data;
  902. omapfb_get_mem_region(rg);
  903. atomic_inc(&rg->map_count);
  904. omapfb_put_mem_region(rg);
  905. }
  906. static void mmap_user_close(struct vm_area_struct *vma)
  907. {
  908. struct omapfb2_mem_region *rg = vma->vm_private_data;
  909. omapfb_get_mem_region(rg);
  910. atomic_dec(&rg->map_count);
  911. omapfb_put_mem_region(rg);
  912. }
  913. static struct vm_operations_struct mmap_user_ops = {
  914. .open = mmap_user_open,
  915. .close = mmap_user_close,
  916. };
  917. static int omapfb_mmap(struct fb_info *fbi, struct vm_area_struct *vma)
  918. {
  919. struct omapfb_info *ofbi = FB2OFB(fbi);
  920. struct fb_fix_screeninfo *fix = &fbi->fix;
  921. struct omapfb2_mem_region *rg;
  922. unsigned long off;
  923. unsigned long start;
  924. u32 len;
  925. int r = -EINVAL;
  926. if (vma->vm_end - vma->vm_start == 0)
  927. return 0;
  928. if (vma->vm_pgoff > (~0UL >> PAGE_SHIFT))
  929. return -EINVAL;
  930. off = vma->vm_pgoff << PAGE_SHIFT;
  931. rg = omapfb_get_mem_region(ofbi->region);
  932. start = omapfb_get_region_paddr(ofbi);
  933. len = fix->smem_len;
  934. if (off >= len)
  935. goto error;
  936. if ((vma->vm_end - vma->vm_start + off) > len)
  937. goto error;
  938. off += start;
  939. DBG("user mmap region start %lx, len %d, off %lx\n", start, len, off);
  940. vma->vm_pgoff = off >> PAGE_SHIFT;
  941. vma->vm_flags |= VM_IO | VM_RESERVED;
  942. vma->vm_page_prot = pgprot_writecombine(vma->vm_page_prot);
  943. vma->vm_ops = &mmap_user_ops;
  944. vma->vm_private_data = rg;
  945. if (io_remap_pfn_range(vma, vma->vm_start, off >> PAGE_SHIFT,
  946. vma->vm_end - vma->vm_start,
  947. vma->vm_page_prot)) {
  948. r = -EAGAIN;
  949. goto error;
  950. }
  951. /* vm_ops.open won't be called for mmap itself. */
  952. atomic_inc(&rg->map_count);
  953. omapfb_put_mem_region(rg);
  954. return 0;
  955. error:
  956. omapfb_put_mem_region(ofbi->region);
  957. return r;
  958. }
  959. /* Store a single color palette entry into a pseudo palette or the hardware
  960. * palette if one is available. For now we support only 16bpp and thus store
  961. * the entry only to the pseudo palette.
  962. */
  963. static int _setcolreg(struct fb_info *fbi, u_int regno, u_int red, u_int green,
  964. u_int blue, u_int transp, int update_hw_pal)
  965. {
  966. /*struct omapfb_info *ofbi = FB2OFB(fbi);*/
  967. /*struct omapfb2_device *fbdev = ofbi->fbdev;*/
  968. struct fb_var_screeninfo *var = &fbi->var;
  969. int r = 0;
  970. enum omapfb_color_format mode = OMAPFB_COLOR_RGB24U; /* XXX */
  971. /*switch (plane->color_mode) {*/
  972. switch (mode) {
  973. case OMAPFB_COLOR_YUV422:
  974. case OMAPFB_COLOR_YUV420:
  975. case OMAPFB_COLOR_YUY422:
  976. r = -EINVAL;
  977. break;
  978. case OMAPFB_COLOR_CLUT_8BPP:
  979. case OMAPFB_COLOR_CLUT_4BPP:
  980. case OMAPFB_COLOR_CLUT_2BPP:
  981. case OMAPFB_COLOR_CLUT_1BPP:
  982. /*
  983. if (fbdev->ctrl->setcolreg)
  984. r = fbdev->ctrl->setcolreg(regno, red, green, blue,
  985. transp, update_hw_pal);
  986. */
  987. /* Fallthrough */
  988. r = -EINVAL;
  989. break;
  990. case OMAPFB_COLOR_RGB565:
  991. case OMAPFB_COLOR_RGB444:
  992. case OMAPFB_COLOR_RGB24P:
  993. case OMAPFB_COLOR_RGB24U:
  994. if (r != 0)
  995. break;
  996. if (regno < 16) {
  997. u16 pal;
  998. pal = ((red >> (16 - var->red.length)) <<
  999. var->red.offset) |
  1000. ((green >> (16 - var->green.length)) <<
  1001. var->green.offset) |
  1002. (blue >> (16 - var->blue.length));
  1003. ((u32 *)(fbi->pseudo_palette))[regno] = pal;
  1004. }
  1005. break;
  1006. default:
  1007. BUG();
  1008. }
  1009. return r;
  1010. }
  1011. static int omapfb_setcolreg(u_int regno, u_int red, u_int green, u_int blue,
  1012. u_int transp, struct fb_info *info)
  1013. {
  1014. DBG("setcolreg\n");
  1015. return _setcolreg(info, regno, red, green, blue, transp, 1);
  1016. }
  1017. static int omapfb_setcmap(struct fb_cmap *cmap, struct fb_info *info)
  1018. {
  1019. int count, index, r;
  1020. u16 *red, *green, *blue, *transp;
  1021. u16 trans = 0xffff;
  1022. DBG("setcmap\n");
  1023. red = cmap->red;
  1024. green = cmap->green;
  1025. blue = cmap->blue;
  1026. transp = cmap->transp;
  1027. index = cmap->start;
  1028. for (count = 0; count < cmap->len; count++) {
  1029. if (transp)
  1030. trans = *transp++;
  1031. r = _setcolreg(info, index++, *red++, *green++, *blue++, trans,
  1032. count == cmap->len - 1);
  1033. if (r != 0)
  1034. return r;
  1035. }
  1036. return 0;
  1037. }
  1038. static int omapfb_blank(int blank, struct fb_info *fbi)
  1039. {
  1040. struct omapfb_info *ofbi = FB2OFB(fbi);
  1041. struct omapfb2_device *fbdev = ofbi->fbdev;
  1042. struct omap_dss_device *display = fb2display(fbi);
  1043. struct omapfb_display_data *d;
  1044. int r = 0;
  1045. if (!display)
  1046. return -EINVAL;
  1047. omapfb_lock(fbdev);
  1048. d = get_display_data(fbdev, display);
  1049. switch (blank) {
  1050. case FB_BLANK_UNBLANK:
  1051. if (display->state != OMAP_DSS_DISPLAY_SUSPENDED)
  1052. goto exit;
  1053. if (display->driver->resume)
  1054. r = display->driver->resume(display);
  1055. if ((display->caps & OMAP_DSS_DISPLAY_CAP_MANUAL_UPDATE) &&
  1056. d->update_mode == OMAPFB_AUTO_UPDATE &&
  1057. !d->auto_update_work_enabled)
  1058. omapfb_start_auto_update(fbdev, display);
  1059. break;
  1060. case FB_BLANK_NORMAL:
  1061. /* FB_BLANK_NORMAL could be implemented.
  1062. * Needs DSS additions. */
  1063. case FB_BLANK_VSYNC_SUSPEND:
  1064. case FB_BLANK_HSYNC_SUSPEND:
  1065. case FB_BLANK_POWERDOWN:
  1066. if (display->state != OMAP_DSS_DISPLAY_ACTIVE)
  1067. goto exit;
  1068. if (d->auto_update_work_enabled)
  1069. omapfb_stop_auto_update(fbdev, display);
  1070. if (display->driver->suspend)
  1071. r = display->driver->suspend(display);
  1072. break;
  1073. default:
  1074. r = -EINVAL;
  1075. }
  1076. exit:
  1077. omapfb_unlock(fbdev);
  1078. return r;
  1079. }
  1080. #if 0
  1081. /* XXX fb_read and fb_write are needed for VRFB */
  1082. ssize_t omapfb_write(struct fb_info *info, const char __user *buf,
  1083. size_t count, loff_t *ppos)
  1084. {
  1085. DBG("omapfb_write %d, %lu\n", count, (unsigned long)*ppos);
  1086. /* XXX needed for VRFB */
  1087. return count;
  1088. }
  1089. #endif
  1090. static struct fb_ops omapfb_ops = {
  1091. .owner = THIS_MODULE,
  1092. .fb_open = omapfb_open,
  1093. .fb_release = omapfb_release,
  1094. .fb_fillrect = cfb_fillrect,
  1095. .fb_copyarea = cfb_copyarea,
  1096. .fb_imageblit = cfb_imageblit,
  1097. .fb_blank = omapfb_blank,
  1098. .fb_ioctl = omapfb_ioctl,
  1099. .fb_check_var = omapfb_check_var,
  1100. .fb_set_par = omapfb_set_par,
  1101. .fb_pan_display = omapfb_pan_display,
  1102. .fb_mmap = omapfb_mmap,
  1103. .fb_setcolreg = omapfb_setcolreg,
  1104. .fb_setcmap = omapfb_setcmap,
  1105. /*.fb_write = omapfb_write,*/
  1106. };
  1107. static void omapfb_free_fbmem(struct fb_info *fbi)
  1108. {
  1109. struct omapfb_info *ofbi = FB2OFB(fbi);
  1110. struct omapfb2_device *fbdev = ofbi->fbdev;
  1111. struct omapfb2_mem_region *rg;
  1112. rg = ofbi->region;
  1113. WARN_ON(atomic_read(&rg->map_count));
  1114. if (rg->paddr)
  1115. if (omap_vram_free(rg->paddr, rg->size))
  1116. dev_err(fbdev->dev, "VRAM FREE failed\n");
  1117. if (rg->vaddr)
  1118. iounmap(rg->vaddr);
  1119. if (ofbi->rotation_type == OMAP_DSS_ROT_VRFB) {
  1120. /* unmap the 0 angle rotation */
  1121. if (rg->vrfb.vaddr[0]) {
  1122. iounmap(rg->vrfb.vaddr[0]);
  1123. omap_vrfb_release_ctx(&rg->vrfb);
  1124. rg->vrfb.vaddr[0] = NULL;
  1125. }
  1126. }
  1127. rg->vaddr = NULL;
  1128. rg->paddr = 0;
  1129. rg->alloc = 0;
  1130. rg->size = 0;
  1131. }
  1132. static void clear_fb_info(struct fb_info *fbi)
  1133. {
  1134. memset(&fbi->var, 0, sizeof(fbi->var));
  1135. memset(&fbi->fix, 0, sizeof(fbi->fix));
  1136. strlcpy(fbi->fix.id, MODULE_NAME, sizeof(fbi->fix.id));
  1137. }
  1138. static int omapfb_free_all_fbmem(struct omapfb2_device *fbdev)
  1139. {
  1140. int i;
  1141. DBG("free all fbmem\n");
  1142. for (i = 0; i < fbdev->num_fbs; i++) {
  1143. struct fb_info *fbi = fbdev->fbs[i];
  1144. omapfb_free_fbmem(fbi);
  1145. clear_fb_info(fbi);
  1146. }
  1147. return 0;
  1148. }
  1149. static int omapfb_alloc_fbmem(struct fb_info *fbi, unsigned long size,
  1150. unsigned long paddr)
  1151. {
  1152. struct omapfb_info *ofbi = FB2OFB(fbi);
  1153. struct omapfb2_device *fbdev = ofbi->fbdev;
  1154. struct omapfb2_mem_region *rg;
  1155. void __iomem *vaddr;
  1156. int r;
  1157. rg = ofbi->region;
  1158. rg->paddr = 0;
  1159. rg->vaddr = NULL;
  1160. memset(&rg->vrfb, 0, sizeof rg->vrfb);
  1161. rg->size = 0;
  1162. rg->type = 0;
  1163. rg->alloc = false;
  1164. rg->map = false;
  1165. size = PAGE_ALIGN(size);
  1166. if (!paddr) {
  1167. DBG("allocating %lu bytes for fb %d\n", size, ofbi->id);
  1168. r = omap_vram_alloc(size, &paddr);
  1169. } else {
  1170. DBG("reserving %lu bytes at %lx for fb %d\n", size, paddr,
  1171. ofbi->id);
  1172. r = omap_vram_reserve(paddr, size);
  1173. }
  1174. if (r) {
  1175. dev_err(fbdev->dev, "failed to allocate framebuffer\n");
  1176. return -ENOMEM;
  1177. }
  1178. if (ofbi->rotation_type != OMAP_DSS_ROT_VRFB) {
  1179. vaddr = ioremap_wc(paddr, size);
  1180. if (!vaddr) {
  1181. dev_err(fbdev->dev, "failed to ioremap framebuffer\n");
  1182. omap_vram_free(paddr, size);
  1183. return -ENOMEM;
  1184. }
  1185. DBG("allocated VRAM paddr %lx, vaddr %p\n", paddr, vaddr);
  1186. } else {
  1187. r = omap_vrfb_request_ctx(&rg->vrfb);
  1188. if (r) {
  1189. dev_err(fbdev->dev, "vrfb create ctx failed\n");
  1190. return r;
  1191. }
  1192. vaddr = NULL;
  1193. }
  1194. rg->paddr = paddr;
  1195. rg->vaddr = vaddr;
  1196. rg->size = size;
  1197. rg->alloc = 1;
  1198. return 0;
  1199. }
  1200. /* allocate fbmem using display resolution as reference */
  1201. static int omapfb_alloc_fbmem_display(struct fb_info *fbi, unsigned long size,
  1202. unsigned long paddr)
  1203. {
  1204. struct omapfb_info *ofbi = FB2OFB(fbi);
  1205. struct omapfb2_device *fbdev = ofbi->fbdev;
  1206. struct omap_dss_device *display;
  1207. int bytespp;
  1208. display = fb2display(fbi);
  1209. if (!display)
  1210. return 0;
  1211. switch (omapfb_get_recommended_bpp(fbdev, display)) {
  1212. case 16:
  1213. bytespp = 2;
  1214. break;
  1215. case 24:
  1216. bytespp = 4;
  1217. break;
  1218. default:
  1219. bytespp = 4;
  1220. break;
  1221. }
  1222. if (!size) {
  1223. u16 w, h;
  1224. display->driver->get_resolution(display, &w, &h);
  1225. if (ofbi->rotation_type == OMAP_DSS_ROT_VRFB) {
  1226. size = max(omap_vrfb_min_phys_size(w, h, bytespp),
  1227. omap_vrfb_min_phys_size(h, w, bytespp));
  1228. DBG("adjusting fb mem size for VRFB, %u -> %lu\n",
  1229. w * h * bytespp, size);
  1230. } else {
  1231. size = w * h * bytespp;
  1232. }
  1233. }
  1234. if (!size)
  1235. return 0;
  1236. return omapfb_alloc_fbmem(fbi, size, paddr);
  1237. }
  1238. static int omapfb_parse_vram_param(const char *param, int max_entries,
  1239. unsigned long *sizes, unsigned long *paddrs)
  1240. {
  1241. int fbnum;
  1242. unsigned long size;
  1243. unsigned long paddr = 0;
  1244. char *p, *start;
  1245. start = (char *)param;
  1246. while (1) {
  1247. p = start;
  1248. fbnum = simple_strtoul(p, &p, 10);
  1249. if (p == start)
  1250. return -EINVAL;
  1251. if (*p != ':')
  1252. return -EINVAL;
  1253. if (fbnum >= max_entries)
  1254. return -EINVAL;
  1255. size = memparse(p + 1, &p);
  1256. if (!size)
  1257. return -EINVAL;
  1258. paddr = 0;
  1259. if (*p == '@') {
  1260. paddr = simple_strtoul(p + 1, &p, 16);
  1261. if (!paddr)
  1262. return -EINVAL;
  1263. }
  1264. paddrs[fbnum] = paddr;
  1265. sizes[fbnum] = size;
  1266. if (*p == 0)
  1267. break;
  1268. if (*p != ',')
  1269. return -EINVAL;
  1270. ++p;
  1271. start = p;
  1272. }
  1273. return 0;
  1274. }
  1275. static int omapfb_allocate_all_fbs(struct omapfb2_device *fbdev)
  1276. {
  1277. int i, r;
  1278. unsigned long vram_sizes[10];
  1279. unsigned long vram_paddrs[10];
  1280. memset(&vram_sizes, 0, sizeof(vram_sizes));
  1281. memset(&vram_paddrs, 0, sizeof(vram_paddrs));
  1282. if (def_vram && omapfb_parse_vram_param(def_vram, 10,
  1283. vram_sizes, vram_paddrs)) {
  1284. dev_err(fbdev->dev, "failed to parse vram parameter\n");
  1285. memset(&vram_sizes, 0, sizeof(vram_sizes));
  1286. memset(&vram_paddrs, 0, sizeof(vram_paddrs));
  1287. }
  1288. for (i = 0; i < fbdev->num_fbs; i++) {
  1289. /* allocate memory automatically only for fb0, or if
  1290. * excplicitly defined with vram or plat data option */
  1291. if (i == 0 || vram_sizes[i] != 0) {
  1292. r = omapfb_alloc_fbmem_display(fbdev->fbs[i],
  1293. vram_sizes[i], vram_paddrs[i]);
  1294. if (r)
  1295. return r;
  1296. }
  1297. }
  1298. for (i = 0; i < fbdev->num_fbs; i++) {
  1299. struct omapfb_info *ofbi = FB2OFB(fbdev->fbs[i]);
  1300. struct omapfb2_mem_region *rg;
  1301. rg = ofbi->region;
  1302. DBG("region%d phys %08x virt %p size=%lu\n",
  1303. i,
  1304. rg->paddr,
  1305. rg->vaddr,
  1306. rg->size);
  1307. }
  1308. return 0;
  1309. }
  1310. int omapfb_realloc_fbmem(struct fb_info *fbi, unsigned long size, int type)
  1311. {
  1312. struct omapfb_info *ofbi = FB2OFB(fbi);
  1313. struct omapfb2_device *fbdev = ofbi->fbdev;
  1314. struct omap_dss_device *display = fb2display(fbi);
  1315. struct omapfb2_mem_region *rg = ofbi->region;
  1316. unsigned long old_size = rg->size;
  1317. unsigned long old_paddr = rg->paddr;
  1318. int old_type = rg->type;
  1319. int r;
  1320. if (type != OMAPFB_MEMTYPE_SDRAM)
  1321. return -EINVAL;
  1322. size = PAGE_ALIGN(size);
  1323. if (old_size == size && old_type == type)
  1324. return 0;
  1325. if (display && display->driver->sync)
  1326. display->driver->sync(display);
  1327. omapfb_free_fbmem(fbi);
  1328. if (size == 0) {
  1329. clear_fb_info(fbi);
  1330. return 0;
  1331. }
  1332. r = omapfb_alloc_fbmem(fbi, size, 0);
  1333. if (r) {
  1334. if (old_size)
  1335. omapfb_alloc_fbmem(fbi, old_size, old_paddr);
  1336. if (rg->size == 0)
  1337. clear_fb_info(fbi);
  1338. return r;
  1339. }
  1340. if (old_size == size)
  1341. return 0;
  1342. if (old_size == 0) {
  1343. DBG("initializing fb %d\n", ofbi->id);
  1344. r = omapfb_fb_init(fbdev, fbi);
  1345. if (r) {
  1346. DBG("omapfb_fb_init failed\n");
  1347. goto err;
  1348. }
  1349. r = omapfb_apply_changes(fbi, 1);
  1350. if (r) {
  1351. DBG("omapfb_apply_changes failed\n");
  1352. goto err;
  1353. }
  1354. } else {
  1355. struct fb_var_screeninfo new_var;
  1356. memcpy(&new_var, &fbi->var, sizeof(new_var));
  1357. r = check_fb_var(fbi, &new_var);
  1358. if (r)
  1359. goto err;
  1360. memcpy(&fbi->var, &new_var, sizeof(fbi->var));
  1361. set_fb_fix(fbi);
  1362. r = setup_vrfb_rotation(fbi);
  1363. if (r)
  1364. goto err;
  1365. }
  1366. return 0;
  1367. err:
  1368. omapfb_free_fbmem(fbi);
  1369. clear_fb_info(fbi);
  1370. return r;
  1371. }
  1372. static void omapfb_auto_update_work(struct work_struct *work)
  1373. {
  1374. struct omap_dss_device *dssdev;
  1375. struct omap_dss_driver *dssdrv;
  1376. struct omapfb_display_data *d;
  1377. u16 w, h;
  1378. unsigned int freq;
  1379. struct omapfb2_device *fbdev;
  1380. d = container_of(work, struct omapfb_display_data,
  1381. auto_update_work.work);
  1382. dssdev = d->dssdev;
  1383. dssdrv = dssdev->driver;
  1384. fbdev = d->fbdev;
  1385. if (!dssdrv || !dssdrv->update)
  1386. return;
  1387. if (dssdrv->sync)
  1388. dssdrv->sync(dssdev);
  1389. dssdrv->get_resolution(dssdev, &w, &h);
  1390. dssdrv->update(dssdev, 0, 0, w, h);
  1391. freq = auto_update_freq;
  1392. if (freq == 0)
  1393. freq = 20;
  1394. queue_delayed_work(fbdev->auto_update_wq,
  1395. &d->auto_update_work, HZ / freq);
  1396. }
  1397. void omapfb_start_auto_update(struct omapfb2_device *fbdev,
  1398. struct omap_dss_device *display)
  1399. {
  1400. struct omapfb_display_data *d;
  1401. if (fbdev->auto_update_wq == NULL) {
  1402. struct workqueue_struct *wq;
  1403. wq = create_singlethread_workqueue("omapfb_auto_update");
  1404. if (wq == NULL) {
  1405. dev_err(fbdev->dev, "Failed to create workqueue for "
  1406. "auto-update\n");
  1407. return;
  1408. }
  1409. fbdev->auto_update_wq = wq;
  1410. }
  1411. d = get_display_data(fbdev, display);
  1412. INIT_DELAYED_WORK(&d->auto_update_work, omapfb_auto_update_work);
  1413. d->auto_update_work_enabled = true;
  1414. omapfb_auto_update_work(&d->auto_update_work.work);
  1415. }
  1416. void omapfb_stop_auto_update(struct omapfb2_device *fbdev,
  1417. struct omap_dss_device *display)
  1418. {
  1419. struct omapfb_display_data *d;
  1420. d = get_display_data(fbdev, display);
  1421. cancel_delayed_work_sync(&d->auto_update_work);
  1422. d->auto_update_work_enabled = false;
  1423. }
  1424. /* initialize fb_info, var, fix to something sane based on the display */
  1425. static int omapfb_fb_init(struct omapfb2_device *fbdev, struct fb_info *fbi)
  1426. {
  1427. struct fb_var_screeninfo *var = &fbi->var;
  1428. struct omap_dss_device *display = fb2display(fbi);
  1429. struct omapfb_info *ofbi = FB2OFB(fbi);
  1430. int r = 0;
  1431. fbi->fbops = &omapfb_ops;
  1432. fbi->flags = FBINFO_FLAG_DEFAULT;
  1433. fbi->pseudo_palette = fbdev->pseudo_palette;
  1434. if (ofbi->region->size == 0) {
  1435. clear_fb_info(fbi);
  1436. return 0;
  1437. }
  1438. var->nonstd = 0;
  1439. var->bits_per_pixel = 0;
  1440. var->rotate = def_rotate;
  1441. if (display) {
  1442. u16 w, h;
  1443. int rotation = (var->rotate + ofbi->rotation[0]) % 4;
  1444. display->driver->get_resolution(display, &w, &h);
  1445. if (rotation == FB_ROTATE_CW ||
  1446. rotation == FB_ROTATE_CCW) {
  1447. var->xres = h;
  1448. var->yres = w;
  1449. } else {
  1450. var->xres = w;
  1451. var->yres = h;
  1452. }
  1453. var->xres_virtual = var->xres;
  1454. var->yres_virtual = var->yres;
  1455. if (!var->bits_per_pixel) {
  1456. switch (omapfb_get_recommended_bpp(fbdev, display)) {
  1457. case 16:
  1458. var->bits_per_pixel = 16;
  1459. break;
  1460. case 24:
  1461. var->bits_per_pixel = 32;
  1462. break;
  1463. default:
  1464. dev_err(fbdev->dev, "illegal display "
  1465. "bpp\n");
  1466. return -EINVAL;
  1467. }
  1468. }
  1469. } else {
  1470. /* if there's no display, let's just guess some basic values */
  1471. var->xres = 320;
  1472. var->yres = 240;
  1473. var->xres_virtual = var->xres;
  1474. var->yres_virtual = var->yres;
  1475. if (!var->bits_per_pixel)
  1476. var->bits_per_pixel = 16;
  1477. }
  1478. r = check_fb_var(fbi, var);
  1479. if (r)
  1480. goto err;
  1481. set_fb_fix(fbi);
  1482. r = setup_vrfb_rotation(fbi);
  1483. if (r)
  1484. goto err;
  1485. r = fb_alloc_cmap(&fbi->cmap, 256, 0);
  1486. if (r)
  1487. dev_err(fbdev->dev, "unable to allocate color map memory\n");
  1488. err:
  1489. return r;
  1490. }
  1491. static void fbinfo_cleanup(struct omapfb2_device *fbdev, struct fb_info *fbi)
  1492. {
  1493. fb_dealloc_cmap(&fbi->cmap);
  1494. }
  1495. static void omapfb_free_resources(struct omapfb2_device *fbdev)
  1496. {
  1497. int i;
  1498. DBG("free_resources\n");
  1499. if (fbdev == NULL)
  1500. return;
  1501. for (i = 0; i < fbdev->num_fbs; i++)
  1502. unregister_framebuffer(fbdev->fbs[i]);
  1503. /* free the reserved fbmem */
  1504. omapfb_free_all_fbmem(fbdev);
  1505. for (i = 0; i < fbdev->num_fbs; i++) {
  1506. fbinfo_cleanup(fbdev, fbdev->fbs[i]);
  1507. framebuffer_release(fbdev->fbs[i]);
  1508. }
  1509. for (i = 0; i < fbdev->num_displays; i++) {
  1510. struct omap_dss_device *dssdev = fbdev->displays[i].dssdev;
  1511. if (fbdev->displays[i].auto_update_work_enabled)
  1512. omapfb_stop_auto_update(fbdev, dssdev);
  1513. if (dssdev->state != OMAP_DSS_DISPLAY_DISABLED)
  1514. dssdev->driver->disable(dssdev);
  1515. omap_dss_put_device(dssdev);
  1516. }
  1517. if (fbdev->auto_update_wq != NULL) {
  1518. flush_workqueue(fbdev->auto_update_wq);
  1519. destroy_workqueue(fbdev->auto_update_wq);
  1520. fbdev->auto_update_wq = NULL;
  1521. }
  1522. dev_set_drvdata(fbdev->dev, NULL);
  1523. kfree(fbdev);
  1524. }
  1525. static int omapfb_create_framebuffers(struct omapfb2_device *fbdev)
  1526. {
  1527. int r, i;
  1528. fbdev->num_fbs = 0;
  1529. DBG("create %d framebuffers\n", CONFIG_FB_OMAP2_NUM_FBS);
  1530. /* allocate fb_infos */
  1531. for (i = 0; i < CONFIG_FB_OMAP2_NUM_FBS; i++) {
  1532. struct fb_info *fbi;
  1533. struct omapfb_info *ofbi;
  1534. fbi = framebuffer_alloc(sizeof(struct omapfb_info),
  1535. fbdev->dev);
  1536. if (fbi == NULL) {
  1537. dev_err(fbdev->dev,
  1538. "unable to allocate memory for plane info\n");
  1539. return -ENOMEM;
  1540. }
  1541. clear_fb_info(fbi);
  1542. fbdev->fbs[i] = fbi;
  1543. ofbi = FB2OFB(fbi);
  1544. ofbi->fbdev = fbdev;
  1545. ofbi->id = i;
  1546. ofbi->region = &fbdev->regions[i];
  1547. ofbi->region->id = i;
  1548. init_rwsem(&ofbi->region->lock);
  1549. /* assign these early, so that fb alloc can use them */
  1550. ofbi->rotation_type = def_vrfb ? OMAP_DSS_ROT_VRFB :
  1551. OMAP_DSS_ROT_DMA;
  1552. ofbi->mirror = def_mirror;
  1553. fbdev->num_fbs++;
  1554. }
  1555. DBG("fb_infos allocated\n");
  1556. /* assign overlays for the fbs */
  1557. for (i = 0; i < min(fbdev->num_fbs, fbdev->num_overlays); i++) {
  1558. struct omapfb_info *ofbi = FB2OFB(fbdev->fbs[i]);
  1559. ofbi->overlays[0] = fbdev->overlays[i];
  1560. ofbi->num_overlays = 1;
  1561. }
  1562. /* allocate fb memories */
  1563. r = omapfb_allocate_all_fbs(fbdev);
  1564. if (r) {
  1565. dev_err(fbdev->dev, "failed to allocate fbmem\n");
  1566. return r;
  1567. }
  1568. DBG("fbmems allocated\n");
  1569. /* setup fb_infos */
  1570. for (i = 0; i < fbdev->num_fbs; i++) {
  1571. struct fb_info *fbi = fbdev->fbs[i];
  1572. struct omapfb_info *ofbi = FB2OFB(fbi);
  1573. omapfb_get_mem_region(ofbi->region);
  1574. r = omapfb_fb_init(fbdev, fbi);
  1575. omapfb_put_mem_region(ofbi->region);
  1576. if (r) {
  1577. dev_err(fbdev->dev, "failed to setup fb_info\n");
  1578. return r;
  1579. }
  1580. }
  1581. DBG("fb_infos initialized\n");
  1582. for (i = 0; i < fbdev->num_fbs; i++) {
  1583. r = register_framebuffer(fbdev->fbs[i]);
  1584. if (r != 0) {
  1585. dev_err(fbdev->dev,
  1586. "registering framebuffer %d failed\n", i);
  1587. return r;
  1588. }
  1589. }
  1590. DBG("framebuffers registered\n");
  1591. for (i = 0; i < fbdev->num_fbs; i++) {
  1592. struct fb_info *fbi = fbdev->fbs[i];
  1593. struct omapfb_info *ofbi = FB2OFB(fbi);
  1594. omapfb_get_mem_region(ofbi->region);
  1595. r = omapfb_apply_changes(fbi, 1);
  1596. omapfb_put_mem_region(ofbi->region);
  1597. if (r) {
  1598. dev_err(fbdev->dev, "failed to change mode\n");
  1599. return r;
  1600. }
  1601. }
  1602. /* Enable fb0 */
  1603. if (fbdev->num_fbs > 0) {
  1604. struct omapfb_info *ofbi = FB2OFB(fbdev->fbs[0]);
  1605. if (ofbi->num_overlays > 0) {
  1606. struct omap_overlay *ovl = ofbi->overlays[0];
  1607. ovl->manager->apply(ovl->manager);
  1608. r = omapfb_overlay_enable(ovl, 1);
  1609. if (r) {
  1610. dev_err(fbdev->dev,
  1611. "failed to enable overlay\n");
  1612. return r;
  1613. }
  1614. }
  1615. }
  1616. DBG("create_framebuffers done\n");
  1617. return 0;
  1618. }
  1619. static int omapfb_mode_to_timings(const char *mode_str,
  1620. struct omap_video_timings *timings, u8 *bpp)
  1621. {
  1622. struct fb_info *fbi;
  1623. struct fb_var_screeninfo *var;
  1624. struct fb_ops *fbops;
  1625. int r;
  1626. #ifdef CONFIG_OMAP2_DSS_VENC
  1627. if (strcmp(mode_str, "pal") == 0) {
  1628. *timings = omap_dss_pal_timings;
  1629. *bpp = 24;
  1630. return 0;
  1631. } else if (strcmp(mode_str, "ntsc") == 0) {
  1632. *timings = omap_dss_ntsc_timings;
  1633. *bpp = 24;
  1634. return 0;
  1635. }
  1636. #endif
  1637. /* this is quite a hack, but I wanted to use the modedb and for
  1638. * that we need fb_info and var, so we create dummy ones */
  1639. *bpp = 0;
  1640. fbi = NULL;
  1641. var = NULL;
  1642. fbops = NULL;
  1643. fbi = kzalloc(sizeof(*fbi), GFP_KERNEL);
  1644. if (fbi == NULL) {
  1645. r = -ENOMEM;
  1646. goto err;
  1647. }
  1648. var = kzalloc(sizeof(*var), GFP_KERNEL);
  1649. if (var == NULL) {
  1650. r = -ENOMEM;
  1651. goto err;
  1652. }
  1653. fbops = kzalloc(sizeof(*fbops), GFP_KERNEL);
  1654. if (fbops == NULL) {
  1655. r = -ENOMEM;
  1656. goto err;
  1657. }
  1658. fbi->fbops = fbops;
  1659. r = fb_find_mode(var, fbi, mode_str, NULL, 0, NULL, 24);
  1660. if (r == 0) {
  1661. r = -EINVAL;
  1662. goto err;
  1663. }
  1664. timings->pixel_clock = PICOS2KHZ(var->pixclock);
  1665. timings->hbp = var->left_margin;
  1666. timings->hfp = var->right_margin;
  1667. timings->vbp = var->upper_margin;
  1668. timings->vfp = var->lower_margin;
  1669. timings->hsw = var->hsync_len;
  1670. timings->vsw = var->vsync_len;
  1671. timings->x_res = var->xres;
  1672. timings->y_res = var->yres;
  1673. switch (var->bits_per_pixel) {
  1674. case 16:
  1675. *bpp = 16;
  1676. break;
  1677. case 24:
  1678. case 32:
  1679. default:
  1680. *bpp = 24;
  1681. break;
  1682. }
  1683. r = 0;
  1684. err:
  1685. kfree(fbi);
  1686. kfree(var);
  1687. kfree(fbops);
  1688. return r;
  1689. }
  1690. static int omapfb_set_def_mode(struct omapfb2_device *fbdev,
  1691. struct omap_dss_device *display, char *mode_str)
  1692. {
  1693. int r;
  1694. u8 bpp;
  1695. struct omap_video_timings timings, temp_timings;
  1696. struct omapfb_display_data *d;
  1697. r = omapfb_mode_to_timings(mode_str, &timings, &bpp);
  1698. if (r)
  1699. return r;
  1700. d = get_display_data(fbdev, display);
  1701. d->bpp_override = bpp;
  1702. if (display->driver->check_timings) {
  1703. r = display->driver->check_timings(display, &timings);
  1704. if (r)
  1705. return r;
  1706. } else {
  1707. /* If check_timings is not present compare xres and yres */
  1708. if (display->driver->get_timings) {
  1709. display->driver->get_timings(display, &temp_timings);
  1710. if (temp_timings.x_res != timings.x_res ||
  1711. temp_timings.y_res != timings.y_res)
  1712. return -EINVAL;
  1713. }
  1714. }
  1715. if (display->driver->set_timings)
  1716. display->driver->set_timings(display, &timings);
  1717. return 0;
  1718. }
  1719. static int omapfb_get_recommended_bpp(struct omapfb2_device *fbdev,
  1720. struct omap_dss_device *dssdev)
  1721. {
  1722. struct omapfb_display_data *d;
  1723. BUG_ON(dssdev->driver->get_recommended_bpp == NULL);
  1724. d = get_display_data(fbdev, dssdev);
  1725. if (d->bpp_override != 0)
  1726. return d->bpp_override;
  1727. return dssdev->driver->get_recommended_bpp(dssdev);
  1728. }
  1729. static int omapfb_parse_def_modes(struct omapfb2_device *fbdev)
  1730. {
  1731. char *str, *options, *this_opt;
  1732. int r = 0;
  1733. str = kstrdup(def_mode, GFP_KERNEL);
  1734. if (!str)
  1735. return -ENOMEM;
  1736. options = str;
  1737. while (!r && (this_opt = strsep(&options, ",")) != NULL) {
  1738. char *p, *display_str, *mode_str;
  1739. struct omap_dss_device *display;
  1740. int i;
  1741. p = strchr(this_opt, ':');
  1742. if (!p) {
  1743. r = -EINVAL;
  1744. break;
  1745. }
  1746. *p = 0;
  1747. display_str = this_opt;
  1748. mode_str = p + 1;
  1749. display = NULL;
  1750. for (i = 0; i < fbdev->num_displays; ++i) {
  1751. if (strcmp(fbdev->displays[i].dssdev->name,
  1752. display_str) == 0) {
  1753. display = fbdev->displays[i].dssdev;
  1754. break;
  1755. }
  1756. }
  1757. if (!display) {
  1758. r = -EINVAL;
  1759. break;
  1760. }
  1761. r = omapfb_set_def_mode(fbdev, display, mode_str);
  1762. if (r)
  1763. break;
  1764. }
  1765. kfree(str);
  1766. return r;
  1767. }
  1768. static void fb_videomode_to_omap_timings(struct fb_videomode *m,
  1769. struct omap_video_timings *t)
  1770. {
  1771. t->x_res = m->xres;
  1772. t->y_res = m->yres;
  1773. t->pixel_clock = PICOS2KHZ(m->pixclock);
  1774. t->hsw = m->hsync_len;
  1775. t->hfp = m->right_margin;
  1776. t->hbp = m->left_margin;
  1777. t->vsw = m->vsync_len;
  1778. t->vfp = m->lower_margin;
  1779. t->vbp = m->upper_margin;
  1780. }
  1781. static int omapfb_find_best_mode(struct omap_dss_device *display,
  1782. struct omap_video_timings *timings)
  1783. {
  1784. struct fb_monspecs *specs;
  1785. u8 *edid;
  1786. int r, i, best_xres, best_idx, len;
  1787. if (!display->driver->read_edid)
  1788. return -ENODEV;
  1789. len = 0x80 * 2;
  1790. edid = kmalloc(len, GFP_KERNEL);
  1791. r = display->driver->read_edid(display, edid, len);
  1792. if (r < 0)
  1793. goto err1;
  1794. specs = kzalloc(sizeof(*specs), GFP_KERNEL);
  1795. fb_edid_to_monspecs(edid, specs);
  1796. if (edid[126] > 0)
  1797. fb_edid_add_monspecs(edid + 0x80, specs);
  1798. best_xres = 0;
  1799. best_idx = -1;
  1800. for (i = 0; i < specs->modedb_len; ++i) {
  1801. struct fb_videomode *m;
  1802. struct omap_video_timings t;
  1803. m = &specs->modedb[i];
  1804. if (m->pixclock == 0)
  1805. continue;
  1806. /* skip repeated pixel modes */
  1807. if (m->xres == 2880 || m->xres == 1440)
  1808. continue;
  1809. fb_videomode_to_omap_timings(m, &t);
  1810. r = display->driver->check_timings(display, &t);
  1811. if (r == 0 && best_xres < m->xres) {
  1812. best_xres = m->xres;
  1813. best_idx = i;
  1814. }
  1815. }
  1816. if (best_xres == 0) {
  1817. r = -ENOENT;
  1818. goto err2;
  1819. }
  1820. fb_videomode_to_omap_timings(&specs->modedb[best_idx], timings);
  1821. r = 0;
  1822. err2:
  1823. fb_destroy_modedb(specs->modedb);
  1824. kfree(specs);
  1825. err1:
  1826. kfree(edid);
  1827. return r;
  1828. }
  1829. static int omapfb_init_display(struct omapfb2_device *fbdev,
  1830. struct omap_dss_device *dssdev)
  1831. {
  1832. struct omap_dss_driver *dssdrv = dssdev->driver;
  1833. struct omapfb_display_data *d;
  1834. int r;
  1835. r = dssdrv->enable(dssdev);
  1836. if (r) {
  1837. dev_warn(fbdev->dev, "Failed to enable display '%s'\n",
  1838. dssdev->name);
  1839. return r;
  1840. }
  1841. d = get_display_data(fbdev, dssdev);
  1842. d->fbdev = fbdev;
  1843. if (dssdev->caps & OMAP_DSS_DISPLAY_CAP_MANUAL_UPDATE) {
  1844. u16 w, h;
  1845. if (auto_update) {
  1846. omapfb_start_auto_update(fbdev, dssdev);
  1847. d->update_mode = OMAPFB_AUTO_UPDATE;
  1848. } else {
  1849. d->update_mode = OMAPFB_MANUAL_UPDATE;
  1850. }
  1851. if (dssdrv->enable_te) {
  1852. r = dssdrv->enable_te(dssdev, 1);
  1853. if (r) {
  1854. dev_err(fbdev->dev, "Failed to set TE\n");
  1855. return r;
  1856. }
  1857. }
  1858. dssdrv->get_resolution(dssdev, &w, &h);
  1859. r = dssdrv->update(dssdev, 0, 0, w, h);
  1860. if (r) {
  1861. dev_err(fbdev->dev,
  1862. "Failed to update display\n");
  1863. return r;
  1864. }
  1865. } else {
  1866. d->update_mode = OMAPFB_AUTO_UPDATE;
  1867. }
  1868. return 0;
  1869. }
  1870. static int __init omapfb_probe(struct platform_device *pdev)
  1871. {
  1872. struct omapfb2_device *fbdev = NULL;
  1873. int r = 0;
  1874. int i;
  1875. struct omap_overlay *ovl;
  1876. struct omap_dss_device *def_display;
  1877. struct omap_dss_device *dssdev;
  1878. DBG("omapfb_probe\n");
  1879. if (pdev->num_resources != 0) {
  1880. dev_err(&pdev->dev, "probed for an unknown device\n");
  1881. r = -ENODEV;
  1882. goto err0;
  1883. }
  1884. fbdev = kzalloc(sizeof(struct omapfb2_device), GFP_KERNEL);
  1885. if (fbdev == NULL) {
  1886. r = -ENOMEM;
  1887. goto err0;
  1888. }
  1889. /* TODO : Replace cpu check with omap_has_vrfb once HAS_FEATURE
  1890. * available for OMAP2 and OMAP3
  1891. */
  1892. if (def_vrfb && !cpu_is_omap24xx() && !cpu_is_omap34xx()) {
  1893. def_vrfb = 0;
  1894. dev_warn(&pdev->dev, "VRFB is not supported on this hardware, "
  1895. "ignoring the module parameter vrfb=y\n");
  1896. }
  1897. mutex_init(&fbdev->mtx);
  1898. fbdev->dev = &pdev->dev;
  1899. platform_set_drvdata(pdev, fbdev);
  1900. r = 0;
  1901. fbdev->num_displays = 0;
  1902. dssdev = NULL;
  1903. for_each_dss_dev(dssdev) {
  1904. struct omapfb_display_data *d;
  1905. omap_dss_get_device(dssdev);
  1906. if (!dssdev->driver) {
  1907. dev_warn(&pdev->dev, "no driver for display: %s\n",
  1908. dssdev->name);
  1909. omap_dss_put_device(dssdev);
  1910. continue;
  1911. }
  1912. d = &fbdev->displays[fbdev->num_displays++];
  1913. d->dssdev = dssdev;
  1914. if (dssdev->caps & OMAP_DSS_DISPLAY_CAP_MANUAL_UPDATE)
  1915. d->update_mode = OMAPFB_MANUAL_UPDATE;
  1916. else
  1917. d->update_mode = OMAPFB_AUTO_UPDATE;
  1918. }
  1919. if (r)
  1920. goto cleanup;
  1921. if (fbdev->num_displays == 0) {
  1922. dev_err(&pdev->dev, "no displays\n");
  1923. r = -EINVAL;
  1924. goto cleanup;
  1925. }
  1926. fbdev->num_overlays = omap_dss_get_num_overlays();
  1927. for (i = 0; i < fbdev->num_overlays; i++)
  1928. fbdev->overlays[i] = omap_dss_get_overlay(i);
  1929. fbdev->num_managers = omap_dss_get_num_overlay_managers();
  1930. for (i = 0; i < fbdev->num_managers; i++)
  1931. fbdev->managers[i] = omap_dss_get_overlay_manager(i);
  1932. /* gfx overlay should be the default one. find a display
  1933. * connected to that, and use it as default display */
  1934. ovl = omap_dss_get_overlay(0);
  1935. if (ovl->manager && ovl->manager->device) {
  1936. def_display = ovl->manager->device;
  1937. } else {
  1938. dev_warn(&pdev->dev, "cannot find default display\n");
  1939. def_display = NULL;
  1940. }
  1941. if (def_mode && strlen(def_mode) > 0) {
  1942. if (omapfb_parse_def_modes(fbdev))
  1943. dev_warn(&pdev->dev, "cannot parse default modes\n");
  1944. } else if (def_display && def_display->driver->set_timings &&
  1945. def_display->driver->check_timings) {
  1946. struct omap_video_timings t;
  1947. r = omapfb_find_best_mode(def_display, &t);
  1948. if (r == 0)
  1949. def_display->driver->set_timings(def_display, &t);
  1950. }
  1951. r = omapfb_create_framebuffers(fbdev);
  1952. if (r)
  1953. goto cleanup;
  1954. for (i = 0; i < fbdev->num_managers; i++) {
  1955. struct omap_overlay_manager *mgr;
  1956. mgr = fbdev->managers[i];
  1957. r = mgr->apply(mgr);
  1958. if (r)
  1959. dev_warn(fbdev->dev, "failed to apply dispc config\n");
  1960. }
  1961. DBG("mgr->apply'ed\n");
  1962. if (def_display) {
  1963. r = omapfb_init_display(fbdev, def_display);
  1964. if (r) {
  1965. dev_err(fbdev->dev,
  1966. "failed to initialize default "
  1967. "display\n");
  1968. goto cleanup;
  1969. }
  1970. }
  1971. DBG("create sysfs for fbs\n");
  1972. r = omapfb_create_sysfs(fbdev);
  1973. if (r) {
  1974. dev_err(fbdev->dev, "failed to create sysfs entries\n");
  1975. goto cleanup;
  1976. }
  1977. return 0;
  1978. cleanup:
  1979. omapfb_free_resources(fbdev);
  1980. err0:
  1981. dev_err(&pdev->dev, "failed to setup omapfb\n");
  1982. return r;
  1983. }
  1984. static int __exit omapfb_remove(struct platform_device *pdev)
  1985. {
  1986. struct omapfb2_device *fbdev = platform_get_drvdata(pdev);
  1987. /* FIXME: wait till completion of pending events */
  1988. omapfb_remove_sysfs(fbdev);
  1989. omapfb_free_resources(fbdev);
  1990. return 0;
  1991. }
  1992. static struct platform_driver omapfb_driver = {
  1993. .remove = __exit_p(omapfb_remove),
  1994. .driver = {
  1995. .name = "omapfb",
  1996. .owner = THIS_MODULE,
  1997. },
  1998. };
  1999. static int __init omapfb_init(void)
  2000. {
  2001. DBG("omapfb_init\n");
  2002. if (platform_driver_probe(&omapfb_driver, omapfb_probe)) {
  2003. printk(KERN_ERR "failed to register omapfb driver\n");
  2004. return -ENODEV;
  2005. }
  2006. return 0;
  2007. }
  2008. static void __exit omapfb_exit(void)
  2009. {
  2010. DBG("omapfb_exit\n");
  2011. platform_driver_unregister(&omapfb_driver);
  2012. }
  2013. module_param_named(mode, def_mode, charp, 0);
  2014. module_param_named(vram, def_vram, charp, 0);
  2015. module_param_named(rotate, def_rotate, int, 0);
  2016. module_param_named(vrfb, def_vrfb, bool, 0);
  2017. module_param_named(mirror, def_mirror, bool, 0);
  2018. /* late_initcall to let panel/ctrl drivers loaded first.
  2019. * I guess better option would be a more dynamic approach,
  2020. * so that omapfb reacts to new panels when they are loaded */
  2021. late_initcall(omapfb_init);
  2022. /*module_init(omapfb_init);*/
  2023. module_exit(omapfb_exit);
  2024. MODULE_AUTHOR("Tomi Valkeinen <tomi.valkeinen@nokia.com>");
  2025. MODULE_DESCRIPTION("OMAP2/3 Framebuffer");
  2026. MODULE_LICENSE("GPL v2");