1
2
3
4
5
6
7
8
9#include <linux/kernel.h>
10#include <linux/delay.h>
11#include <linux/slab.h>
12#include <linux/io.h>
13
14#include <asm/prom.h>
15#include <asm/macio.h>
16#include <asm/pmac_feature.h>
17#include <asm/pmac_pfunc.h>
18#include <asm/keylargo.h>
19
20#include "i2sbus.h"
21
22int i2sbus_control_init(struct macio_dev* dev, struct i2sbus_control **c)
23{
24 *c = kzalloc(sizeof(struct i2sbus_control), GFP_KERNEL);
25 if (!*c)
26 return -ENOMEM;
27
28 INIT_LIST_HEAD(&(*c)->list);
29
30 (*c)->macio = dev->bus->chip;
31 return 0;
32}
33
34void i2sbus_control_destroy(struct i2sbus_control *c)
35{
36 kfree(c);
37}
38
39
40int i2sbus_control_add_dev(struct i2sbus_control *c,
41 struct i2sbus_dev *i2sdev)
42{
43 struct device_node *np;
44
45 np = i2sdev->sound.ofdev.dev.of_node;
46 i2sdev->enable = pmf_find_function(np, "enable");
47 i2sdev->cell_enable = pmf_find_function(np, "cell-enable");
48 i2sdev->clock_enable = pmf_find_function(np, "clock-enable");
49 i2sdev->cell_disable = pmf_find_function(np, "cell-disable");
50 i2sdev->clock_disable = pmf_find_function(np, "clock-disable");
51
52
53
54
55
56
57 if (i2sdev->bus_number != 0 && i2sdev->bus_number != 1 &&
58 (!i2sdev->enable ||
59 !i2sdev->cell_enable || !i2sdev->clock_enable ||
60 !i2sdev->cell_disable || !i2sdev->clock_disable)) {
61 pmf_put_function(i2sdev->enable);
62 pmf_put_function(i2sdev->cell_enable);
63 pmf_put_function(i2sdev->clock_enable);
64 pmf_put_function(i2sdev->cell_disable);
65 pmf_put_function(i2sdev->clock_disable);
66 return -ENODEV;
67 }
68
69 list_add(&i2sdev->item, &c->list);
70
71 return 0;
72}
73
74void i2sbus_control_remove_dev(struct i2sbus_control *c,
75 struct i2sbus_dev *i2sdev)
76{
77
78 list_del(&i2sdev->item);
79 if (list_empty(&c->list))
80 i2sbus_control_destroy(c);
81}
82
83int i2sbus_control_enable(struct i2sbus_control *c,
84 struct i2sbus_dev *i2sdev)
85{
86 struct pmf_args args = { .count = 0 };
87 struct macio_chip *macio = c->macio;
88
89 if (i2sdev->enable)
90 return pmf_call_one(i2sdev->enable, &args);
91
92 if (macio == NULL || macio->base == NULL)
93 return -ENODEV;
94
95 switch (i2sdev->bus_number) {
96 case 0:
97
98
99 MACIO_BIS(KEYLARGO_FCR1, KL1_I2S0_ENABLE);
100 break;
101 case 1:
102 MACIO_BIS(KEYLARGO_FCR1, KL1_I2S1_ENABLE);
103 break;
104 default:
105 return -ENODEV;
106 }
107 return 0;
108}
109
110int i2sbus_control_cell(struct i2sbus_control *c,
111 struct i2sbus_dev *i2sdev,
112 int enable)
113{
114 struct pmf_args args = { .count = 0 };
115 struct macio_chip *macio = c->macio;
116
117 switch (enable) {
118 case 0:
119 if (i2sdev->cell_disable)
120 return pmf_call_one(i2sdev->cell_disable, &args);
121 break;
122 case 1:
123 if (i2sdev->cell_enable)
124 return pmf_call_one(i2sdev->cell_enable, &args);
125 break;
126 default:
127 printk(KERN_ERR "i2sbus: INVALID CELL ENABLE VALUE\n");
128 return -ENODEV;
129 }
130
131 if (macio == NULL || macio->base == NULL)
132 return -ENODEV;
133
134 switch (i2sdev->bus_number) {
135 case 0:
136 if (enable)
137 MACIO_BIS(KEYLARGO_FCR1, KL1_I2S0_CELL_ENABLE);
138 else
139 MACIO_BIC(KEYLARGO_FCR1, KL1_I2S0_CELL_ENABLE);
140 break;
141 case 1:
142 if (enable)
143 MACIO_BIS(KEYLARGO_FCR1, KL1_I2S1_CELL_ENABLE);
144 else
145 MACIO_BIC(KEYLARGO_FCR1, KL1_I2S1_CELL_ENABLE);
146 break;
147 default:
148 return -ENODEV;
149 }
150 return 0;
151}
152
153int i2sbus_control_clock(struct i2sbus_control *c,
154 struct i2sbus_dev *i2sdev,
155 int enable)
156{
157 struct pmf_args args = { .count = 0 };
158 struct macio_chip *macio = c->macio;
159
160 switch (enable) {
161 case 0:
162 if (i2sdev->clock_disable)
163 return pmf_call_one(i2sdev->clock_disable, &args);
164 break;
165 case 1:
166 if (i2sdev->clock_enable)
167 return pmf_call_one(i2sdev->clock_enable, &args);
168 break;
169 default:
170 printk(KERN_ERR "i2sbus: INVALID CLOCK ENABLE VALUE\n");
171 return -ENODEV;
172 }
173
174 if (macio == NULL || macio->base == NULL)
175 return -ENODEV;
176
177 switch (i2sdev->bus_number) {
178 case 0:
179 if (enable)
180 MACIO_BIS(KEYLARGO_FCR1, KL1_I2S0_CLK_ENABLE_BIT);
181 else
182 MACIO_BIC(KEYLARGO_FCR1, KL1_I2S0_CLK_ENABLE_BIT);
183 break;
184 case 1:
185 if (enable)
186 MACIO_BIS(KEYLARGO_FCR1, KL1_I2S1_CLK_ENABLE_BIT);
187 else
188 MACIO_BIC(KEYLARGO_FCR1, KL1_I2S1_CLK_ENABLE_BIT);
189 break;
190 default:
191 return -ENODEV;
192 }
193 return 0;
194}
195
