treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / arch / arm / mach-pxa / pcm990-baseboard.c
blobcb1c56769fbc5f7761267b7d89a2c1c5b32cf4f6
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * arch/arm/mach-pxa/pcm990-baseboard.c
4 * Support for the Phytec phyCORE-PXA270 Development Platform (PCM-990).
6 * Refer
7 * http://www.phytec.com/products/rdk/ARM-XScale/phyCORE-XScale-PXA270.html
8 * for additional hardware info
10 * Author: Juergen Kilb
11 * Created: April 05, 2005
12 * Copyright: Phytec Messtechnik GmbH
13 * e-Mail: armlinux@phytec.de
15 * based on Intel Mainstone Board
17 * Copyright 2007 Juergen Beisert @ Pengutronix (j.beisert@pengutronix.de)
19 #include <linux/gpio.h>
20 #include <linux/irq.h>
21 #include <linux/platform_device.h>
22 #include <linux/i2c.h>
23 #include <linux/platform_data/i2c-pxa.h>
24 #include <linux/pwm.h>
25 #include <linux/pwm_backlight.h>
27 #include <media/i2c/mt9v022.h>
28 #include <media/soc_camera.h>
30 #include <linux/platform_data/media/camera-pxa.h>
31 #include <asm/mach/map.h>
32 #include "pxa27x.h"
33 #include <mach/audio.h>
34 #include <linux/platform_data/mmc-pxamci.h>
35 #include <linux/platform_data/usb-ohci-pxa27x.h>
36 #include "pcm990_baseboard.h"
37 #include <linux/platform_data/video-pxafb.h>
39 #include "devices.h"
40 #include "generic.h"
42 static unsigned long pcm990_pin_config[] __initdata = {
43 /* MMC */
44 GPIO32_MMC_CLK,
45 GPIO112_MMC_CMD,
46 GPIO92_MMC_DAT_0,
47 GPIO109_MMC_DAT_1,
48 GPIO110_MMC_DAT_2,
49 GPIO111_MMC_DAT_3,
50 /* USB */
51 GPIO88_USBH1_PWR,
52 GPIO89_USBH1_PEN,
53 /* PWM0 */
54 GPIO16_PWM0_OUT,
56 /* I2C */
57 GPIO117_I2C_SCL,
58 GPIO118_I2C_SDA,
60 /* AC97 */
61 GPIO28_AC97_BITCLK,
62 GPIO29_AC97_SDATA_IN_0,
63 GPIO30_AC97_SDATA_OUT,
64 GPIO31_AC97_SYNC,
67 static void __iomem *pcm990_cpld_base;
69 static u8 pcm990_cpld_readb(unsigned int reg)
71 return readb(pcm990_cpld_base + reg);
74 static void pcm990_cpld_writeb(u8 value, unsigned int reg)
76 writeb(value, pcm990_cpld_base + reg);
80 * pcm990_lcd_power - control power supply to the LCD
81 * @on: 0 = switch off, 1 = switch on
83 * Called by the pxafb driver
85 #ifndef CONFIG_PCM990_DISPLAY_NONE
86 static void pcm990_lcd_power(int on, struct fb_var_screeninfo *var)
88 if (on) {
89 /* enable LCD-Latches
90 * power on LCD
92 pcm990_cpld_writeb(PCM990_CTRL_LCDPWR + PCM990_CTRL_LCDON,
93 PCM990_CTRL_REG3);
94 } else {
95 /* disable LCD-Latches
96 * power off LCD
98 pcm990_cpld_writeb(0, PCM990_CTRL_REG3);
101 #endif
103 #if defined(CONFIG_PCM990_DISPLAY_SHARP)
104 static struct pxafb_mode_info fb_info_sharp_lq084v1dg21 = {
105 .pixclock = 28000,
106 .xres = 640,
107 .yres = 480,
108 .bpp = 16,
109 .hsync_len = 20,
110 .left_margin = 103,
111 .right_margin = 47,
112 .vsync_len = 6,
113 .upper_margin = 28,
114 .lower_margin = 5,
115 .sync = 0,
116 .cmap_greyscale = 0,
119 static struct pxafb_mach_info pcm990_fbinfo __initdata = {
120 .modes = &fb_info_sharp_lq084v1dg21,
121 .num_modes = 1,
122 .lcd_conn = LCD_COLOR_TFT_16BPP | LCD_PCLK_EDGE_FALL,
123 .pxafb_lcd_power = pcm990_lcd_power,
125 #elif defined(CONFIG_PCM990_DISPLAY_NEC)
126 struct pxafb_mode_info fb_info_nec_nl6448bc20_18d = {
127 .pixclock = 39720,
128 .xres = 640,
129 .yres = 480,
130 .bpp = 16,
131 .hsync_len = 32,
132 .left_margin = 16,
133 .right_margin = 48,
134 .vsync_len = 2,
135 .upper_margin = 12,
136 .lower_margin = 17,
137 .sync = 0,
138 .cmap_greyscale = 0,
141 static struct pxafb_mach_info pcm990_fbinfo __initdata = {
142 .modes = &fb_info_nec_nl6448bc20_18d,
143 .num_modes = 1,
144 .lcd_conn = LCD_COLOR_TFT_16BPP | LCD_PCLK_EDGE_FALL,
145 .pxafb_lcd_power = pcm990_lcd_power,
147 #endif
149 static struct pwm_lookup pcm990_pwm_lookup[] = {
150 PWM_LOOKUP("pxa27x-pwm.0", 0, "pwm-backlight.0", NULL, 78770,
151 PWM_POLARITY_NORMAL),
154 static struct platform_pwm_backlight_data pcm990_backlight_data = {
155 .max_brightness = 1023,
156 .dft_brightness = 1023,
157 .enable_gpio = -1,
160 static struct platform_device pcm990_backlight_device = {
161 .name = "pwm-backlight",
162 .dev = {
163 .parent = &pxa27x_device_pwm0.dev,
164 .platform_data = &pcm990_backlight_data,
169 * The PCM-990 development baseboard uses PCM-027's hardware in the
170 * following way:
172 * - LCD support is in use
173 * - GPIO16 is output for back light on/off with PWM
174 * - GPIO58 ... GPIO73 are outputs for display data
175 * - GPIO74 is output output for LCDFCLK
176 * - GPIO75 is output for LCDLCLK
177 * - GPIO76 is output for LCDPCLK
178 * - GPIO77 is output for LCDBIAS
179 * - MMC support is in use
180 * - GPIO32 is output for MMCCLK
181 * - GPIO92 is MMDAT0
182 * - GPIO109 is MMDAT1
183 * - GPIO110 is MMCS0
184 * - GPIO111 is MMCS1
185 * - GPIO112 is MMCMD
186 * - IDE/CF card is in use
187 * - GPIO48 is output /POE
188 * - GPIO49 is output /PWE
189 * - GPIO50 is output /PIOR
190 * - GPIO51 is output /PIOW
191 * - GPIO54 is output /PCE2
192 * - GPIO55 is output /PREG
193 * - GPIO56 is input /PWAIT
194 * - GPIO57 is output /PIOS16
195 * - GPIO79 is output PSKTSEL
196 * - GPIO85 is output /PCE1
197 * - FFUART is in use
198 * - GPIO34 is input FFRXD
199 * - GPIO35 is input FFCTS
200 * - GPIO36 is input FFDCD
201 * - GPIO37 is input FFDSR
202 * - GPIO38 is input FFRI
203 * - GPIO39 is output FFTXD
204 * - GPIO40 is output FFDTR
205 * - GPIO41 is output FFRTS
206 * - BTUART is in use
207 * - GPIO42 is input BTRXD
208 * - GPIO43 is output BTTXD
209 * - GPIO44 is input BTCTS
210 * - GPIO45 is output BTRTS
211 * - IRUART is in use
212 * - GPIO46 is input STDRXD
213 * - GPIO47 is output STDTXD
214 * - AC97 is in use*)
215 * - GPIO28 is input AC97CLK
216 * - GPIO29 is input AC97DatIn
217 * - GPIO30 is output AC97DatO
218 * - GPIO31 is output AC97SYNC
219 * - GPIO113 is output AC97_RESET
220 * - SSP is in use
221 * - GPIO23 is output SSPSCLK
222 * - GPIO24 is output chip select to Max7301
223 * - GPIO25 is output SSPTXD
224 * - GPIO26 is input SSPRXD
225 * - GPIO27 is input for Max7301 IRQ
226 * - GPIO53 is input SSPSYSCLK
227 * - SSP3 is in use
228 * - GPIO81 is output SSPTXD3
229 * - GPIO82 is input SSPRXD3
230 * - GPIO83 is output SSPSFRM
231 * - GPIO84 is output SSPCLK3
233 * Otherwise claimed GPIOs:
234 * GPIO1 -> IRQ from user switch
235 * GPIO9 -> IRQ from power management
236 * GPIO10 -> IRQ from WML9712 AC97 controller
237 * GPIO11 -> IRQ from IDE controller
238 * GPIO12 -> IRQ from CF controller
239 * GPIO13 -> IRQ from CF controller
240 * GPIO14 -> GPIO free
241 * GPIO15 -> /CS1 selects baseboard's Control CPLD (U7, 16 bit wide data path)
242 * GPIO19 -> GPIO free
243 * GPIO20 -> /SDCS2
244 * GPIO21 -> /CS3 PC card socket select
245 * GPIO33 -> /CS5 network controller select
246 * GPIO78 -> /CS2 (16 bit wide data path)
247 * GPIO80 -> /CS4 (16 bit wide data path)
248 * GPIO86 -> GPIO free
249 * GPIO87 -> GPIO free
250 * GPIO90 -> LED0 on CPU module
251 * GPIO91 -> LED1 on CPI module
252 * GPIO117 -> SCL
253 * GPIO118 -> SDA
256 static unsigned long pcm990_irq_enabled;
258 static void pcm990_mask_ack_irq(struct irq_data *d)
260 int pcm990_irq = (d->irq - PCM027_IRQ(0));
262 pcm990_irq_enabled &= ~(1 << pcm990_irq);
264 pcm990_cpld_writeb(pcm990_irq_enabled, PCM990_CTRL_INTMSKENA);
267 static void pcm990_unmask_irq(struct irq_data *d)
269 int pcm990_irq = (d->irq - PCM027_IRQ(0));
270 u8 val;
272 /* the irq can be acknowledged only if deasserted, so it's done here */
274 pcm990_irq_enabled |= (1 << pcm990_irq);
276 val = pcm990_cpld_readb(PCM990_CTRL_INTSETCLR);
277 val |= 1 << pcm990_irq;
278 pcm990_cpld_writeb(val, PCM990_CTRL_INTSETCLR);
280 pcm990_cpld_writeb(pcm990_irq_enabled, PCM990_CTRL_INTMSKENA);
283 static struct irq_chip pcm990_irq_chip = {
284 .irq_mask_ack = pcm990_mask_ack_irq,
285 .irq_unmask = pcm990_unmask_irq,
288 static void pcm990_irq_handler(struct irq_desc *desc)
290 unsigned int irq;
291 unsigned long pending;
293 pending = ~pcm990_cpld_readb(PCM990_CTRL_INTSETCLR);
294 pending &= pcm990_irq_enabled;
296 do {
297 /* clear our parent IRQ */
298 desc->irq_data.chip->irq_ack(&desc->irq_data);
299 if (likely(pending)) {
300 irq = PCM027_IRQ(0) + __ffs(pending);
301 generic_handle_irq(irq);
303 pending = ~pcm990_cpld_readb(PCM990_CTRL_INTSETCLR);
304 pending &= pcm990_irq_enabled;
305 } while (pending);
308 static void __init pcm990_init_irq(void)
310 int irq;
312 /* setup extra PCM990 irqs */
313 for (irq = PCM027_IRQ(0); irq <= PCM027_IRQ(3); irq++) {
314 irq_set_chip_and_handler(irq, &pcm990_irq_chip,
315 handle_level_irq);
316 irq_clear_status_flags(irq, IRQ_NOREQUEST | IRQ_NOPROBE);
319 /* disable all Interrupts */
320 pcm990_cpld_writeb(0x0, PCM990_CTRL_INTMSKENA);
321 pcm990_cpld_writeb(0xff, PCM990_CTRL_INTSETCLR);
323 irq_set_chained_handler(PCM990_CTRL_INT_IRQ, pcm990_irq_handler);
324 irq_set_irq_type(PCM990_CTRL_INT_IRQ, PCM990_CTRL_INT_IRQ_EDGE);
327 static int pcm990_mci_init(struct device *dev, irq_handler_t mci_detect_int,
328 void *data)
330 int err;
332 err = request_irq(PCM027_MMCDET_IRQ, mci_detect_int, 0,
333 "MMC card detect", data);
334 if (err)
335 printk(KERN_ERR "pcm990_mci_init: MMC/SD: can't request MMC "
336 "card detect IRQ\n");
338 return err;
341 static int pcm990_mci_setpower(struct device *dev, unsigned int vdd)
343 struct pxamci_platform_data *p_d = dev->platform_data;
344 u8 val;
346 val = pcm990_cpld_readb(PCM990_CTRL_REG5);
348 if ((1 << vdd) & p_d->ocr_mask)
349 val |= PCM990_CTRL_MMC2PWR;
350 else
351 val &= ~PCM990_CTRL_MMC2PWR;
353 pcm990_cpld_writeb(PCM990_CTRL_MMC2PWR, PCM990_CTRL_REG5);
354 return 0;
357 static void pcm990_mci_exit(struct device *dev, void *data)
359 free_irq(PCM027_MMCDET_IRQ, data);
362 #define MSECS_PER_JIFFY (1000/HZ)
364 static struct pxamci_platform_data pcm990_mci_platform_data = {
365 .detect_delay_ms = 250,
366 .ocr_mask = MMC_VDD_32_33 | MMC_VDD_33_34,
367 .init = pcm990_mci_init,
368 .setpower = pcm990_mci_setpower,
369 .exit = pcm990_mci_exit,
372 static struct pxaohci_platform_data pcm990_ohci_platform_data = {
373 .port_mode = PMM_PERPORT_MODE,
374 .flags = ENABLE_PORT1 | POWER_CONTROL_LOW | POWER_SENSE_LOW,
375 .power_on_delay = 10,
379 * PXA27x Camera specific stuff
381 #if defined(CONFIG_VIDEO_PXA27x) || defined(CONFIG_VIDEO_PXA27x_MODULE)
382 static unsigned long pcm990_camera_pin_config[] = {
383 /* CIF */
384 GPIO98_CIF_DD_0,
385 GPIO105_CIF_DD_1,
386 GPIO104_CIF_DD_2,
387 GPIO103_CIF_DD_3,
388 GPIO95_CIF_DD_4,
389 GPIO94_CIF_DD_5,
390 GPIO93_CIF_DD_6,
391 GPIO108_CIF_DD_7,
392 GPIO107_CIF_DD_8,
393 GPIO106_CIF_DD_9,
394 GPIO42_CIF_MCLK,
395 GPIO45_CIF_PCLK,
396 GPIO43_CIF_FV,
397 GPIO44_CIF_LV,
401 * CICR4: PCLK_EN: Pixel clock is supplied by the sensor
402 * MCLK_EN: Master clock is generated by PXA
403 * PCP: Data sampled on the falling edge of pixel clock
405 struct pxacamera_platform_data pcm990_pxacamera_platform_data = {
406 .flags = PXA_CAMERA_MASTER | PXA_CAMERA_DATAWIDTH_8 | PXA_CAMERA_DATAWIDTH_10 |
407 PXA_CAMERA_PCLK_EN | PXA_CAMERA_MCLK_EN/* | PXA_CAMERA_PCP*/,
408 .mclk_10khz = 1000,
411 #include <linux/platform_data/pca953x.h>
413 static struct pca953x_platform_data pca9536_data = {
414 .gpio_base = PXA_NR_BUILTIN_GPIO,
417 static int gpio_bus_switch = -EINVAL;
419 static int pcm990_camera_set_bus_param(struct soc_camera_link *link,
420 unsigned long flags)
422 if (gpio_bus_switch < 0) {
423 if (flags == SOCAM_DATAWIDTH_10)
424 return 0;
425 else
426 return -EINVAL;
429 if (flags & SOCAM_DATAWIDTH_8)
430 gpio_set_value_cansleep(gpio_bus_switch, 1);
431 else
432 gpio_set_value_cansleep(gpio_bus_switch, 0);
434 return 0;
437 static unsigned long pcm990_camera_query_bus_param(struct soc_camera_link *link)
439 int ret;
441 if (gpio_bus_switch < 0) {
442 ret = gpio_request(PXA_NR_BUILTIN_GPIO, "camera");
443 if (!ret) {
444 gpio_bus_switch = PXA_NR_BUILTIN_GPIO;
445 gpio_direction_output(gpio_bus_switch, 0);
449 if (gpio_bus_switch >= 0)
450 return SOCAM_DATAWIDTH_8 | SOCAM_DATAWIDTH_10;
451 else
452 return SOCAM_DATAWIDTH_10;
455 static void pcm990_camera_free_bus(struct soc_camera_link *link)
457 if (gpio_bus_switch < 0)
458 return;
460 gpio_free(gpio_bus_switch);
461 gpio_bus_switch = -EINVAL;
464 /* Board I2C devices. */
465 static struct i2c_board_info __initdata pcm990_i2c_devices[] = {
467 /* Must initialize before the camera(s) */
468 I2C_BOARD_INFO("pca9536", 0x41),
469 .platform_data = &pca9536_data,
473 static struct mt9v022_platform_data mt9v022_pdata = {
474 .y_skip_top = 1,
477 static struct i2c_board_info pcm990_camera_i2c[] = {
479 I2C_BOARD_INFO("mt9v022", 0x48),
480 }, {
481 I2C_BOARD_INFO("mt9m001", 0x5d),
485 static struct soc_camera_link iclink[] = {
487 .bus_id = 0, /* Must match with the camera ID */
488 .board_info = &pcm990_camera_i2c[0],
489 .priv = &mt9v022_pdata,
490 .i2c_adapter_id = 0,
491 .query_bus_param = pcm990_camera_query_bus_param,
492 .set_bus_param = pcm990_camera_set_bus_param,
493 .free_bus = pcm990_camera_free_bus,
494 }, {
495 .bus_id = 0, /* Must match with the camera ID */
496 .board_info = &pcm990_camera_i2c[1],
497 .i2c_adapter_id = 0,
498 .query_bus_param = pcm990_camera_query_bus_param,
499 .set_bus_param = pcm990_camera_set_bus_param,
500 .free_bus = pcm990_camera_free_bus,
504 static struct platform_device pcm990_camera[] = {
506 .name = "soc-camera-pdrv",
507 .id = 0,
508 .dev = {
509 .platform_data = &iclink[0],
511 }, {
512 .name = "soc-camera-pdrv",
513 .id = 1,
514 .dev = {
515 .platform_data = &iclink[1],
519 #endif /* CONFIG_VIDEO_PXA27x ||CONFIG_VIDEO_PXA27x_MODULE */
522 * system init for baseboard usage. Will be called by pcm027 init.
524 * Add platform devices present on this baseboard and init
525 * them from CPU side as far as required to use them later on
527 void __init pcm990_baseboard_init(void)
529 pxa2xx_mfp_config(ARRAY_AND_SIZE(pcm990_pin_config));
531 pcm990_cpld_base = ioremap(PCM990_CTRL_PHYS, PCM990_CTRL_SIZE);
532 if (!pcm990_cpld_base) {
533 pr_err("pcm990: failed to ioremap cpld\n");
534 return;
537 /* register CPLD's IRQ controller */
538 pcm990_init_irq();
540 #ifndef CONFIG_PCM990_DISPLAY_NONE
541 pxa_set_fb_info(NULL, &pcm990_fbinfo);
542 #endif
543 pwm_add_table(pcm990_pwm_lookup, ARRAY_SIZE(pcm990_pwm_lookup));
544 platform_device_register(&pcm990_backlight_device);
546 /* MMC */
547 pxa_set_mci_info(&pcm990_mci_platform_data);
549 /* USB host */
550 pxa_set_ohci_info(&pcm990_ohci_platform_data);
552 pxa_set_i2c_info(NULL);
553 pxa_set_ac97_info(NULL);
555 #if defined(CONFIG_VIDEO_PXA27x) || defined(CONFIG_VIDEO_PXA27x_MODULE)
556 pxa2xx_mfp_config(ARRAY_AND_SIZE(pcm990_camera_pin_config));
557 pxa_set_camera_info(&pcm990_pxacamera_platform_data);
559 i2c_register_board_info(0, ARRAY_AND_SIZE(pcm990_i2c_devices));
561 platform_device_register(&pcm990_camera[0]);
562 platform_device_register(&pcm990_camera[1]);
563 #endif
565 printk(KERN_INFO "PCM-990 Evaluation baseboard initialized\n");