开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 嵌入式/单片机编程 > 嵌入式Linux > 查看源码
sa1100fb.c
资源名称：SBC-2410X_kernel.tar.gz　[点击查看]
上传用户：lgb322
上传日期：2013-02-24
资源大小：30529k
文件大小：59k
源码类别：

嵌入式Linux

开发平台：

Unix_Linux

sa1100fb.c：源码内容
  1. /*
  2.  *  linux/drivers/video/sa1100fb.c
  3.  *
  4.  *  Copyright (C) 1999 Eric A. Thomas
  5.  *   Based on acornfb.c Copyright (C) Russell King.
  6.  *
  7.  * This file is subject to the terms and conditions of the GNU General Public
  8.  * License.  See the file COPYING in the main directory of this archive for
  9.  * more details.
  10.  *
  11.  *         StrongARM 1100 LCD Controller Frame Buffer Driver
  12.  *
  13.  * Please direct your questions and comments on this driver to the following
  14.  * email address:
  15.  *
  16.  * linux-arm-kernel@lists.arm.linux.org.uk
  17.  *
  18.  * Clean patches should be sent to the ARM Linux Patch System.  Please see the
  19.  * following web page for more information:
  20.  *
  21.  * http://www.arm.linux.org.uk/developer/patches/info.shtml
  22.  *
  23.  * Thank you.
  24.  *
  25.  * Known problems:
  26.  * - With the Neponset plugged into an Assabet, LCD powerdown
  27.  *   doesn't work (LCD stays powered up).  Therefore we shouldn't
  28.  *   blank the screen.
  29.  * - We don't limit the CPU clock rate nor the mode selection
  30.  *   according to the available SDRAM bandwidth.
  31.  *
  32.  * Other notes:
  33.  * - Linear grayscale palettes and the kernel.
  34.  *   Such code does not belong in the kernel.  The kernel frame buffer
  35.  *   drivers do not expect a linear colourmap, but a colourmap based on
  36.  *   the VT100 standard mapping.
  37.  *
  38.  *   If your _userspace_ requires a linear colourmap, then the setup of
  39.  *   such a colourmap belongs _in userspace_, not in the kernel.  Code
  40.  *   to set the colourmap correctly from user space has been sent to
  41.  *   David Neuer.  It's around 8 lines of C code, plus another 4 to
  42.  *   detect if we are using grayscale.
  43.  *
  44.  * - The following must never be specified in a panel definition:
  45.  *      LCCR0_LtlEnd, LCCR3_PixClkDiv, LCCR3_VrtSnchL, LCCR3_HorSnchL
  46.  *
  47.  * - The following should be specified:
  48.  *      either LCCR0_Color or LCCR0_Mono
  49.  *      either LCCR0_Sngl or LCCR0_Dual
  50.  *      either LCCR0_Act or LCCR0_Pas
  51.  *      either LCCR3_OutEnH or LCCD3_OutEnL
  52.  *      either LCCR3_PixRsEdg or LCCR3_PixFlEdg
  53.  *      either LCCR3_ACBsDiv or LCCR3_ACBsCntOff
  54.  *
  55.  * Code Status:
  56.  * 1999/04/01:
  57.  * - Driver appears to be working for Brutus 320x200x8bpp mode.  Other
  58.  *   resolutions are working, but only the 8bpp mode is supported.
  59.  *   Changes need to be made to the palette encode and decode routines
  60.  *   to support 4 and 16 bpp modes.  
  61.  *   Driver is not designed to be a module.  The FrameBuffer is statically
  62.  *   allocated since dynamic allocation of a 300k buffer cannot be 
  63.  *   guaranteed. 
  64.  *
  65.  * 1999/06/17:
  66.  * - FrameBuffer memory is now allocated at run-time when the
  67.  *   driver is initialized.    
  68.  *
  69.  * 2000/04/10: Nicolas Pitre <nico@cam.org>
  70.  * - Big cleanup for dynamic selection of machine type at run time.
  71.  *
  72.  * 2000/07/19: Jamey Hicks <jamey@crl.dec.com>
  73.  * - Support for Bitsy aka Compaq iPAQ H3600 added.
  74.  *
  75.  * 2000/08/07: Tak-Shing Chan <tchan.rd@idthk.com>
  76.  *        Jeff Sutherland <jsutherland@accelent.com>
  77.  * - Resolved an issue caused by a change made to the Assabet's PLD 
  78.  *   earlier this year which broke the framebuffer driver for newer 
  79.  *   Phase 4 Assabets.  Some other parameters were changed to optimize
  80.  *   for the Sharp display.
  81.  *
  82.  * 2000/08/09: Kunihiko IMAI <imai@vasara.co.jp>
  83.  * - XP860 support added
  84.  *
  85.  * 2000/08/19: Mark Huang <mhuang@livetoy.com>
  86.  * - Allows standard options to be passed on the kernel command line
  87.  *   for most common passive displays.
  88.  *
  89.  * 2000/08/29:
  90.  * - s/save_flags_cli/local_irq_save/
  91.  * - remove unneeded extra save_flags_cli in sa1100fb_enable_lcd_controller
  92.  *
  93.  * 2000/10/10: Erik Mouw <J.A.K.Mouw@its.tudelft.nl>
  94.  * - Updated LART stuff. Fixed some minor bugs.
  95.  *
  96.  * 2000/10/30: Murphy Chen <murphy@mail.dialogue.com.tw>
  97.  * - Pangolin support added
  98.  *
  99.  * 2000/10/31: Roman Jordan <jor@hoeft-wessel.de>
  100.  * - Huw Webpanel support added
  101.  *
  102.  * 2000/11/23: Eric Peng <ericpeng@coventive.com>
  103.  * - Freebird add
  104.  *
  105.  * 2001/02/07: Jamey Hicks <jamey.hicks@compaq.com> 
  106.  *        Cliff Brake <cbrake@accelent.com>
  107.  * - Added PM callback
  108.  *
  109.  * 2001/05/26: <rmk@arm.linux.org.uk>
  110.  * - Fix 16bpp so that (a) we use the right colours rather than some
  111.  *   totally random colour depending on what was in page 0, and (b)
  112.  *   we don't de-reference a NULL pointer.
  113.  * - remove duplicated implementation of consistent_alloc()
  114.  * - convert dma address types to dma_addr_t
  115.  * - remove unused 'montype' stuff
  116.  * - remove redundant zero inits of init_var after the initial
  117.  *   memzero.
  118.  * - remove allow_modeset (acornfb idea does not belong here)
  119.  *
  120.  * 2001/05/28: <rmk@arm.linux.org.uk>
  121.  * - massive cleanup - move machine dependent data into structures
  122.  * - I've left various #warnings in - if you see one, and know
  123.  *   the hardware concerned, please get in contact with me.
  124.  *
  125.  * 2001/05/31: <rmk@arm.linux.org.uk>
  126.  * - Fix LCCR1 HSW value, fix all machine type specifications to
  127.  *   keep values in line.  (Please check your machine type specs)
  128.  *
  129.  * 2001/06/10: <rmk@arm.linux.org.uk>
  130.  * - Fiddle with the LCD controller from task context only; mainly
  131.  *   so that we can run with interrupts on, and sleep.
  132.  * - Convert #warnings into #errors.  No pain, no gain. ;)
  133.  *
  134.  * 2001/06/14: <rmk@arm.linux.org.uk>
  135.  * - Make the palette BPS value for 12bpp come out correctly.
  136.  * - Take notice of "greyscale" on any colour depth.
  137.  * - Make truecolor visuals use the RGB channel encoding information.
  138.  *
  139.  * 2001/07/02: <rmk@arm.linux.org.uk>
  140.  * - Fix colourmap problems.
  141.  *
  142.  * 2001/07/13: <abraham@2d3d.co.za>
  143.  * - Added support for the ICP LCD-Kit01 on LART. This LCD is
  144.  *   manufactured by Prime View, model no V16C6448AB
  145.  *
  146.  * 2001/07/23: <rmk@arm.linux.org.uk>
  147.  * - Hand merge version from handhelds.org CVS tree.  See patch
  148.  *   notes for 595/1 for more information.
  149.  * - Drop 12bpp (it's 16bpp with different colour register mappings).
  150.  * - This hardware can not do direct colour.  Therefore we don't
  151.  *   support it.
  152.  *
  153.  * 2001/07/27: <rmk@arm.linux.org.uk>
  154.  * - Halve YRES on dual scan LCDs.
  155.  *
  156.  * 2001/08/22: <rmk@arm.linux.org.uk>
  157.  * - Add b/w iPAQ pixclock value.
  158.  *
  159.  * 2001/10/12: <rmk@arm.linux.org.uk>
  160.  * - Add patch 681/1 and clean up stork definitions.
  161.  *
  162.  * 2002/02/21: <abraham@2d3d.co.za>
  163.  *  - Added support for ICP LCD-Kit01 on Frodo.
  164.  *  - Added support for backlight via CPLDs on Frodo.
  165.  */
  167. #include <linux/config.h>
  168. #include <linux/module.h>
  169. #include <linux/kernel.h>
  170. #include <linux/sched.h>
  171. #include <linux/errno.h>
  172. #include <linux/string.h>
  173. #include <linux/interrupt.h>
  174. #include <linux/slab.h>
  175. #include <linux/fb.h>
  176. #include <linux/delay.h>
  177. #include <linux/pm.h>
  178. #include <linux/init.h>
  179. #include <linux/cpufreq.h>
  181. #include <asm/hardware.h>
  182. #include <asm/io.h>
  183. #include <asm/irq.h>
  184. #include <asm/mach-types.h>
  185. #include <asm/uaccess.h>
  186. #include <asm/arch/assabet.h>
  187. #include <asm/arch/shannon.h>
  189. #include <video/fbcon.h>
  190. #include <video/fbcon-mfb.h>
  191. #include <video/fbcon-cfb4.h>
  192. #include <video/fbcon-cfb8.h>
  193. #include <video/fbcon-cfb16.h>
  195. /*
  196.  * debugging?
  197.  */
  198. #define DEBUG 0
  199. /*
  200.  * Complain if VAR is out of range.
  201.  */
  202. #define DEBUG_VAR 1
  204. #undef ASSABET_PAL_VIDEO
  206. #include "sa1100fb.h"
  208. void (*sa1100fb_blank_helper)(int blank);
  209. EXPORT_SYMBOL(sa1100fb_blank_helper);
  211. /*
  212.  * IMHO this looks wrong.  In 8BPP, length should be 8.
  213.  */
  214. static struct sa1100fb_rgb rgb_8 = {
  215. red: { offset: 0,  length: 4, },
  216. green: { offset: 0,  length: 4, },
  217. blue: { offset: 0,  length: 4, },
  218. transp: { offset: 0,  length: 0, },
  219. };
  221. static struct sa1100fb_rgb def_rgb_16 = {
  222. red: { offset: 11, length: 5, },
  223. green: { offset: 5,  length: 6, },
  224. blue: { offset: 0,  length: 5, },
  225. transp: { offset: 0,  length: 0, },
  226. };
  228. #ifdef CONFIG_SA1100_ASSABET
  229. #ifndef ASSABET_PAL_VIDEO
  230. /*
  231.  * The assabet uses a sharp LQ039Q2DS54 LCD module.  It is actually
  232.  * takes an RGB666 signal, but we provide it with an RGB565 signal
  233.  * instead (def_rgb_16).
  234.  */
  235. static struct sa1100fb_mach_info lq039q2ds54_info __initdata = {
  236. pixclock: 171521, bpp: 16,
  237. xres: 320, yres: 240,
  239. hsync_len: 5, vsync_len: 1,
  240. left_margin: 61, upper_margin: 3,
  241. right_margin: 9, lower_margin: 0,
  243. sync: FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
  245. lccr0: LCCR0_Color | LCCR0_Sngl | LCCR0_Act,
  246. lccr3: LCCR3_OutEnH | LCCR3_PixRsEdg | LCCR3_ACBsDiv(2),
  247. };
  248. #else
  249. static struct sa1100fb_mach_info pal_info __initdata = {
  250. pixclock: 67797, bpp: 16,
  251. xres: 640, yres: 512,
  253. hsync_len: 64, vsync_len: 6,
  254. left_margin: 125, upper_margin: 70,
  255. right_margin: 115, lower_margin: 36,
  257. sync: 0,
  259. lccr0: LCCR0_Color | LCCR0_Sngl | LCCR0_Act,
  260. lccr3: LCCR3_OutEnH | LCCR3_PixRsEdg | LCCR3_ACBsDiv(512),
  261. };
  262. #endif
  263. #endif
  265. #ifdef CONFIG_SA1100_H3XXX
  266. static struct sa1100fb_mach_info h3800_info __initdata = {
  267. pixclock: 174757,  bpp: 16,
  268. xres: 320, yres: 240,
  270. hsync_len: 3, vsync_len: 3,
  271. left_margin: 12, upper_margin: 10,
  272. right_margin: 17, lower_margin: 1,
  274. sync: 0, cmap_static: 1,
  276. lccr0: LCCR0_Color | LCCR0_Sngl | LCCR0_Act,
  277. lccr3: LCCR3_ACBsCntOff | LCCR3_PixFlEdg | LCCR3_OutEnH,
  278. };
  280. static struct sa1100fb_mach_info h3600_info __initdata = {
  281. pixclock: 174757,  bpp: 16,
  282. xres: 320, yres: 240,
  284. hsync_len: 3, vsync_len: 3,
  285. left_margin: 12, upper_margin: 10,
  286. right_margin: 17, lower_margin: 1,
  288. sync: 0, cmap_static: 1,
  290. lccr0: LCCR0_Color | LCCR0_Sngl | LCCR0_Act,
  291. lccr3: LCCR3_ACBsCntOff | LCCR3_OutEnH | LCCR3_PixFlEdg,
  292. };
  294. static struct sa1100fb_rgb h3600_rgb_16 = {
  295. red: { offset: 12, length: 4, },
  296. green: { offset: 7,  length: 4, },
  297. blue: { offset: 1,  length: 4, },
  298. transp: { offset: 0,  length: 0, },
  299. };
  301. static struct sa1100fb_mach_info h3100_info __initdata = {
  302. pixclock: 406977,  bpp: 4,
  303. xres: 320, yres: 240,
  305. hsync_len: 26, vsync_len: 41,
  306. left_margin: 4, upper_margin: 0,
  307. right_margin: 4, lower_margin: 0,
  309. sync: FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
  310. cmap_greyscale: 1,
  311. cmap_inverse: 1,
  313. lccr0: LCCR0_Mono | LCCR0_4PixMono | LCCR0_Sngl | LCCR0_Pas,
  314. lccr3: LCCR3_OutEnH | LCCR3_PixRsEdg | LCCR3_ACBsDiv(2),
  315. };
  316. #endif
  318. #ifdef CONFIG_SA1100_BRUTUS
  319. static struct sa1100fb_mach_info brutus_info __initdata = {
  320. pixclock: 0, bpp: 8,
  321. xres: 320, yres: 240,
  323. hsync_len: 3, vsync_len: 1,
  324. left_margin: 41, upper_margin: 0,
  325. right_margin: 101, lower_margin: 0,
  327. sync: FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
  329. lccr0: LCCR0_Color | LCCR0_Sngl | LCCR0_Pas,
  330. lccr3: LCCR3_OutEnH | LCCR3_PixRsEdg | LCCR3_ACBsDiv(2) |
  331. LCCR3_PixClkDiv(44),
  332. };
  333. #endif
  335. #ifdef CONFIG_SA1100_CERF
  336. static struct sa1100fb_mach_info cerf_info __initdata = {
  337. #if defined(CONFIG_CERF_LCD_72_A)
  338. pixclock:       171521,         bpp:            8,
  339. xres: 640, yres: 480,
  340. lccr0: LCCR0_Color | LCCR0_Dual | LCCR0_Pas,
  341. lccr3: LCCR3_OutEnH | LCCR3_PixRsEdg | LCCR3_ACBsDiv(2) |
  342. LCCR3_PixClkDiv(38),
  343. #elif defined(CONFIG_CERF_LCD_57_A)
  344. pixclock:       171521,         bpp:            8,
  345. xres: 320, yres: 240,
  346. lccr0: LCCR0_Color | LCCR0_Sngl | LCCR0_Pas,
  347. lccr3: LCCR3_OutEnH | LCCR3_PixRsEdg | LCCR3_ACBsDiv(2) |
  348. LCCR3_PixClkDiv(38),
  349. #elif defined(CONFIG_CERF_LCD_38_A)
  350. pixclock:       171521,         bpp:            8,
  351. xres: 240, yres: 320,
  352. lccr0: LCCR0_Color | LCCR0_Sngl | LCCR0_Pas,
  353. lccr3: LCCR3_OutEnH | LCCR3_PixRsEdg | LCCR3_ACBsDiv(56) |
  354. LCCR3_PixClkDiv(38),
  355. #elif defined(CONFIG_CERF_LCD_38_B)
  356. pixclock: 171521,  bpp: 4,
  357. xres: 320, yres: 240,
  358. lccr0: LCCR0_Mono | LCCR0_4PixMono | LCCR0_Sngl | LCCR0_Pas,
  359. lccr3: LCCR3_OutEnH | LCCR3_PixRsEdg | LCCR3_ACBsDiv(56) |
  360. LCCR3_PixClkDiv(38),
  361. #else
  362. #error "Must have a CerfBoard LCD form factor selected"
  363. #endif
  365. hsync_len: 5, vsync_len: 1,
  366. left_margin: 61, upper_margin: 3,
  367. right_margin: 9, lower_margin: 0,
  369. sync: FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
  371. };
  373. #if 0
  374. static struct sa1100fb_rgb cerf_rgb_16 = {
  375. red: { offset: 8, length: 4, },
  376. green: { offset: 4, length: 4, },
  377. blue: { offset: 0, length: 4, },
  378. transp: { offset: 0, length: 0, },
  379. };
  380. #endif
  381. #endif
  383. #ifdef CONFIG_SA1100_FREEBIRD
  384. #warning Please check this carefully
  385. static struct sa1100fb_mach_info freebird_info __initdata = {
  386. pixclock: 171521, bpp: 16,
  387. xres: 240, yres: 320,
  389. hsync_len: 3, vsync_len: 2,
  390. left_margin: 2, upper_margin: 0,
  391. right_margin: 2, lower_margin: 0,
  393. sync: FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
  395. lccr0: LCCR0_Color | LCCR0_Sngl | LCCR0_Pas,
  396. lccr3: LCCR3_OutEnH | LCCR3_PixFlEdg | LCCR3_ACBsDiv(2),
  397. };
  399. static struct sa1100fb_rgb freebird_rgb_16 = {
  400. red: { offset: 8,  length: 4, },
  401. green: { offset: 4,  length: 4, },
  402. blue: { offset: 0,  length: 4, },
  403. transp: { offset: 12, length: 4, },
  404. };
  405. #endif
  407. #ifdef CONFIG_SA1100_GRAPHICSCLIENT
  408. static struct sa1100fb_mach_info graphicsclient_info __initdata = {
  409. pixclock: 53500, bpp: 8,
  410. xres: 640, yres: 480,
  412. hsync_len: 9, vsync_len: 9,
  413. left_margin: 54, upper_margin: 24,
  414. right_margin: 54, lower_margin: 32,
  416. sync: 0,
  418. lccr0: LCCR0_Color | LCCR0_Sngl | LCCR0_Act,
  419. lccr3: LCCR3_OutEnH | LCCR3_PixRsEdg | LCCR3_ACBsDiv(2),
  420. };
  421. #endif
  423. #ifdef CONFIG_SA1100_HUW_WEBPANEL
  424. static struct sa1100fb_mach_info huw_webpanel_info __initdata = {
  425. pixclock: 0, bpp: 8,
  426. xres: 640, yres: 480,
  428. hsync_len: 3, vsync_len: 1,
  429. left_margin: 41, upper_margin: 0,
  430. right_margin: 101, lower_margin: 0,
  432. sync: FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
  434. lccr0: LCCR0_Color | LCCR0_Dual | LCCR0_Pas,
  435. lccr3: LCCR3_OutEnH | LCCR3_PixRsEdg | LCCR3_ACBsDiv(2) | 8,
  436. #error FIXME
  437. /*
  438.  * FIXME: please get rid of the '| 8' in preference to an
  439.  * LCCR3_PixClkDiv() version. --rmk
  440.  */
  441. };
  442. #endif
  444. #ifdef LART_GREY_LCD
  445. static struct sa1100fb_mach_info lart_grey_info __initdata = {
  446. pixclock: 150000, bpp: 4,
  447. xres: 320, yres: 240,
  449. hsync_len: 1, vsync_len: 1,
  450. left_margin: 4, upper_margin: 0,
  451. right_margin: 2, lower_margin: 0,
  453. cmap_greyscale: 1,
  454. sync: FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
  456. lccr0: LCCR0_Mono | LCCR0_Sngl | LCCR0_Pas | LCCR0_4PixMono,
  457. lccr3: LCCR3_OutEnH | LCCR3_PixRsEdg | LCCR3_ACBsDiv(512),
  458. };
  459. #endif
  460. #ifdef LART_COLOR_LCD
  461. static struct sa1100fb_mach_info lart_color_info __initdata = {
  462. pixclock: 150000, bpp: 16,
  463. xres: 320, yres: 240,
  465. hsync_len: 2, vsync_len: 3,
  466. left_margin: 69, upper_margin: 14,
  467. right_margin: 8, lower_margin: 4,
  469. sync: 0,
  471. lccr0: LCCR0_Color | LCCR0_Sngl | LCCR0_Act,
  472. lccr3: LCCR3_OutEnH | LCCR3_PixFlEdg | LCCR3_ACBsDiv(512),
  473. };
  474. #endif
  475. #ifdef LART_VIDEO_OUT
  476. static struct sa1100fb_mach_info lart_video_info __initdata = {
  477. pixclock: 39721, bpp: 16,
  478. xres: 640, yres: 480,
  480. hsync_len: 95, vsync_len: 2,
  481. left_margin: 40, upper_margin: 32,
  482. right_margin: 24, lower_margin: 11,
  484. sync: FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
  486. lccr0: LCCR0_Color | LCCR0_Sngl | LCCR0_Act,
  487. lccr3: LCCR3_OutEnL | LCCR3_PixFlEdg | LCCR3_ACBsDiv(512),
  488. };
  489. #endif
  491. #ifdef CONFIG_SA1100_FRODO
  492. /* At the moment, this is the only LCD available
  493.    for the 2d3D, Inc. SA-1110 Development Board */
  494. #define KIT01_LCD
  495. #endif
  497. #ifdef KIT01_LCD
  498. static struct sa1100fb_mach_info kit01_info __initdata =
  499. {
  500. pixclock: 63291, bpp: 16,
  501. xres: 640, yres: 480,
  503. hsync_len: 64, vsync_len: 3,
  504. left_margin: 122, upper_margin: 45,
  505. right_margin: 10, lower_margin: 10,
  507. sync: 0,
  509. lccr0: LCCR0_Color | LCCR0_Sngl | LCCR0_Act,
  510. lccr3: LCCR3_OutEnH | LCCR3_PixFlEdg
  511. };
  512. #endif
  514. #ifdef CONFIG_SA1100_SHANNON
  515. static struct sa1100fb_mach_info shannon_info __initdata = {
  516. pixclock: 152500, bpp: 8,
  517. xres: 640, yres: 480,
  519. hsync_len: 4, vsync_len: 3,
  520. left_margin: 2, upper_margin: 0,
  521. right_margin: 1, lower_margin: 0,
  523. sync: FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, 
  525. lccr0: LCCR0_Color | LCCR0_Dual | LCCR0_Pas,
  526. lccr3: LCCR3_ACBsDiv(512),
  527. };
  528. #endif
  530. #ifdef CONFIG_SA1100_OMNIMETER
  531. static struct sa1100fb_mach_info omnimeter_info __initdata = {
  532. pixclock: 0, bpp: 4,
  533. xres: 480, yres: 320,
  535. hsync_len: 1, vsync_len: 1,
  536. left_margin: 10, upper_margin: 0,
  537. right_margin: 10, lower_margin: 0,
  539. cmap_greyscale: 1,
  540. sync: FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
  542. lccr0: LCCR0_Mono | LCCR0_Sngl | LCCR0_Pas | LCCR0_8PixMono,
  543. lccr3: LCCR3_OutEnH | LCCR3_PixRsEdg | LCCR3_ACBsDiv(255) |
  544. LCCR3_PixClkDiv(44),
  545. #error FIXME: fix pixclock, ACBsDiv
  546. /*
  547.  * FIXME: I think ACBsDiv is wrong above - should it be 512 (disabled)?
  548.  *   - rmk
  549.  */
  550. };
  551. #endif
  553. #ifdef CONFIG_SA1100_PANGOLIN
  554. static struct sa1100fb_mach_info pangolin_info __initdata = {
  555. pixclock: 341521, bpp: 16,
  556. xres: 800, yres: 600,
  558. hsync_len: 64, vsync_len: 7,
  559. left_margin: 160, upper_margin: 7,
  560. right_margin: 24, lower_margin: 1,
  562. sync: FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
  564. lccr0: LCCR0_Color | LCCR0_Sngl | LCCR0_Act,
  565. lccr3: LCCR3_OutEnH | LCCR3_PixFlEdg | LCCR3_ACBsCntOff,
  566. };
  567. #endif
  569. #ifdef CONFIG_SA1100_STORK
  570. #if STORK_TFT /* ie the NEC TFT */
  571. /*
  572.  * pixclock is ps per clock. say 72Hz, 800x600 clocks => (1/72)/(800*600)
  573.  * = 28935 and a bit
  574.  * NB likely to be increased to ease bus timings wrt pcmcia interface
  575.  */
  576. static struct sa1100fb_mach_info stork_tft_info __initdata = {
  577. pixclock: 28935, bpp: 16,
  578. xres: 640, yres: 480,
  580. hsync_len: 64, vsync_len: 2,
  581. left_margin: 48, upper_margin: 12,
  582. right_margin: 48, lower_margin: 31,
  584. sync: 0,
  586. lccr0: LCCR0_Color | LCCR0_Sngl | LCCR0_Act,
  587. lccr3: LCCR3_OutEnH | LCCR3_PixRsEdg,
  588. };
  590. static struct sa1100fb_rgb stork_tft_rgb_16 = {
  591. red: { offset: 11, length: 5, },
  592. green: { offset: 5,  length: 6, },
  593. blue: { offset: 0,  length: 5, },
  594. transp: { offset: 0,  length: 0, },
  595. };
  597. #else /* Kyocera DSTN */
  599. static struct sa1100fb_mach_info stork_dstn_info __initdata = {
  600. pixclock: 0, bpp: 16,
  601. xres: 640, yres: 480,
  603. hsync_len: 2, vsync_len: 2,
  604. left_margin: 2, upper_margin: 0,
  605. right_margin: 2, lower_margin: 0,
  607. sync: FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT ,
  609. lccr0: LCCR0_Color | LCCR0_Dual | LCCR0_Pas,
  610. #error Fixme
  611. lccr3: 0xff00 |
  612. 0x18 /* ought to be 0x14 but DMA isn't up to that as yet */
  613. };
  615. static struct sa1100fb_rgb stork_dstn_rgb_16 = {
  616. red: { offset: 8,  length: 4, },
  617. green: { offset: 4,  length: 4, },
  618. blue: { offset: 0,  length: 4, },
  619. transp: { offset: 0,  length: 0, },
  620. };
  621. #endif
  622. #endif
  624. #ifdef CONFIG_SA1100_XP860
  625. static struct sa1100fb_mach_info xp860_info __initdata = {
  626. pixclock: 0, bpp: 8,
  627. xres: 1024, yres: 768,
  629. hsync_len: 3, vsync_len: 3,
  630. left_margin: 3, upper_margin: 2,
  631. right_margin: 2, lower_margin: 1,
  633. sync: 0,
  635. lccr0: LCCR0_Color | LCCR0_Sngl | LCCR0_Act,
  636. lccr3: LCCR3_OutEnH | LCCR3_PixRsEdg | LCCR3_PixClkDiv(6),
  637. };
  638. #endif
  642. static struct sa1100fb_mach_info * __init
  643. sa1100fb_get_machine_info(struct sa1100fb_info *fbi)
  644. {
  645. struct sa1100fb_mach_info *inf = NULL;
  647. /*
  648.  *            R        G       B       T
  649.  * default  {11,5}, { 5,6}, { 0,5}, { 0,0}
  650.  * h3600    {12,4}, { 7,4}, { 1,4}, { 0,0}
  651.  * freebird { 8,4}, { 4,4}, { 0,4}, {12,4}
  652.  */
  653. #ifdef CONFIG_SA1100_ASSABET
  654. if (machine_is_assabet()) {
  655. #ifndef ASSABET_PAL_VIDEO
  656. inf = &lq039q2ds54_info;
  657. #else
  658. inf = &pal_info;
  659. #endif
  660. }
  661. #endif
  662. #ifdef CONFIG_SA1100_H3XXX
  663. if (machine_is_h3600()) {
  664. inf = &h3600_info;
  665. fbi->rgb[RGB_16] = &h3600_rgb_16;
  666. }
  667. if (machine_is_h3100()) {
  668. inf = &h3100_info;
  669. }
  670. if (machine_is_h3800()) {
  671. inf = &h3800_info;
  672. }
  673. #endif
  674. #ifdef CONFIG_SA1100_BRUTUS
  675. if (machine_is_brutus()) {
  676. inf = &brutus_info;
  677. }
  678. #endif
  679. #ifdef CONFIG_SA1100_CERF
  680. if (machine_is_cerf()) {
  681. inf = &cerf_info;
  682. }
  683. #endif
  684. #ifdef CONFIG_SA1100_FREEBIRD
  685. if (machine_is_freebird()) {
  686. inf = &freebird_info;
  687. fbi->rgb[RGB_16] = &freebird_rgb16;
  688. }
  689. #endif
  690. #ifdef CONFIG_SA1100_GRAPHICSCLIENT
  691. if (machine_is_graphicsclient()) {
  692. inf = &graphicsclient_info;
  693. }
  694. #endif
  695. #ifdef CONFIG_SA1100_HUW_WEBPANEL
  696. if (machine_is_huw_webpanel()) {
  697. inf = &huw_webpanel_info;
  698. }
  699. #endif
  700. #ifdef CONFIG_SA1100_LART
  701. if (machine_is_lart()) {
  702. #ifdef LART_GREY_LCD
  703. inf = &lart_grey_info;
  704. #endif
  705. #ifdef LART_COLOR_LCD
  706. inf = &lart_color_info;
  707. #endif
  708. #ifdef LART_VIDEO_OUT
  709. inf = &lart_video_info;
  710. #endif
  711. #ifdef KIT01_LCD
  712. inf = &kit01_info;
  713. #endif
  714. }
  715. #endif
  716. #ifdef CONFIG_SA1100_FRODO
  717. if (machine_is_frodo()) {
  718. #ifdef KIT01_LCD
  719. inf = &kit01_info;
  720. #endif
  721. }
  722. #endif
  723. #ifdef CONFIG_SA1100_SHANNON
  724. if (machine_is_shannon()) {
  725. inf = &shannon_info;
  726. }
  727. #endif
  728. #ifdef CONFIG_SA1100_OMNIMETER
  729. if (machine_is_omnimeter()) {
  730. inf = &omnimeter_info;
  731. }
  732. #endif
  733. #ifdef CONFIG_SA1100_PANGOLIN
  734. if (machine_is_pangolin()) {
  735. inf = &pangolin_info;
  736. }
  737. #endif
  738. #ifdef CONFIG_SA1100_XP860
  739. if (machine_is_xp860()) {
  740. inf = &xp860_info;
  741. }
  742. #endif
  743. #ifdef CONFIG_SA1100_STORK
  744. if (machine_is_stork()) {
  745. #if STORK_TFT
  746. inf = &stork_tft_info;
  747. fbi->rgb[RGB_16] = &stork_tft_rgb_16;
  748. #else
  749. inf = &stork_dstn_info;
  750. fbi->rgb[RGB_16] = &stork_dstn_rgb_16;
  751. #endif
  752. }
  753. #endif
  754. return inf;
  755. }
  757. static int sa1100fb_activate_var(struct fb_var_screeninfo *var, struct sa1100fb_info *);
  758. static void set_ctrlr_state(struct sa1100fb_info *fbi, u_int state);
  760. static inline void sa1100fb_schedule_task(struct sa1100fb_info *fbi, u_int state)
  761. {
  762. unsigned long flags;
  764. local_irq_save(flags);
  765. /*
  766.  * We need to handle two requests being made at the same time.
  767.  * There are two important cases:
  768.  *  1. When we are changing VT (C_REENABLE) while unblanking (C_ENABLE)
  769.  *     We must perform the unblanking, which will do our REENABLE for us.
  770.  *  2. When we are blanking, but immediately unblank before we have
  771.  *     blanked.  We do the "REENABLE" thing here as well, just to be sure.
  772.  */
  773. if (fbi->task_state == C_ENABLE && state == C_REENABLE)
  774. state = (u_int) -1;
  775. if (fbi->task_state == C_DISABLE && state == C_ENABLE)
  776. state = C_REENABLE;
  778. if (state != (u_int)-1) {
  779. fbi->task_state = state;
  780. schedule_task(&fbi->task);
  781. }
  782. local_irq_restore(flags);
  783. }
  785. /*
  786.  * Get the VAR structure pointer for the specified console
  787.  */
  788. static inline struct fb_var_screeninfo *get_con_var(struct fb_info *info, int con)
  789. {
  790. struct sa1100fb_info *fbi = (struct sa1100fb_info *)info;
  791. return (con == fbi->currcon || con == -1) ? &fbi->fb.var : &fb_display[con].var;
  792. }
  794. /*
  795.  * Get the DISPLAY structure pointer for the specified console
  796.  */
  797. static inline struct display *get_con_display(struct fb_info *info, int con)
  798. {
  799. struct sa1100fb_info *fbi = (struct sa1100fb_info *)info;
  800. return (con < 0) ? fbi->fb.disp : &fb_display[con];
  801. }
  803. /*
  804.  * Get the CMAP pointer for the specified console
  805.  */
  806. static inline struct fb_cmap *get_con_cmap(struct fb_info *info, int con)
  807. {
  808. struct sa1100fb_info *fbi = (struct sa1100fb_info *)info;
  809. return (con == fbi->currcon || con == -1) ? &fbi->fb.cmap : &fb_display[con].cmap;
  810. }
  812. static inline u_int
  813. chan_to_field(u_int chan, struct fb_bitfield *bf)
  814. {
  815. chan &= 0xffff;
  816. chan >>= 16 - bf->length;
  817. return chan << bf->offset;
  818. }
  820. /*
  821.  * Convert bits-per-pixel to a hardware palette PBS value.
  822.  */
  823. static inline u_int
  824. palette_pbs(struct fb_var_screeninfo *var)
  825. {
  826. int ret = 0;
  827. switch (var->bits_per_pixel) {
  828. #ifdef FBCON_HAS_CFB4
  829. case 4:  ret = 0 << 12; break;
  830. #endif
  831. #ifdef FBCON_HAS_CFB8
  832. case 8:  ret = 1 << 12; break;
  833. #endif
  834. #ifdef FBCON_HAS_CFB16
  835. case 16: ret = 2 << 12; break;
  836. #endif
  837. }
  838. return ret;
  839. }
  841. static int
  842. sa1100fb_setpalettereg(u_int regno, u_int red, u_int green, u_int blue,
  843.        u_int trans, struct fb_info *info)
  844. {
  845. struct sa1100fb_info *fbi = (struct sa1100fb_info *)info;
  846. u_int val, ret = 1;
  848. if (regno < fbi->palette_size) {
  849. val = ((red >> 4) & 0xf00);
  850. val |= ((green >> 8) & 0x0f0);
  851. val |= ((blue >> 12) & 0x00f);
  853. if (regno == 0)
  854. val |= palette_pbs(&fbi->fb.var);
  856. fbi->palette_cpu[regno] = val;
  857. ret = 0;
  858. }
  859. return ret;
  860. }
  862. static int
  863. sa1100fb_setcolreg(u_int regno, u_int red, u_int green, u_int blue,
  864.    u_int trans, struct fb_info *info)
  865. {
  866. struct sa1100fb_info *fbi = (struct sa1100fb_info *)info;
  867. struct display *disp = get_con_display(info, fbi->currcon);
  868. u_int val;
  869. int ret = 1;
  871. /*
  872.  * If inverse mode was selected, invert all the colours
  873.  * rather than the register number.  The register number
  874.  * is what you poke into the framebuffer to produce the
  875.  * colour you requested.
  876.  */
  877. if (disp->inverse) {
  878. red   = 0xffff - red;
  879. green = 0xffff - green;
  880. blue  = 0xffff - blue;
  881. }
  883. /*
  884.  * If greyscale is true, then we convert the RGB value
  885.  * to greyscale no mater what visual we are using.
  886.  */
  887. if (fbi->fb.var.grayscale)
  888. red = green = blue = (19595 * red + 38470 * green +
  889. 7471 * blue) >> 16;
  891. switch (fbi->fb.disp->visual) {
  892. case FB_VISUAL_TRUECOLOR:
  893. /*
  894.  * 12 or 16-bit True Colour.  We encode the RGB value
  895.  * according to the RGB bitfield information.
  896.  */
  897. if (regno < 16) {
  898. u16 *pal = fbi->fb.pseudo_palette;
  900. val  = chan_to_field(red, &fbi->fb.var.red);
  901. val |= chan_to_field(green, &fbi->fb.var.green);
  902. val |= chan_to_field(blue, &fbi->fb.var.blue);
  904. pal[regno] = val;
  905. ret = 0;
  906. }
  907. break;
  909. case FB_VISUAL_STATIC_PSEUDOCOLOR:
  910. case FB_VISUAL_PSEUDOCOLOR:
  911. ret = sa1100fb_setpalettereg(regno, red, green, blue, trans, info);
  912. break;
  913. }
  915. return ret;
  916. }
  918. /*
  919.  *  sa1100fb_display_dma_period()
  920.  *    Calculate the minimum period (in picoseconds) between two DMA
  921.  *    requests for the LCD controller.
  922.  */
  923. static unsigned int
  924. sa1100fb_display_dma_period(struct fb_var_screeninfo *var)
  925. {
  926. unsigned int mem_bits_per_pixel;
  928. mem_bits_per_pixel = var->bits_per_pixel;
  929. if (mem_bits_per_pixel == 12)
  930. mem_bits_per_pixel = 16;
  932. /*
  933.  * Period = pixclock * bits_per_byte * bytes_per_transfer
  934.  * / memory_bits_per_pixel;
  935.  */
  936. return var->pixclock * 8 * 16 / mem_bits_per_pixel;
  937. }
  939. /*
  940.  *  sa1100fb_decode_var():
  941.  *    Get the video params out of 'var'. If a value doesn't fit, round it up,
  942.  *    if it's too big, return -EINVAL.
  943.  *
  944.  *    Suggestion: Round up in the following order: bits_per_pixel, xres,
  945.  *    yres, xres_virtual, yres_virtual, xoffset, yoffset, grayscale,
  946.  *    bitfields, horizontal timing, vertical timing.
  947.  */
  948. static int
  949. sa1100fb_validate_var(struct fb_var_screeninfo *var,
  950.       struct sa1100fb_info *fbi)
  951. {
  952. int ret = -EINVAL;
  954. if (var->xres < MIN_XRES)
  955. var->xres = MIN_XRES;
  956. if (var->yres < MIN_YRES)
  957. var->yres = MIN_YRES;
  958. if (var->xres > fbi->max_xres)
  959. var->xres = fbi->max_xres;
  960. if (var->yres > fbi->max_yres)
  961. var->yres = fbi->max_yres;
  962. var->xres_virtual =
  963.     var->xres_virtual < var->xres ? var->xres : var->xres_virtual;
  964. var->yres_virtual =
  965.     var->yres_virtual < var->yres ? var->yres : var->yres_virtual;
  967. DPRINTK("var->bits_per_pixel=%dn", var->bits_per_pixel);
  968. switch (var->bits_per_pixel) {
  969. #ifdef FBCON_HAS_CFB4
  970. case 4: ret = 0; break;
  971. #endif
  972. #ifdef FBCON_HAS_CFB8
  973. case 8: ret = 0; break;
  974. #endif
  975. #ifdef FBCON_HAS_CFB16
  976. case 16: ret = 0; break;
  977. #endif
  978. default:
  979. break;
  980. }
  982. #ifdef CONFIG_CPU_FREQ
  983. printk(KERN_DEBUG "dma period = %d ps, clock = %d kHzn",
  984. sa1100fb_display_dma_period(var),
  985. cpufreq_get(smp_processor_id()));
  986. #endif
  988. return ret;
  989. }
  991. static inline void sa1100fb_set_truecolor(u_int is_true_color)
  992. {
  993. DPRINTK("true_color = %dn", is_true_color);
  995. if (machine_is_assabet()) {
  996. #if 1
  997. // phase 4 or newer Assabet's
  998. if (is_true_color)
  999. ASSABET_BCR_set(ASSABET_BCR_LCD_12RGB);
  1000. else
  1001. ASSABET_BCR_clear(ASSABET_BCR_LCD_12RGB);
  1002. #else
  1003. // older Assabet's
  1004. if (is_true_color)
  1005. ASSABET_BCR_clear(ASSABET_BCR_LCD_12RGB);
  1006. else
  1007. ASSABET_BCR_set(ASSABET_BCR_LCD_12RGB);
  1008. #endif
  1009. }
  1010. }
  1012. static void
  1013. sa1100fb_hw_set_var(struct fb_var_screeninfo *var, struct sa1100fb_info *fbi)
  1014. {
  1015. u_long palette_mem_size;
  1017. fbi->palette_size = var->bits_per_pixel == 8 ? 256 : 16;
  1019. palette_mem_size = fbi->palette_size * sizeof(u16);
  1021. DPRINTK("palette_mem_size = 0x%08lxn", (u_long) palette_mem_size);
  1023. fbi->palette_cpu = (u16 *)(fbi->map_cpu + PAGE_SIZE - palette_mem_size);
  1024. fbi->palette_dma = fbi->map_dma + PAGE_SIZE - palette_mem_size;
  1026. fb_set_cmap(&fbi->fb.cmap, 1, sa1100fb_setcolreg, &fbi->fb);
  1028. /* Set board control register to handle new color depth */
  1029. sa1100fb_set_truecolor(var->bits_per_pixel >= 16);
  1031. #ifdef CONFIG_SA1100_OMNIMETER
  1032. #error Do we have to do this here?   We already do it at init time.
  1033. if (machine_is_omnimeter())
  1034. SetLCDContrast(DefaultLCDContrast);
  1035. #endif
  1037. sa1100fb_activate_var(var, fbi);
  1039. fbi->palette_cpu[0] = (fbi->palette_cpu[0] &
  1040.  0xcfff) | palette_pbs(var);
  1042. }
  1044. /*
  1045.  * sa1100fb_set_var():
  1046.  * Set the user defined part of the display for the specified console
  1047.  */
  1048. static int
  1049. sa1100fb_set_var(struct fb_var_screeninfo *var, int con, struct fb_info *info)
  1050. {
  1051. struct sa1100fb_info *fbi = (struct sa1100fb_info *)info;
  1052. struct fb_var_screeninfo *dvar = get_con_var(&fbi->fb, con);
  1053. struct display *display = get_con_display(&fbi->fb, con);
  1054. int err, chgvar = 0, rgbidx;
  1056. DPRINTK("set_varn");
  1058. /*
  1059.  * Decode var contents into a par structure, adjusting any
  1060.  * out of range values.
  1061.  */
  1062. err = sa1100fb_validate_var(var, fbi);
  1063. if (err)
  1064. return err;
  1066. if (var->activate & FB_ACTIVATE_TEST)
  1067. return 0;
  1069. if ((var->activate & FB_ACTIVATE_MASK) != FB_ACTIVATE_NOW)
  1070. return -EINVAL;
  1072. if (dvar->xres != var->xres)
  1073. chgvar = 1;
  1074. if (dvar->yres != var->yres)
  1075. chgvar = 1;
  1076. if (dvar->xres_virtual != var->xres_virtual)
  1077. chgvar = 1;
  1078. if (dvar->yres_virtual != var->yres_virtual)
  1079. chgvar = 1;
  1080. if (dvar->bits_per_pixel != var->bits_per_pixel)
  1081. chgvar = 1;
  1082. if (con < 0)
  1083. chgvar = 0;
  1085. switch (var->bits_per_pixel) {
  1086. #ifdef FBCON_HAS_CFB4
  1087. case 4:
  1088. if (fbi->cmap_static)
  1089. display->visual = FB_VISUAL_STATIC_PSEUDOCOLOR;
  1090. else
  1091. display->visual = FB_VISUAL_PSEUDOCOLOR;
  1092. display->line_length = var->xres / 2;
  1093. display->dispsw = &fbcon_cfb4;
  1094. rgbidx = RGB_8;
  1095. break;
  1096. #endif
  1097. #ifdef FBCON_HAS_CFB8
  1098. case 8:
  1099. if (fbi->cmap_static)
  1100. display->visual = FB_VISUAL_STATIC_PSEUDOCOLOR;
  1101. else
  1102. display->visual = FB_VISUAL_PSEUDOCOLOR;
  1103. display->line_length = var->xres;
  1104. display->dispsw = &fbcon_cfb8;
  1105. rgbidx = RGB_8;
  1106. break;
  1107. #endif
  1108. #ifdef FBCON_HAS_CFB16
  1109. case 16:
  1110. display->visual = FB_VISUAL_TRUECOLOR;
  1111. display->line_length = var->xres * 2;
  1112. display->dispsw = &fbcon_cfb16;
  1113. display->dispsw_data = fbi->fb.pseudo_palette;
  1114. rgbidx = RGB_16;
  1115. break;
  1116. #endif
  1117. default:
  1118. rgbidx = 0;
  1119. display->dispsw = &fbcon_dummy;
  1120. break;
  1121. }
  1123. display->screen_base = fbi->screen_cpu;
  1124. display->next_line = display->line_length;
  1125. display->type = fbi->fb.fix.type;
  1126. display->type_aux = fbi->fb.fix.type_aux;
  1127. display->ypanstep = fbi->fb.fix.ypanstep;
  1128. display->ywrapstep = fbi->fb.fix.ywrapstep;
  1129. display->can_soft_blank = 1;
  1130. display->inverse = fbi->cmap_inverse;
  1132. *dvar = *var;
  1133. dvar->activate &= ~FB_ACTIVATE_ALL;
  1135. /*
  1136.  * Copy the RGB parameters for this display
  1137.  * from the machine specific parameters.
  1138.  */
  1139. dvar->red = fbi->rgb[rgbidx]->red;
  1140. dvar->green = fbi->rgb[rgbidx]->green;
  1141. dvar->blue = fbi->rgb[rgbidx]->blue;
  1142. dvar->transp = fbi->rgb[rgbidx]->transp;
  1144. DPRINTK("RGBT length = %d:%d:%d:%dn",
  1145. dvar->red.length, dvar->green.length, dvar->blue.length,
  1146. dvar->transp.length);
  1148. DPRINTK("RGBT offset = %d:%d:%d:%dn",
  1149. dvar->red.offset, dvar->green.offset, dvar->blue.offset,
  1150. dvar->transp.offset);
  1152. /*
  1153.  * Update the old var.  The fbcon drivers still use this.
  1154.  * Once they are using fbi->fb.var, this can be dropped.
  1155.  */
  1156. display->var = *dvar;
  1158. /*
  1159.  * If we are setting all the virtual consoles, also set the
  1160.  * defaults used to create new consoles.
  1161.  */
  1162. if (var->activate & FB_ACTIVATE_ALL)
  1163. fbi->fb.disp->var = *dvar;
  1165. /*
  1166.  * If the console has changed and the console has defined
  1167.  * a changevar function, call that function.
  1168.  */
  1169. if (chgvar && info && fbi->fb.changevar)
  1170. fbi->fb.changevar(con);
  1172. /* If the current console is selected, activate the new var. */
  1173. if (con != fbi->currcon)
  1174. return 0;
  1176. sa1100fb_hw_set_var(dvar, fbi);
  1178. return 0;
  1179. }
  1181. static int
  1182. __do_set_cmap(struct fb_cmap *cmap, int kspc, int con,
  1183.       struct fb_info *info)
  1184. {
  1185. struct sa1100fb_info *fbi = (struct sa1100fb_info *)info;
  1186. struct fb_cmap *dcmap = get_con_cmap(info, con);
  1187. int err = 0;
  1189. if (con == -1)
  1190. con = fbi->currcon;
  1192. /* no colormap allocated? (we always have "this" colour map allocated) */
  1193. if (con >= 0)
  1194. err = fb_alloc_cmap(&fb_display[con].cmap, fbi->palette_size, 0);
  1196. if (!err && con == fbi->currcon)
  1197. err = fb_set_cmap(cmap, kspc, sa1100fb_setcolreg, info);
  1199. if (!err)
  1200. fb_copy_cmap(cmap, dcmap, kspc ? 0 : 1);
  1202. return err;
  1203. }
  1205. static int
  1206. sa1100fb_set_cmap(struct fb_cmap *cmap, int kspc, int con,
  1207.   struct fb_info *info)
  1208. {
  1209. struct display *disp = get_con_display(info, con);
  1211. if (disp->visual == FB_VISUAL_TRUECOLOR ||
  1212.     disp->visual == FB_VISUAL_STATIC_PSEUDOCOLOR)
  1213. return -EINVAL;
  1215. return __do_set_cmap(cmap, kspc, con, info);
  1216. }
  1218. static int
  1219. sa1100fb_get_fix(struct fb_fix_screeninfo *fix, int con, struct fb_info *info)
  1220. {
  1221. struct display *display = get_con_display(info, con);
  1223. *fix = info->fix;
  1225. fix->line_length = display->line_length;
  1226. fix->visual  = display->visual;
  1227. return 0;
  1228. }
  1230. static int
  1231. sa1100fb_get_var(struct fb_var_screeninfo *var, int con, struct fb_info *info)
  1232. {
  1233. *var = *get_con_var(info, con);
  1234. return 0;
  1235. }
  1237. static int
  1238. sa1100fb_get_cmap(struct fb_cmap *cmap, int kspc, int con, struct fb_info *info)
  1239. {
  1240. struct fb_cmap *dcmap = get_con_cmap(info, con);
  1241. fb_copy_cmap(dcmap, cmap, kspc ? 0 : 2);
  1242. return 0;
  1243. }
  1245. static struct fb_ops sa1100fb_ops = {
  1246. owner: THIS_MODULE,
  1247. fb_get_fix: sa1100fb_get_fix,
  1248. fb_get_var: sa1100fb_get_var,
  1249. fb_set_var: sa1100fb_set_var,
  1250. fb_get_cmap: sa1100fb_get_cmap,
  1251. fb_set_cmap: sa1100fb_set_cmap,
  1252. };
  1254. /*
  1255.  *  sa1100fb_switch():       
  1256.  * Change to the specified console.  Palette and video mode
  1257.  *      are changed to the console's stored parameters.
  1258.  *
  1259.  * Uh oh, this can be called from a tasklet (IRQ)
  1260.  */
  1261. static int sa1100fb_switch(int con, struct fb_info *info)
  1262. {
  1263. struct sa1100fb_info *fbi = (struct sa1100fb_info *)info;
  1264. struct display *disp;
  1265. struct fb_cmap *cmap;
  1267. DPRINTK("con=%d info->modename=%sn", con, fbi->fb.modename);
  1269. if (con == fbi->currcon)
  1270. return 0;
  1272. if (fbi->currcon >= 0) {
  1273. disp = fb_display + fbi->currcon;
  1275. /*
  1276.  * Save the old colormap and video mode.
  1277.  */
  1278. disp->var = fbi->fb.var;
  1280. if (disp->cmap.len)
  1281. fb_copy_cmap(&fbi->fb.cmap, &disp->cmap, 0);
  1282. }
  1284. fbi->currcon = con;
  1285. disp = fb_display + con;
  1287. /*
  1288.  * Make sure that our colourmap contains 256 entries.
  1289.  */
  1290. fb_alloc_cmap(&fbi->fb.cmap, 256, 0);
  1292. if (disp->cmap.len)
  1293. cmap = &disp->cmap;
  1294. else
  1295. cmap = fb_default_cmap(1 << disp->var.bits_per_pixel);
  1297. fb_copy_cmap(cmap, &fbi->fb.cmap, 0);
  1299. fbi->fb.var = disp->var;
  1300. fbi->fb.var.activate = FB_ACTIVATE_NOW;
  1302. sa1100fb_set_var(&fbi->fb.var, con, info);
  1303. return 0;
  1304. }
  1306. /*
  1307.  * Formal definition of the VESA spec:
  1308.  *  On
  1309.  *   This refers to the state of the display when it is in full operation
  1310.  *  Stand-By
  1311.  *   This defines an optional operating state of minimal power reduction with
  1312.  *   the shortest recovery time
  1313.  *  Suspend
  1314.  *   This refers to a level of power management in which substantial power
  1315.  *   reduction is achieved by the display.  The display can have a longer 
  1316.  *   recovery time from this state than from the Stand-by state
  1317.  *  Off
  1318.  *   This indicates that the display is consuming the lowest level of power
  1319.  *   and is non-operational. Recovery from this state may optionally require
  1320.  *   the user to manually power on the monitor
  1321.  *
  1322.  *  Now, the fbdev driver adds an additional state, (blank), where they
  1323.  *  turn off the video (maybe by colormap tricks), but don't mess with the
  1324.  *  video itself: think of it semantically between on and Stand-By.
  1325.  *
  1326.  *  So here's what we should do in our fbdev blank routine:
  1327.  *
  1328.  *   VESA_NO_BLANKING (mode 0) Video on,  front/back light on
  1329.  *   VESA_VSYNC_SUSPEND (mode 1)   Video on,  front/back light off
  1330.  *   VESA_HSYNC_SUSPEND (mode 2)   Video on,  front/back light off
  1331.  *   VESA_POWERDOWN (mode 3) Video off, front/back light off
  1332.  *
  1333.  *  This will match the matrox implementation.
  1334.  */
  1335. /*
  1336.  * sa1100fb_blank():
  1337.  * Blank the display by setting all palette values to zero.  Note, the 
  1338.  *  12 and 16 bpp modes don't really use the palette, so this will not
  1339.  *      blank the display in all modes.  
  1340.  */
  1341. static void sa1100fb_blank(int blank, struct fb_info *info)
  1342. {
  1343. struct sa1100fb_info *fbi = (struct sa1100fb_info *)info;
  1344. int i;
  1346. DPRINTK("sa1100fb_blank: blank=%d info->modename=%sn", blank,
  1347. fbi->fb.modename);
  1349. switch (blank) {
  1350. case VESA_POWERDOWN:
  1351. case VESA_VSYNC_SUSPEND:
  1352. case VESA_HSYNC_SUSPEND:
  1353. if (fbi->fb.disp->visual == FB_VISUAL_PSEUDOCOLOR ||
  1354.     fbi->fb.disp->visual == FB_VISUAL_STATIC_PSEUDOCOLOR)
  1355. for (i = 0; i < fbi->palette_size; i++)
  1356. sa1100fb_setpalettereg(i, 0, 0, 0, 0, info);
  1357. sa1100fb_schedule_task(fbi, C_DISABLE);
  1358. if (sa1100fb_blank_helper)
  1359. sa1100fb_blank_helper(blank);
  1360. break;
  1362. case VESA_NO_BLANKING:
  1363. if (sa1100fb_blank_helper)
  1364. sa1100fb_blank_helper(blank);
  1365. if (fbi->fb.disp->visual == FB_VISUAL_PSEUDOCOLOR ||
  1366.     fbi->fb.disp->visual == FB_VISUAL_STATIC_PSEUDOCOLOR)
  1367. fb_set_cmap(&fbi->fb.cmap, 1, sa1100fb_setcolreg, info);
  1368. sa1100fb_schedule_task(fbi, C_ENABLE);
  1369. }
  1370. }
  1372. static int sa1100fb_updatevar(int con, struct fb_info *info)
  1373. {
  1374. DPRINTK("enteredn");
  1375. return 0;
  1376. }
  1378. /*
  1379.  * Calculate the PCD value from the clock rate (in picoseconds).
  1380.  * We take account of the PPCR clock setting.
  1381.  */
  1382. static inline int get_pcd(unsigned int pixclock)
  1383. {
  1384. unsigned int pcd;
  1386. if (pixclock) {
  1387. pcd = cpufreq_get(0) / 100;
  1388. pcd *= pixclock;
  1389. pcd /= 10000000;
  1390. pcd += 1; /* make up for integer math truncations */
  1391. } else {
  1392. /*
  1393.  * People seem to be missing this message.  Make it big.
  1394.  * Make it stand out.  Make sure people see it.
  1395.  */
  1396. printk(KERN_WARNING "******************************************************n");
  1397. printk(KERN_WARNING "**            ZERO PIXEL CLOCK DETECTED             **n");
  1398. printk(KERN_WARNING "** You are using a zero pixclock.  This means that  **n");
  1399. printk(KERN_WARNING "** clock scaling will not be able to adjust your    **n");
  1400. printk(KERN_WARNING "** your timing parameters appropriately, and the    **n");
  1401. printk(KERN_WARNING "** bandwidth calculations will fail to work.  This  **n");
  1402. printk(KERN_WARNING "** will shortly become an error condition, which    **n");
  1403. printk(KERN_WARNING "** will prevent your LCD display working.  Please   **n");
  1404. printk(KERN_WARNING "** send your patches in as soon as possible to shut **n");
  1405. printk(KERN_WARNING "** this message up.                                 **n");
  1406. printk(KERN_WARNING "******************************************************n");
  1407. pcd = 0;
  1408. }
  1409. return pcd;
  1410. }
  1412. /*
  1413.  * sa1100fb_activate_var():
  1414.  * Configures LCD Controller based on entries in var parameter.  Settings are      
  1415.  * only written to the controller if changes were made.  
  1416.  */
  1417. static int sa1100fb_activate_var(struct fb_var_screeninfo *var, struct sa1100fb_info *fbi)
  1418. {
  1419. struct sa1100fb_lcd_reg new_regs;
  1420. u_int half_screen_size, yres, pcd = get_pcd(var->pixclock);
  1421. u_long flags;
  1423. DPRINTK("Configuring SA1100 LCDn");
  1425. DPRINTK("var: xres=%d hslen=%d lm=%d rm=%dn",
  1426. var->xres, var->hsync_len,
  1427. var->left_margin, var->right_margin);
  1428. DPRINTK("var: yres=%d vslen=%d um=%d bm=%dn",
  1429. var->yres, var->vsync_len,
  1430. var->upper_margin, var->lower_margin);
  1432. #if DEBUG_VAR
  1433. if (var->xres < 16        || var->xres > 1024)
  1434. printk(KERN_ERR "%s: invalid xres %dn",
  1435. fbi->fb.fix.id, var->xres);
  1436. if (var->hsync_len < 1    || var->hsync_len > 64)
  1437. printk(KERN_ERR "%s: invalid hsync_len %dn",
  1438. fbi->fb.fix.id, var->hsync_len);
  1439. if (var->left_margin < 1  || var->left_margin > 255)
  1440. printk(KERN_ERR "%s: invalid left_margin %dn",
  1441. fbi->fb.fix.id, var->left_margin);
  1442. if (var->right_margin < 1 || var->right_margin > 255)
  1443. printk(KERN_ERR "%s: invalid right_margin %dn",
  1444. fbi->fb.fix.id, var->right_margin);
  1445. if (var->yres < 1         || var->yres > 1024)
  1446. printk(KERN_ERR "%s: invalid yres %dn",
  1447. fbi->fb.fix.id, var->yres);
  1448. if (var->vsync_len < 1    || var->vsync_len > 64)
  1449. printk(KERN_ERR "%s: invalid vsync_len %dn",
  1450. fbi->fb.fix.id, var->vsync_len);
  1451. if (var->upper_margin < 0 || var->upper_margin > 255)
  1452. printk(KERN_ERR "%s: invalid upper_margin %dn",
  1453. fbi->fb.fix.id, var->upper_margin);
  1454. if (var->lower_margin < 0 || var->lower_margin > 255)
  1455. printk(KERN_ERR "%s: invalid lower_margin %dn",
  1456. fbi->fb.fix.id, var->lower_margin);
  1457. #endif
  1459. new_regs.lccr0 = fbi->lccr0 |
  1460. LCCR0_LEN | LCCR0_LDM | LCCR0_BAM |
  1461. LCCR0_ERM | LCCR0_LtlEnd | LCCR0_DMADel(0);
  1463. new_regs.lccr1 =
  1464. LCCR1_DisWdth(var->xres) +
  1465. LCCR1_HorSnchWdth(var->hsync_len) +
  1466. LCCR1_BegLnDel(var->left_margin) +
  1467. LCCR1_EndLnDel(var->right_margin);
  1469. /*
  1470.  * If we have a dual scan LCD, then we need to halve
  1471.  * the YRES parameter.
  1472.  */
  1473. yres = var->yres;
  1474. if (fbi->lccr0 & LCCR0_Dual)
  1475. yres /= 2;
  1477. new_regs.lccr2 =
  1478. LCCR2_DisHght(yres) +
  1479. LCCR2_VrtSnchWdth(var->vsync_len) +
  1480. LCCR2_BegFrmDel(var->upper_margin) +
  1481. LCCR2_EndFrmDel(var->lower_margin);
  1483. new_regs.lccr3 = fbi->lccr3 |
  1484. (var->sync & FB_SYNC_HOR_HIGH_ACT ? LCCR3_HorSnchH : LCCR3_HorSnchL) |
  1485. (var->sync & FB_SYNC_VERT_HIGH_ACT ? LCCR3_VrtSnchH : LCCR3_VrtSnchL) |
  1486. LCCR3_ACBsCntOff;
  1488. if (pcd)
  1489. new_regs.lccr3 |= LCCR3_PixClkDiv(pcd);
  1491. DPRINTK("nlccr0 = 0x%08xn", new_regs.lccr0);
  1492. DPRINTK("nlccr1 = 0x%08xn", new_regs.lccr1);
  1493. DPRINTK("nlccr2 = 0x%08xn", new_regs.lccr2);
  1494. DPRINTK("nlccr3 = 0x%08xn", new_regs.lccr3);
  1496. half_screen_size = var->bits_per_pixel;
  1497. half_screen_size = half_screen_size * var->xres * var->yres / 16;
  1499. /* Update shadow copy atomically */
  1500. local_irq_save(flags);
  1501. fbi->dbar1 = fbi->palette_dma;
  1502. fbi->dbar2 = fbi->screen_dma + half_screen_size;
  1504. fbi->reg_lccr0 = new_regs.lccr0;
  1505. fbi->reg_lccr1 = new_regs.lccr1;
  1506. fbi->reg_lccr2 = new_regs.lccr2;
  1507. fbi->reg_lccr3 = new_regs.lccr3;
  1508. local_irq_restore(flags);
  1510. /*
  1511.  * Only update the registers if the controller is enabled
  1512.  * and something has changed.
  1513.  */
  1514. if ((LCCR0 != fbi->reg_lccr0)       || (LCCR1 != fbi->reg_lccr1) ||
  1515.     (LCCR2 != fbi->reg_lccr2)       || (LCCR3 != fbi->reg_lccr3) ||
  1516.     (DBAR1 != fbi->dbar1) || (DBAR2 != fbi->dbar2))
  1517. sa1100fb_schedule_task(fbi, C_REENABLE);
  1519. return 0;
  1520. }
  1522. /*
  1523.  * NOTE!  The following functions are purely helpers for set_ctrlr_state.
  1524.  * Do not call them directly; set_ctrlr_state does the correct serialisation
  1525.  * to ensure that things happen in the right way 100% of time time.
  1526.  * -- rmk
  1527.  */
  1529. /*
  1530.  * FIXME: move LCD power stuff into sa1100fb_power_up_lcd()
  1531.  * Also, I'm expecting that the backlight stuff should
  1532.  * be handled differently.
  1533.  */
  1534. static void sa1100fb_backlight_on(struct sa1100fb_info *fbi)
  1535. {
  1536. DPRINTK("backlight onn");
  1538. #ifdef CONFIG_SA1100_FREEBIRD
  1539. #error FIXME
  1540. if (machine_is_freebird()) {
  1541. BCR_set(BCR_FREEBIRD_LCD_PWR | BCR_FREEBIRD_LCD_DISP);
  1542. }
  1543. #endif
  1544. #ifdef CONFIG_SA1100_FREEBIRD
  1545. if (machine_is_freebird()) {
  1546. /* Turn on backlight ,Chester */
  1547. BCR_set(BCR_FREEBIRD_LCD_BACKLIGHT);
  1548. }
  1549. #endif
  1550. #ifdef CONFIG_SA1100_HUW_WEBPANEL
  1551. #error FIXME
  1552. if (machine_is_huw_webpanel()) {
  1553. BCR_set(BCR_CCFL_POW + BCR_PWM_BACKLIGHT);
  1554. set_current_state(TASK_UNINTERRUPTIBLE);
  1555. schedule_task(200 * HZ / 1000);
  1556. BCR_set(BCR_TFT_ENA);
  1557. }
  1558. #endif
  1559. #ifdef CONFIG_SA1100_OMNIMETER
  1560. if (machine_is_omnimeter())
  1561. LEDBacklightOn();
  1562. #endif
  1563. #ifdef CONFIG_SA1100_FRODO
  1564. if (machine_is_frodo())
  1565. FRODO_CPLD_GENERAL |= FRODO_LCD_BACKLIGHT;
  1566. #endif
  1567. }
  1569. /*
  1570.  * FIXME: move LCD power stuf into sa1100fb_power_down_lcd()
  1571.  * Also, I'm expecting that the backlight stuff should
  1572.  * be handled differently.
  1573.  */
  1574. static void sa1100fb_backlight_off(struct sa1100fb_info *fbi)
  1575. {
  1576. DPRINTK("backlight offn");
  1578. #ifdef CONFIG_SA1100_FREEBIRD
  1579. #error FIXME
  1580. if (machine_is_freebird()) {
  1581. BCR_clear(BCR_FREEBIRD_LCD_PWR | BCR_FREEBIRD_LCD_DISP
  1582.   /*| BCR_FREEBIRD_LCD_BACKLIGHT */ );
  1583. }
  1584. #endif
  1585. #ifdef CONFIG_SA1100_OMNIMETER
  1586. if (machine_is_omnimeter())
  1587. LEDBacklightOff();
  1588. #endif
  1589. #ifdef CONFIG_SA1100_FRODO
  1590. if (machine_is_frodo())
  1591. FRODO_CPLD_GENERAL &= ~FRODO_LCD_BACKLIGHT;
  1592. #endif
  1593. }
  1595. static void sa1100fb_power_up_lcd(struct sa1100fb_info *fbi)
  1596. {
  1597. DPRINTK("LCD power onn");
  1599. #ifndef ASSABET_PAL_VIDEO
  1600. if (machine_is_assabet())
  1601. ASSABET_BCR_set(ASSABET_BCR_LCD_ON);
  1602. #endif
  1603. #ifdef CONFIG_SA1100_HUW_WEBPANEL
  1604. if (machine_is_huw_webpanel())
  1605. BCR_clear(BCR_TFT_NPWR);
  1606. #endif
  1607. #ifdef CONFIG_SA1100_OMNIMETER
  1608. if (machine_is_omnimeter())
  1609. LCDPowerOn();
  1610. #endif
  1611. if (machine_is_h3xxx())
  1612. set_h3600_egpio( IPAQ_EGPIO_LCD_ON );     /* Turn on power to the LCD */
  1613. #ifdef CONFIG_SA1100_STORK
  1614. if (machine_is_stork()) {
  1615. storkSetLCDCPLD(0, 1);
  1616. storkSetLatchA(STORK_LCD_BACKLIGHT_INVERTER_ON);
  1617.   }
  1618. #endif
  1619. #ifdef CONFIG_SA1100_FRODO
  1620. if (machine_is_frodo())
  1621. sa1100fb_backlight_on(fbi);
  1622. #endif
  1623. }
  1625. static void sa1100fb_power_down_lcd(struct sa1100fb_info *fbi)
  1626. {
  1627. DPRINTK("LCD power offn");
  1629. #ifndef ASSABET_PAL_VIDEO
  1630. if (machine_is_assabet())
  1631. ASSABET_BCR_clear(ASSABET_BCR_LCD_ON);
  1632. #endif
  1633. #ifdef CONFIG_SA1100_HUW_WEBPANEL
  1634. // dont forget to set the control lines to zero (?)
  1635. if (machine_is_huw_webpanel())
  1636. BCR_set(BCR_TFT_NPWR);
  1637. #endif
  1638. if (machine_is_h3xxx())
  1639. clr_h3600_egpio( IPAQ_EGPIO_LCD_ON );
  1640. #ifdef CONFIG_SA1100_STORK
  1641. if (machine_is_stork()) {
  1642. storkSetLCDCPLD(0, 0);
  1643. storkClearLatchA(STORK_LCD_BACKLIGHT_INVERTER_ON);
  1644. }
  1645. #endif
  1646. #ifdef CONFIG_SA1100_FRODO
  1647. if (machine_is_frodo())
  1648. sa1100fb_backlight_off(fbi);
  1649. #endif
  1650. }
  1652. static void sa1100fb_setup_gpio(struct sa1100fb_info *fbi)
  1653. {
  1654. u_int mask = 0;
  1656. /*
  1657.  * Enable GPIO<9:2> for LCD use if:
  1658.  *  1. Active display, or
  1659.  *  2. Color Dual Passive display
  1660.  *
  1661.  * see table 11.8 on page 11-27 in the SA1100 manual
  1662.  *   -- Erik.
  1663.  *
  1664.  * SA1110 spec update nr. 25 says we can and should
  1665.  * clear LDD15 to 12 for 4 or 8bpp modes with active
  1666.  * panels.  
  1667.  */
  1668. if ((fbi->reg_lccr0 & LCCR0_CMS) == LCCR0_Color &&
  1669.     (fbi->reg_lccr0 & (LCCR0_Dual|LCCR0_Act)) != 0) {
  1670. mask = GPIO_LDD11 | GPIO_LDD10 | GPIO_LDD9  | GPIO_LDD8;
  1672. if (fbi->fb.var.bits_per_pixel > 8 ||
  1673.     (fbi->reg_lccr0 & (LCCR0_Dual|LCCR0_Act)) == LCCR0_Dual)
  1674. mask |= GPIO_LDD15 | GPIO_LDD14 | GPIO_LDD13 | GPIO_LDD12;
  1676. }
  1678. #ifdef CONFIG_SA1100_FREEBIRD
  1679. #error Please contact <rmk@arm.linux.org.uk> about this
  1680. if (machine_is_freebird()) {
  1681. /* Color single passive */
  1682. mask |= GPIO_LDD15 | GPIO_LDD14 | GPIO_LDD13 | GPIO_LDD12 |
  1683. GPIO_LDD11 | GPIO_LDD10 | GPIO_LDD9  | GPIO_LDD8;
  1684. }
  1685. #endif
  1686. if (machine_is_cerf()) {
  1687. /* GPIO15 is used as a bypass for 3.8" displays */
  1688. mask |= GPIO_GPIO15;
  1689. #ifdef CONFIG_SA1100_CERF
  1690. #warning Read Me Now!
  1691. #endif
  1692. #if 0 /* if this causes you problems, mail <rmk@arm.linux.org.uk> please. */
  1693.       /*
  1694.        * This was enabled for the 72_A version only, which is a _color_
  1695.        * _dual_ LCD.  Now look at the generic test above, and calculate
  1696.        * the mask value for a colour dual display...
  1697.        *
  1698.        * I therefore conclude that the code below is redundant, and will
  1699.        * be killed at the start of November 2001.
  1700.        */
  1701. /* FIXME: why is this? The Cerf's display doesn't seem
  1702.  * to be dual scan or active. I just leave it here,
  1703.  * but in my opinion this is definitively wrong.
  1704.  *  -- Erik <J.A.K.Mouw@its.tudelft.nl>
  1705.  */
  1707. /* REPLY: Umm.. Well to be honest, the 5.7" LCD which
  1708.  * this was used for does not use these pins, but
  1709.  * apparently all hell breaks loose if they are not
  1710.  * set on the Cerf, so we decided to leave them in ;)
  1711.  *  -- Daniel Chemko <dchemko@intrinsyc.com>
  1712.  */
  1713. /* color {dual/single} passive */
  1714. mask |= GPIO_LDD15 | GPIO_LDD14 | GPIO_LDD13 | GPIO_LDD12 |
  1715. GPIO_LDD11 | GPIO_LDD10 | GPIO_LDD9  | GPIO_LDD8;
  1716. #endif
  1717. }
  1719. if (mask) {
  1720. GPDR |= mask;
  1721. GAFR |= mask;
  1722. }
  1723. }
  1725. static void sa1100fb_enable_controller(struct sa1100fb_info *fbi)
  1726. {
  1727. DPRINTK("Enabling LCD controllern");
  1729. /*
  1730.  * Make sure the mode bits are present in the first palette entry
  1731.  */
  1732. fbi->palette_cpu[0] &= 0xcfff;
  1733. fbi->palette_cpu[0] |= palette_pbs(&fbi->fb.var);
  1735. /* Sequence from 11.7.10 */
  1736. LCCR3 = fbi->reg_lccr3;
  1737. LCCR2 = fbi->reg_lccr2;
  1738. LCCR1 = fbi->reg_lccr1;
  1739. LCCR0 = fbi->reg_lccr0 & ~LCCR0_LEN;
  1740. DBAR1 = fbi->dbar1;
  1741. DBAR2 = fbi->dbar2;
  1742. LCCR0 |= LCCR0_LEN;
  1744. #ifdef CONFIG_SA1100_GRAPHICSCLIENT
  1745. #error Where is GPIO24 set as an output?  Can we fit this in somewhere else?
  1746. if (machine_is_graphicsclient()) {
  1747. // From ADS doc again...same as disable
  1748. set_current_state(TASK_UNINTERRUPTIBLE);
  1749. schedule_timeout(20 * HZ / 1000);
  1750. GPSR |= GPIO_GPIO24;
  1751. }
  1752. #endif
  1754. if (machine_is_shannon()) {
  1755. GPDR |= SHANNON_GPIO_DISP_EN;
  1756. GPSR |= SHANNON_GPIO_DISP_EN;
  1757. }
  1759. DPRINTK("DBAR1 = %pn", DBAR1);
  1760. DPRINTK("DBAR2 = %pn", DBAR2);
  1761. DPRINTK("LCCR0 = 0x%08xn", LCCR0);
  1762. DPRINTK("LCCR1 = 0x%08xn", LCCR1);
  1763. DPRINTK("LCCR2 = 0x%08xn", LCCR2);
  1764. DPRINTK("LCCR3 = 0x%08xn", LCCR3);
  1765. }
  1767. static void sa1100fb_disable_controller(struct sa1100fb_info *fbi)
  1768. {
  1769. DECLARE_WAITQUEUE(wait, current);
  1771. DPRINTK("Disabling LCD controllern");
  1773. #ifdef CONFIG_SA1100_GRAPHICSCLIENT
  1774. #error Where is GPIO24 set as an output?  Can we fit this in somewhere else?
  1775. if (machine_is_graphicsclient()) {
  1776. /*
  1777.  * From ADS internal document:
  1778.  *  GPIO24 should be LOW at least 10msec prior to disabling
  1779.  *  the LCD interface.
  1780.  *
  1781.  * We'll wait 20msec.
  1782.  */
  1783. GPCR |= GPIO_GPIO24;
  1784. set_current_state(TASK_UNINTERRUPTIBLE);
  1785. schedule_timeout(20 * HZ / 1000);
  1786. }
  1787. #endif
  1788. #ifdef CONFIG_SA1100_HUW_WEBPANEL
  1789. #error Move me into sa1100fb_power_up_lcd and/or sa1100fb_backlight_on
  1790. if (machine_is_huw_webpanel()) {
  1791. // dont forget to set the control lines to zero (?)
  1792. DPRINTK("ShutDown HuW LCD controllern");
  1793. BCR_clear(BCR_TFT_ENA + BCR_CCFL_POW + BCR_PWM_BACKLIGHT);
  1794. }
  1795. #endif
  1797. if (machine_is_shannon()) {
  1798. GPCR |= SHANNON_GPIO_DISP_EN;
  1799. }
  1801. add_wait_queue(&fbi->ctrlr_wait, &wait);
  1802. set_current_state(TASK_UNINTERRUPTIBLE);
  1804. LCSR = 0xffffffff; /* Clear LCD Status Register */
  1805. LCCR0 &= ~LCCR0_LDM; /* Enable LCD Disable Done Interrupt */
  1806. enable_irq(IRQ_LCD); /* Enable LCD IRQ */
  1807. LCCR0 &= ~LCCR0_LEN; /* Disable LCD Controller */
  1809. schedule_timeout(20 * HZ / 1000);
  1810. current->state = TASK_RUNNING;
  1811. remove_wait_queue(&fbi->ctrlr_wait, &wait);
  1812. }
  1814. /*
  1815.  *  sa1100fb_handle_irq: Handle 'LCD DONE' interrupts.
  1816.  */
  1817. static void sa1100fb_handle_irq(int irq, void *dev_id, struct pt_regs *regs)
  1818. {
  1819. struct sa1100fb_info *fbi = dev_id;
  1820. unsigned int lcsr = LCSR;
  1822. if (lcsr & LCSR_LDD) {
  1823. LCCR0 |= LCCR0_LDM;
  1824. wake_up(&fbi->ctrlr_wait);
  1825. }
  1827. LCSR = lcsr;
  1828. }
  1830. /*
  1831.  * This function must be called from task context only, since it will
  1832.  * sleep when disabling the LCD controller, or if we get two contending
  1833.  * processes trying to alter state.
  1834.  */
  1835. static void set_ctrlr_state(struct sa1100fb_info *fbi, u_int state)
  1836. {
  1837. u_int old_state;
  1839. down(&fbi->ctrlr_sem);
  1841. old_state = fbi->state;
  1843. switch (state) {
  1844. case C_DISABLE_CLKCHANGE:
  1845. /*
  1846.  * Disable controller for clock change.  If the
  1847.  * controller is already disabled, then do nothing.
  1848.  */
  1849. if (old_state != C_DISABLE && old_state != C_DISABLE_PM) {
  1850. fbi->state = state;
  1851. sa1100fb_disable_controller(fbi);
  1852. }
  1853. break;
  1855. case C_DISABLE_PM:
  1856. case C_DISABLE:
  1857. /*
  1858.  * Disable controller
  1859.  */
  1860. if (old_state != C_DISABLE) {
  1861. fbi->state = state;
  1863. sa1100fb_backlight_off(fbi);
  1864. if (old_state != C_DISABLE_CLKCHANGE)
  1865. sa1100fb_disable_controller(fbi);
  1866. sa1100fb_power_down_lcd(fbi);
  1867. }
  1868. break;
  1870. case C_ENABLE_CLKCHANGE:
  1871. /*
  1872.  * Enable the controller after clock change.  Only
  1873.  * do this if we were disabled for the clock change.
  1874.  */
  1875. if (old_state == C_DISABLE_CLKCHANGE) {
  1876. fbi->state = C_ENABLE;
  1877. sa1100fb_enable_controller(fbi);
  1878. }
  1879. break;
  1881. case C_REENABLE:
  1882. /*
  1883.  * Re-enable the controller only if it was already
  1884.  * enabled.  This is so we reprogram the control
  1885.  * registers.
  1886.  */
  1887. if (old_state == C_ENABLE) {
  1888. sa1100fb_disable_controller(fbi);
  1889. sa1100fb_setup_gpio(fbi);
  1890. sa1100fb_enable_controller(fbi);
  1891. }
  1892. break;
  1894. case C_ENABLE_PM:
  1895. /*
  1896.  * Re-enable the controller after PM.  This is not
  1897.  * perfect - think about the case where we were doing
  1898.  * a clock change, and we suspended half-way through.
  1899.  */
  1900. if (old_state != C_DISABLE_PM)
  1901. break;
  1902. /* fall through */
  1904. case C_ENABLE:
  1905. /*
  1906.  * Power up the LCD screen, enable controller, and
  1907.  * turn on the backlight.
  1908.  */
  1909. if (old_state != C_ENABLE) {
  1910. fbi->state = C_ENABLE;
  1911. sa1100fb_setup_gpio(fbi);
  1912. sa1100fb_power_up_lcd(fbi);
  1913. sa1100fb_enable_controller(fbi);
  1914. sa1100fb_backlight_on(fbi);
  1915. }
  1916. break;
  1917. }
  1918. up(&fbi->ctrlr_sem);
  1919. }
  1921. /*
  1922.  * Our LCD controller task (which is called when we blank or unblank)
  1923.  * via keventd.
  1924.  */
  1925. static void sa1100fb_task(void *dummy)
  1926. {
  1927. struct sa1100fb_info *fbi = dummy;
  1928. u_int state = xchg(&fbi->task_state, -1);
  1930. set_ctrlr_state(fbi, state);
  1931. }
  1933. #ifdef CONFIG_CPU_FREQ
  1934. /*
  1935.  * Calculate the minimum DMA period over all displays that we own.
  1936.  * This, together with the SDRAM bandwidth defines the slowest CPU
  1937.  * frequency that can be selected.
  1938.  */
  1939. static unsigned int sa1100fb_min_dma_period(struct sa1100fb_info *fbi)
  1940. {
  1941. unsigned int min_period = (unsigned int)-1;
  1942. int i;
  1944. for (i = 0; i < MAX_NR_CONSOLES; i++) {
  1945. unsigned int period;
  1947. /*
  1948.  * Do we own this display?
  1949.  */
  1950. if (fb_display[i].fb_info != &fbi->fb)
  1951. continue;
  1953. /*
  1954.  * Ok, calculate its DMA period
  1955.  */
  1956. period = sa1100fb_display_dma_period(get_con_var(&fbi->fb, i));
  1957. if (period < min_period)
  1958. min_period = period;
  1959. }
  1961. return min_period;
  1962. }
  1964. /*
  1965.  * CPU clock speed change handler.  We need to adjust the LCD timing
  1966.  * parameters when the CPU clock is adjusted by the power management
  1967.  * subsystem.
  1968.  */
  1969. static int
  1970. sa1100fb_clkchg_notifier(struct notifier_block *nb, unsigned long val,
  1971.  void *data)
  1972. {
  1973. struct sa1100fb_info *fbi = TO_INF(nb, clockchg);
  1974. struct cpufreq_minmax *mm = data;
  1975. u_int pcd;
  1977. switch (val) {
  1978. case CPUFREQ_MINMAX:
  1979. printk(KERN_DEBUG "min dma period: %d ps, old clock %d kHz, "
  1980. "new clock %d kHzn", sa1100fb_min_dma_period(fbi),
  1981. mm->cur_freq, mm->new_freq);
  1982. /* todo: fill in min/max values */
  1983. break;
  1985. case CPUFREQ_PRECHANGE:
  1986. set_ctrlr_state(fbi, C_DISABLE_CLKCHANGE);
  1987. break;
  1989. case CPUFREQ_POSTCHANGE:
  1990. pcd = get_pcd(fbi->fb.var.pixclock);
  1991. fbi->reg_lccr3 = (fbi->reg_lccr3 & ~0xff) | LCCR3_PixClkDiv(pcd);
  1992. set_ctrlr_state(fbi, C_ENABLE_CLKCHANGE);
  1993. break;
  1994. }
  1995. return 0;
  1996. }
  1997. #endif
  1999. #ifdef CONFIG_PM
  2000. /*
  2001.  * Power management hook.  Note that we won't be called from IRQ context,
  2002.  * unlike the blank functions above, so we may sleep.
  2003.  */
  2004. static int
  2005. sa1100fb_pm_callback(struct pm_dev *pm_dev, pm_request_t req, void *data)
  2006. {
  2007. struct sa1100fb_info *fbi = pm_dev->data;
  2009. DPRINTK("pm_callback: %dn", req);
  2011. if (req == PM_SUSPEND || req == PM_RESUME) {
  2012. int state = (int)data;
  2014. if (state == 0) {
  2015. /* Enter D0. */
  2016. set_ctrlr_state(fbi, C_ENABLE_PM);
  2017. } else {
  2018. /* Enter D1-D3.  Disable the LCD controller.  */
  2019. set_ctrlr_state(fbi, C_DISABLE_PM);
  2020. }
  2021. }
  2022. DPRINTK("donen");
  2023. return 0;
  2024. }
  2025. #endif
  2027. /*
  2028.  * sa1100fb_map_video_memory():
  2029.  *      Allocates the DRAM memory for the frame buffer.  This buffer is  
  2030.  * remapped into a non-cached, non-buffered, memory region to  
  2031.  *      allow palette and pixel writes to occur without flushing the 
  2032.  *      cache.  Once this area is remapped, all virtual memory
  2033.  *      access to the video memory should occur at the new region.
  2034.  */
  2035. static int __init sa1100fb_map_video_memory(struct sa1100fb_info *fbi)
  2036. {
  2037. /*
  2038.  * We reserve one page for the palette, plus the size
  2039.  * of the framebuffer.
  2040.  */
  2041. fbi->map_size = PAGE_ALIGN(fbi->fb.fix.smem_len + PAGE_SIZE);
  2042. fbi->map_cpu = consistent_alloc(GFP_KERNEL, fbi->map_size,
  2043. &fbi->map_dma);
  2045. if (fbi->map_cpu) {
  2046. fbi->screen_cpu = fbi->map_cpu + PAGE_SIZE;
  2047. fbi->screen_dma = fbi->map_dma + PAGE_SIZE;
  2048. fbi->fb.fix.smem_start = fbi->screen_dma;
  2049. }
  2051. return fbi->map_cpu ? 0 : -ENOMEM;
  2052. }
  2054. /* Fake monspecs to fill in fbinfo structure */
  2055. static struct fb_monspecs monspecs __initdata = {
  2056. 30000, 70000, 50, 65, 0 /* Generic */
  2057. };
  2060. static struct sa1100fb_info * __init sa1100fb_init_fbinfo(void)
  2061. {
  2062. struct sa1100fb_mach_info *inf;
  2063. struct sa1100fb_info *fbi;
  2065. fbi = kmalloc(sizeof(struct sa1100fb_info) + sizeof(struct display) +
  2066.       sizeof(u16) * 16, GFP_KERNEL);
  2067. if (!fbi)
  2068. return NULL;
  2070. memset(fbi, 0, sizeof(struct sa1100fb_info) + sizeof(struct display));
  2072. fbi->currcon = -1;
  2074. strcpy(fbi->fb.fix.id, SA1100_NAME);
  2076. fbi->fb.fix.type = FB_TYPE_PACKED_PIXELS;
  2077. fbi->fb.fix.type_aux = 0;
  2078. fbi->fb.fix.xpanstep = 0;
  2079. fbi->fb.fix.ypanstep = 0;
  2080. fbi->fb.fix.ywrapstep = 0;
  2081. fbi->fb.fix.accel = FB_ACCEL_NONE;
  2083. fbi->fb.var.nonstd = 0;
  2084. fbi->fb.var.activate = FB_ACTIVATE_NOW;
  2085. fbi->fb.var.height = -1;
  2086. fbi->fb.var.width = -1;
  2087. fbi->fb.var.accel_flags = 0;
  2088. fbi->fb.var.vmode = FB_VMODE_NONINTERLACED;
  2090. strcpy(fbi->fb.modename, SA1100_NAME);
  2091. strcpy(fbi->fb.fontname, "Acorn8x8");
  2093. fbi->fb.fbops = &sa1100fb_ops;
  2094. fbi->fb.changevar = NULL;
  2095. fbi->fb.switch_con = sa1100fb_switch;
  2096. fbi->fb.updatevar = sa1100fb_updatevar;
  2097. fbi->fb.blank = sa1100fb_blank;
  2098. fbi->fb.flags = FBINFO_FLAG_DEFAULT;
  2099. fbi->fb.node = -1;
  2100. fbi->fb.monspecs = monspecs;
  2101. fbi->fb.disp = (struct display *)(fbi + 1);
  2102. fbi->fb.pseudo_palette = (void *)(fbi->fb.disp + 1);
  2104. fbi->rgb[RGB_8] = &rgb_8;
  2105. fbi->rgb[RGB_16] = &def_rgb_16;
  2107. inf = sa1100fb_get_machine_info(fbi);
  2109. fbi->max_xres = inf->xres;
  2110. fbi->fb.var.xres = inf->xres;
  2111. fbi->fb.var.xres_virtual = inf->xres;
  2112. fbi->max_yres = inf->yres;
  2113. fbi->fb.var.yres = inf->yres;
  2114. fbi->fb.var.yres_virtual = inf->yres;
  2115. fbi->max_bpp = inf->bpp;
  2116. fbi->fb.var.bits_per_pixel = inf->bpp;
  2117. fbi->fb.var.pixclock = inf->pixclock;
  2118. fbi->fb.var.hsync_len = inf->hsync_len;
  2119. fbi->fb.var.left_margin = inf->left_margin;
  2120. fbi->fb.var.right_margin = inf->right_margin;
  2121. fbi->fb.var.vsync_len = inf->vsync_len;
  2122. fbi->fb.var.upper_margin = inf->upper_margin;
  2123. fbi->fb.var.lower_margin = inf->lower_margin;
  2124. fbi->fb.var.sync = inf->sync;
  2125. fbi->fb.var.grayscale = inf->cmap_greyscale;
  2126. fbi->cmap_inverse = inf->cmap_inverse;
  2127. fbi->cmap_static = inf->cmap_static;
  2128. fbi->lccr0 = inf->lccr0;
  2129. fbi->lccr3 = inf->lccr3;
  2130. fbi->state = C_DISABLE;
  2131. fbi->task_state = (u_char)-1;
  2132. fbi->fb.fix.smem_len = fbi->max_xres * fbi->max_yres *
  2133.   fbi->max_bpp / 8;
  2135. init_waitqueue_head(&fbi->ctrlr_wait);
  2136. INIT_TQUEUE(&fbi->task, sa1100fb_task, fbi);
  2137. init_MUTEX(&fbi->ctrlr_sem);
  2139. return fbi;
  2140. }
  2142. int __init sa1100fb_init(void)
  2143. {
  2144. struct sa1100fb_info *fbi;
  2145. int ret;
  2147. fbi = sa1100fb_init_fbinfo();
  2148. ret = -ENOMEM;
  2149. if (!fbi)
  2150. goto failed;
  2152. /* Initialize video memory */
  2153. ret = sa1100fb_map_video_memory(fbi);
  2154. if (ret)
  2155. goto failed;
  2157. ret = request_irq(IRQ_LCD, sa1100fb_handle_irq, SA_INTERRUPT,
  2158.   "LCD", fbi);
  2159. if (ret) {
  2160. printk(KERN_ERR "sa1100fb: request_irq failed: %dn", ret);
  2161. goto failed;
  2162. }
  2164. #ifdef ASSABET_PAL_VIDEO
  2165. if (machine_is_assabet())
  2166. ASSABET_BCR_clear(ASSABET_BCR_LCD_ON);
  2167. #endif
  2169. #ifdef CONFIG_SA1100_FREEBIRD
  2170. #error Please move this into sa1100fb_power_up_lcd
  2171. if (machine_is_freebird()) {
  2172. BCR_set(BCR_FREEBIRD_LCD_DISP);
  2173. mdelay(20);
  2174. BCR_set(BCR_FREEBIRD_LCD_PWR);
  2175. mdelay(20);
  2176. }
  2177. #endif
  2179. sa1100fb_set_var(&fbi->fb.var, -1, &fbi->fb);
  2181. ret = register_framebuffer(&fbi->fb);
  2182. if (ret < 0)
  2183. goto failed;
  2185. #ifdef CONFIG_PM
  2186. /*
  2187.  * Note that the console registers this as well, but we want to
  2188.  * power down the display prior to sleeping.
  2189.  */
  2190. fbi->pm = pm_register(PM_SYS_DEV, PM_SYS_VGA, sa1100fb_pm_callback);
  2191. if (fbi->pm)
  2192. fbi->pm->data = fbi;
  2193. #endif
  2194. #ifdef CONFIG_CPU_FREQ
  2195. fbi->clockchg.notifier_call = sa1100fb_clkchg_notifier;
  2196. cpufreq_register_notifier(&fbi->clockchg);
  2197. #endif
  2199. /*
  2200.  * Ok, now enable the LCD controller
  2201.  */
  2202. set_ctrlr_state(fbi, C_ENABLE);
  2204. /* This driver cannot be unloaded at the moment */
  2205. MOD_INC_USE_COUNT;
  2207. return 0;
  2209. failed:
  2210. if (fbi)
  2211. kfree(fbi);
  2212. return ret;
  2213. }
  2215. int __init sa1100fb_setup(char *options)
  2216. {
  2217. #if 0
  2218. char *this_opt;
  2220. if (!options || !*options)
  2221. return 0;
  2223. while ((this_opt = strsep(&options, ",")) != NULL) {
  2225. if (!strncmp(this_opt, "bpp:", 4))
  2226. current_par.max_bpp =
  2227.     simple_strtoul(this_opt + 4, NULL, 0);
  2229. if (!strncmp(this_opt, "lccr0:", 6))
  2230. lcd_shadow.lccr0 =
  2231.     simple_strtoul(this_opt + 6, NULL, 0);
  2232. if (!strncmp(this_opt, "lccr1:", 6)) {
  2233. lcd_shadow.lccr1 =
  2234.     simple_strtoul(this_opt + 6, NULL, 0);
  2235. current_par.max_xres =
  2236.     (lcd_shadow.lccr1 & 0x3ff) + 16;
  2237. }
  2238. if (!strncmp(this_opt, "lccr2:", 6)) {
  2239. lcd_shadow.lccr2 =
  2240.     simple_strtoul(this_opt + 6, NULL, 0);
  2241. current_par.max_yres =
  2242.     (lcd_shadow.
  2243.      lccr0 & LCCR0_SDS) ? ((lcd_shadow.
  2244.     lccr2 & 0x3ff) +
  2245.    1) *
  2246.     2 : ((lcd_shadow.lccr2 & 0x3ff) + 1);
  2247. }
  2248. if (!strncmp(this_opt, "lccr3:", 6))
  2249. lcd_shadow.lccr3 =
  2250.     simple_strtoul(this_opt + 6, NULL, 0);
  2251. }
  2252. #endif
  2253. return 0;
  2254. }
  2256. MODULE_DESCRIPTION("StrongARM-1100/1110 framebuffer driver");
  2257. MODULE_LICENSE("GPL");