Merge branch 'for-linus' of git://git.linaro.org/people/rmk/linux-arm
[linux-2.6.git] / drivers / staging / olpc_dcon / olpc_dcon_xo_1.c
blob77e8eb5a5abd209268821da414838a28ee190fb5
1 /*
2 * Mainly by David Woodhouse, somewhat modified by Jordan Crouse
4 * Copyright © 2006-2007 Red Hat, Inc.
5 * Copyright © 2006-2007 Advanced Micro Devices, Inc.
6 * Copyright © 2009 VIA Technology, Inc.
7 * Copyright (c) 2010 Andres Salomon <dilinger@queued.net>
9 * This program is free software. You can redistribute it and/or
10 * modify it under the terms of version 2 of the GNU General Public
11 * License as published by the Free Software Foundation.
14 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
16 #include <linux/cs5535.h>
17 #include <linux/gpio.h>
18 #include <linux/delay.h>
19 #include <asm/olpc.h>
21 #include "olpc_dcon.h"
23 static int dcon_init_xo_1(struct dcon_priv *dcon)
25 unsigned char lob;
27 if (gpio_request(OLPC_GPIO_DCON_STAT0, "OLPC-DCON")) {
28 pr_err("failed to request STAT0 GPIO\n");
29 return -EIO;
31 if (gpio_request(OLPC_GPIO_DCON_STAT1, "OLPC-DCON")) {
32 pr_err("failed to request STAT1 GPIO\n");
33 goto err_gp_stat1;
35 if (gpio_request(OLPC_GPIO_DCON_IRQ, "OLPC-DCON")) {
36 pr_err("failed to request IRQ GPIO\n");
37 goto err_gp_irq;
39 if (gpio_request(OLPC_GPIO_DCON_LOAD, "OLPC-DCON")) {
40 pr_err("failed to request LOAD GPIO\n");
41 goto err_gp_load;
43 if (gpio_request(OLPC_GPIO_DCON_BLANK, "OLPC-DCON")) {
44 pr_err("failed to request BLANK GPIO\n");
45 goto err_gp_blank;
48 /* Turn off the event enable for GPIO7 just to be safe */
49 cs5535_gpio_clear(OLPC_GPIO_DCON_IRQ, GPIO_EVENTS_ENABLE);
52 * Determine the current state by reading the GPIO bit; earlier
53 * stages of the boot process have established the state.
55 * Note that we read GPIO_OUPUT_VAL rather than GPIO_READ_BACK here;
56 * this is because OFW will disable input for the pin and set a value..
57 * READ_BACK will only contain a valid value if input is enabled and
58 * then a value is set. So, future readings of the pin can use
59 * READ_BACK, but the first one cannot. Awesome, huh?
61 dcon->curr_src = cs5535_gpio_isset(OLPC_GPIO_DCON_LOAD, GPIO_OUTPUT_VAL)
62 ? DCON_SOURCE_CPU
63 : DCON_SOURCE_DCON;
64 dcon->pending_src = dcon->curr_src;
66 /* Set the directions for the GPIO pins */
67 gpio_direction_input(OLPC_GPIO_DCON_STAT0);
68 gpio_direction_input(OLPC_GPIO_DCON_STAT1);
69 gpio_direction_input(OLPC_GPIO_DCON_IRQ);
70 gpio_direction_input(OLPC_GPIO_DCON_BLANK);
71 gpio_direction_output(OLPC_GPIO_DCON_LOAD,
72 dcon->curr_src == DCON_SOURCE_CPU);
74 /* Set up the interrupt mappings */
76 /* Set the IRQ to pair 2 */
77 cs5535_gpio_setup_event(OLPC_GPIO_DCON_IRQ, 2, 0);
79 /* Enable group 2 to trigger the DCON interrupt */
80 cs5535_gpio_set_irq(2, DCON_IRQ);
82 /* Select edge level for interrupt (in PIC) */
83 lob = inb(0x4d0);
84 lob &= ~(1 << DCON_IRQ);
85 outb(lob, 0x4d0);
87 /* Register the interrupt handler */
88 if (request_irq(DCON_IRQ, &dcon_interrupt, 0, "DCON", dcon)) {
89 pr_err("failed to request DCON's irq\n");
90 goto err_req_irq;
93 /* Clear INV_EN for GPIO7 (DCONIRQ) */
94 cs5535_gpio_clear(OLPC_GPIO_DCON_IRQ, GPIO_INPUT_INVERT);
96 /* Enable filter for GPIO12 (DCONBLANK) */
97 cs5535_gpio_set(OLPC_GPIO_DCON_BLANK, GPIO_INPUT_FILTER);
99 /* Disable filter for GPIO7 */
100 cs5535_gpio_clear(OLPC_GPIO_DCON_IRQ, GPIO_INPUT_FILTER);
102 /* Disable event counter for GPIO7 (DCONIRQ) and GPIO12 (DCONBLANK) */
103 cs5535_gpio_clear(OLPC_GPIO_DCON_IRQ, GPIO_INPUT_EVENT_COUNT);
104 cs5535_gpio_clear(OLPC_GPIO_DCON_BLANK, GPIO_INPUT_EVENT_COUNT);
106 /* Add GPIO12 to the Filter Event Pair #7 */
107 cs5535_gpio_set(OLPC_GPIO_DCON_BLANK, GPIO_FE7_SEL);
109 /* Turn off negative Edge Enable for GPIO12 */
110 cs5535_gpio_clear(OLPC_GPIO_DCON_BLANK, GPIO_NEGATIVE_EDGE_EN);
112 /* Enable negative Edge Enable for GPIO7 */
113 cs5535_gpio_set(OLPC_GPIO_DCON_IRQ, GPIO_NEGATIVE_EDGE_EN);
115 /* Zero the filter amount for Filter Event Pair #7 */
116 cs5535_gpio_set(0, GPIO_FLTR7_AMOUNT);
118 /* Clear the negative edge status for GPIO7 and GPIO12 */
119 cs5535_gpio_set(OLPC_GPIO_DCON_IRQ, GPIO_NEGATIVE_EDGE_STS);
120 cs5535_gpio_set(OLPC_GPIO_DCON_BLANK, GPIO_NEGATIVE_EDGE_STS);
122 /* FIXME: Clear the positive status as well, just to be sure */
123 cs5535_gpio_set(OLPC_GPIO_DCON_IRQ, GPIO_POSITIVE_EDGE_STS);
124 cs5535_gpio_set(OLPC_GPIO_DCON_BLANK, GPIO_POSITIVE_EDGE_STS);
126 /* Enable events for GPIO7 (DCONIRQ) and GPIO12 (DCONBLANK) */
127 cs5535_gpio_set(OLPC_GPIO_DCON_IRQ, GPIO_EVENTS_ENABLE);
128 cs5535_gpio_set(OLPC_GPIO_DCON_BLANK, GPIO_EVENTS_ENABLE);
130 return 0;
132 err_req_irq:
133 gpio_free(OLPC_GPIO_DCON_BLANK);
134 err_gp_blank:
135 gpio_free(OLPC_GPIO_DCON_LOAD);
136 err_gp_load:
137 gpio_free(OLPC_GPIO_DCON_IRQ);
138 err_gp_irq:
139 gpio_free(OLPC_GPIO_DCON_STAT1);
140 err_gp_stat1:
141 gpio_free(OLPC_GPIO_DCON_STAT0);
142 return -EIO;
145 static void dcon_wiggle_xo_1(void)
147 int x;
150 * According to HiMax, when powering the DCON up we should hold
151 * SMB_DATA high for 8 SMB_CLK cycles. This will force the DCON
152 * state machine to reset to a (sane) initial state. Mitch Bradley
153 * did some testing and discovered that holding for 16 SMB_CLK cycles
154 * worked a lot more reliably, so that's what we do here.
156 * According to the cs5536 spec, to set GPIO14 to SMB_CLK we must
157 * simultaneously set AUX1 IN/OUT to GPIO14; ditto for SMB_DATA and
158 * GPIO15.
160 cs5535_gpio_set(OLPC_GPIO_SMB_CLK, GPIO_OUTPUT_VAL);
161 cs5535_gpio_set(OLPC_GPIO_SMB_DATA, GPIO_OUTPUT_VAL);
162 cs5535_gpio_set(OLPC_GPIO_SMB_CLK, GPIO_OUTPUT_ENABLE);
163 cs5535_gpio_set(OLPC_GPIO_SMB_DATA, GPIO_OUTPUT_ENABLE);
164 cs5535_gpio_clear(OLPC_GPIO_SMB_CLK, GPIO_OUTPUT_AUX1);
165 cs5535_gpio_clear(OLPC_GPIO_SMB_DATA, GPIO_OUTPUT_AUX1);
166 cs5535_gpio_clear(OLPC_GPIO_SMB_CLK, GPIO_OUTPUT_AUX2);
167 cs5535_gpio_clear(OLPC_GPIO_SMB_DATA, GPIO_OUTPUT_AUX2);
168 cs5535_gpio_clear(OLPC_GPIO_SMB_CLK, GPIO_INPUT_AUX1);
169 cs5535_gpio_clear(OLPC_GPIO_SMB_DATA, GPIO_INPUT_AUX1);
171 for (x = 0; x < 16; x++) {
172 udelay(5);
173 cs5535_gpio_clear(OLPC_GPIO_SMB_CLK, GPIO_OUTPUT_VAL);
174 udelay(5);
175 cs5535_gpio_set(OLPC_GPIO_SMB_CLK, GPIO_OUTPUT_VAL);
177 udelay(5);
178 cs5535_gpio_set(OLPC_GPIO_SMB_CLK, GPIO_OUTPUT_AUX1);
179 cs5535_gpio_set(OLPC_GPIO_SMB_DATA, GPIO_OUTPUT_AUX1);
180 cs5535_gpio_set(OLPC_GPIO_SMB_CLK, GPIO_INPUT_AUX1);
181 cs5535_gpio_set(OLPC_GPIO_SMB_DATA, GPIO_INPUT_AUX1);
184 static void dcon_set_dconload_1(int val)
186 gpio_set_value(OLPC_GPIO_DCON_LOAD, val);
189 static int dcon_read_status_xo_1(u8 *status)
191 *status = gpio_get_value(OLPC_GPIO_DCON_STAT0);
192 *status |= gpio_get_value(OLPC_GPIO_DCON_STAT1) << 1;
194 /* Clear the negative edge status for GPIO7 */
195 cs5535_gpio_set(OLPC_GPIO_DCON_IRQ, GPIO_NEGATIVE_EDGE_STS);
197 return 0;
200 struct dcon_platform_data dcon_pdata_xo_1 = {
201 .init = dcon_init_xo_1,
202 .bus_stabilize_wiggle = dcon_wiggle_xo_1,
203 .set_dconload = dcon_set_dconload_1,
204 .read_status = dcon_read_status_xo_1,