Blame view

drivers/mfd/mcp-core.c 6.83 KB
a4e137ab1   Russell King   [MFD] Add multime...
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
  /*
   *  linux/drivers/mfd/mcp-core.c
   *
   *  Copyright (C) 2001 Russell King
   *
   * This program is free software; you can redistribute it and/or modify
   * it under the terms of the GNU General Public License as published by
   * the Free Software Foundation; either version 2 of the License.
   *
   *  Generic MCP (Multimedia Communications Port) layer.  All MCP locking
   *  is solely held within this file.
   */
  #include <linux/module.h>
  #include <linux/init.h>
  #include <linux/errno.h>
  #include <linux/smp.h>
  #include <linux/device.h>
8c65b4a60   Tim Schmielau   [PATCH] fix remai...
18
19
  #include <linux/slab.h>
  #include <linux/string.h>
c8602edf3   Thomas Kunze   move drivers/mfd/...
20
  #include <linux/mfd/mcp.h>
a4e137ab1   Russell King   [MFD] Add multime...
21

dcea83adc   Russell King   [ARM] Hide ISA DM...
22
  #include <mach/dma.h>
a4e137ab1   Russell King   [MFD] Add multime...
23
  #include <asm/system.h>
a4e137ab1   Russell King   [MFD] Add multime...
24
25
26
  
  #define to_mcp(d)		container_of(d, struct mcp, attached_device)
  #define to_mcp_driver(d)	container_of(d, struct mcp_driver, drv)
5dd7bf59e   Jochen Friedrich   ARM: sa11x0: Impl...
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
  static const struct mcp_device_id *mcp_match_id(const struct mcp_device_id *id,
  						const char *codec)
  {
  	while (id->name[0]) {
  		if (strcmp(codec, id->name) == 0)
  			return id;
  		id++;
  	}
  	return NULL;
  }
  
  const struct mcp_device_id *mcp_get_device_id(const struct mcp *mcp)
  {
  	const struct mcp_driver *driver =
  		to_mcp_driver(mcp->attached_device.driver);
  
  	return mcp_match_id(driver->id_table, mcp->codec);
  }
  EXPORT_SYMBOL(mcp_get_device_id);
a4e137ab1   Russell King   [MFD] Add multime...
46
47
  static int mcp_bus_match(struct device *dev, struct device_driver *drv)
  {
5dd7bf59e   Jochen Friedrich   ARM: sa11x0: Impl...
48
49
50
51
52
53
54
  	const struct mcp *mcp = to_mcp(dev);
  	const struct mcp_driver *driver = to_mcp_driver(drv);
  
  	if (driver->id_table)
  		return !!mcp_match_id(driver->id_table, mcp->codec);
  
  	return 0;
a4e137ab1   Russell King   [MFD] Add multime...
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
  }
  
  static int mcp_bus_probe(struct device *dev)
  {
  	struct mcp *mcp = to_mcp(dev);
  	struct mcp_driver *drv = to_mcp_driver(dev->driver);
  
  	return drv->probe(mcp);
  }
  
  static int mcp_bus_remove(struct device *dev)
  {
  	struct mcp *mcp = to_mcp(dev);
  	struct mcp_driver *drv = to_mcp_driver(dev->driver);
  
  	drv->remove(mcp);
  	return 0;
  }
  
  static int mcp_bus_suspend(struct device *dev, pm_message_t state)
  {
  	struct mcp *mcp = to_mcp(dev);
  	int ret = 0;
  
  	if (dev->driver) {
  		struct mcp_driver *drv = to_mcp_driver(dev->driver);
  
  		ret = drv->suspend(mcp, state);
  	}
  	return ret;
  }
  
  static int mcp_bus_resume(struct device *dev)
  {
  	struct mcp *mcp = to_mcp(dev);
  	int ret = 0;
  
  	if (dev->driver) {
  		struct mcp_driver *drv = to_mcp_driver(dev->driver);
  
  		ret = drv->resume(mcp);
  	}
  	return ret;
  }
5dd7bf59e   Jochen Friedrich   ARM: sa11x0: Impl...
99
100
101
102
103
104
105
  static int mcp_bus_uevent(struct device *dev, struct kobj_uevent_env *env)
  {
  	struct mcp *mcp = to_mcp(dev);
  
  	add_uevent_var(env, "MODALIAS=%s%s", MCP_MODULE_PREFIX, mcp->codec);
  	return 0;
  }
a4e137ab1   Russell King   [MFD] Add multime...
106
107
108
  static struct bus_type mcp_bus_type = {
  	.name		= "mcp",
  	.match		= mcp_bus_match,
5dd7bf59e   Jochen Friedrich   ARM: sa11x0: Impl...
109
  	.uevent		= mcp_bus_uevent,
413b486e1   Russell King   [PATCH] Add MCP b...
110
111
  	.probe		= mcp_bus_probe,
  	.remove		= mcp_bus_remove,
a4e137ab1   Russell King   [MFD] Add multime...
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
  	.suspend	= mcp_bus_suspend,
  	.resume		= mcp_bus_resume,
  };
  
  /**
   *	mcp_set_telecom_divisor - set the telecom divisor
   *	@mcp: MCP interface structure
   *	@div: SIB clock divisor
   *
   *	Set the telecom divisor on the MCP interface.  The resulting
   *	sample rate is SIBCLOCK/div.
   */
  void mcp_set_telecom_divisor(struct mcp *mcp, unsigned int div)
  {
  	spin_lock_irq(&mcp->lock);
  	mcp->ops->set_telecom_divisor(mcp, div);
  	spin_unlock_irq(&mcp->lock);
  }
  EXPORT_SYMBOL(mcp_set_telecom_divisor);
  
  /**
   *	mcp_set_audio_divisor - set the audio divisor
   *	@mcp: MCP interface structure
   *	@div: SIB clock divisor
   *
   *	Set the audio divisor on the MCP interface.
   */
  void mcp_set_audio_divisor(struct mcp *mcp, unsigned int div)
  {
  	spin_lock_irq(&mcp->lock);
  	mcp->ops->set_audio_divisor(mcp, div);
  	spin_unlock_irq(&mcp->lock);
  }
  EXPORT_SYMBOL(mcp_set_audio_divisor);
  
  /**
   *	mcp_reg_write - write a device register
   *	@mcp: MCP interface structure
   *	@reg: 4-bit register index
   *	@val: 16-bit data value
   *
   *	Write a device register.  The MCP interface must be enabled
   *	to prevent this function hanging.
   */
  void mcp_reg_write(struct mcp *mcp, unsigned int reg, unsigned int val)
  {
  	unsigned long flags;
  
  	spin_lock_irqsave(&mcp->lock, flags);
  	mcp->ops->reg_write(mcp, reg, val);
  	spin_unlock_irqrestore(&mcp->lock, flags);
  }
  EXPORT_SYMBOL(mcp_reg_write);
  
  /**
   *	mcp_reg_read - read a device register
   *	@mcp: MCP interface structure
   *	@reg: 4-bit register index
   *
   *	Read a device register and return its value.  The MCP interface
   *	must be enabled to prevent this function hanging.
   */
  unsigned int mcp_reg_read(struct mcp *mcp, unsigned int reg)
  {
  	unsigned long flags;
  	unsigned int val;
  
  	spin_lock_irqsave(&mcp->lock, flags);
  	val = mcp->ops->reg_read(mcp, reg);
  	spin_unlock_irqrestore(&mcp->lock, flags);
  
  	return val;
  }
  EXPORT_SYMBOL(mcp_reg_read);
  
  /**
   *	mcp_enable - enable the MCP interface
   *	@mcp: MCP interface to enable
   *
   *	Enable the MCP interface.  Each call to mcp_enable will need
   *	a corresponding call to mcp_disable to disable the interface.
   */
  void mcp_enable(struct mcp *mcp)
  {
  	spin_lock_irq(&mcp->lock);
  	if (mcp->use_count++ == 0)
  		mcp->ops->enable(mcp);
  	spin_unlock_irq(&mcp->lock);
  }
  EXPORT_SYMBOL(mcp_enable);
  
  /**
   *	mcp_disable - disable the MCP interface
   *	@mcp: MCP interface to disable
   *
   *	Disable the MCP interface.  The MCP interface will only be
   *	disabled once the number of calls to mcp_enable matches the
   *	number of calls to mcp_disable.
   */
  void mcp_disable(struct mcp *mcp)
  {
  	unsigned long flags;
  
  	spin_lock_irqsave(&mcp->lock, flags);
  	if (--mcp->use_count == 0)
  		mcp->ops->disable(mcp);
  	spin_unlock_irqrestore(&mcp->lock, flags);
  }
  EXPORT_SYMBOL(mcp_disable);
  
  static void mcp_release(struct device *dev)
  {
  	struct mcp *mcp = container_of(dev, struct mcp, attached_device);
  
  	kfree(mcp);
  }
  
  struct mcp *mcp_host_alloc(struct device *parent, size_t size)
  {
  	struct mcp *mcp;
dd00cc486   Yoann Padioleau   some kmalloc/mems...
232
  	mcp = kzalloc(sizeof(struct mcp) + size, GFP_KERNEL);
a4e137ab1   Russell King   [MFD] Add multime...
233
  	if (mcp) {
a4e137ab1   Russell King   [MFD] Add multime...
234
235
236
237
238
239
240
241
242
  		spin_lock_init(&mcp->lock);
  		mcp->attached_device.parent = parent;
  		mcp->attached_device.bus = &mcp_bus_type;
  		mcp->attached_device.dma_mask = parent->dma_mask;
  		mcp->attached_device.release = mcp_release;
  	}
  	return mcp;
  }
  EXPORT_SYMBOL(mcp_host_alloc);
5dd7bf59e   Jochen Friedrich   ARM: sa11x0: Impl...
243
  int mcp_host_register(struct mcp *mcp, void *pdata)
a4e137ab1   Russell King   [MFD] Add multime...
244
  {
5dd7bf59e   Jochen Friedrich   ARM: sa11x0: Impl...
245
246
247
248
  	if (!mcp->codec)
  		return -EINVAL;
  
  	mcp->attached_device.platform_data = pdata;
b2bf61f23   Kay Sievers   mfd: struct devic...
249
  	dev_set_name(&mcp->attached_device, "mcp0");
5dd7bf59e   Jochen Friedrich   ARM: sa11x0: Impl...
250
  	request_module("%s%s", MCP_MODULE_PREFIX, mcp->codec);
a4e137ab1   Russell King   [MFD] Add multime...
251
252
253
254
255
256
257
258
259
260
261
262
263
  	return device_register(&mcp->attached_device);
  }
  EXPORT_SYMBOL(mcp_host_register);
  
  void mcp_host_unregister(struct mcp *mcp)
  {
  	device_unregister(&mcp->attached_device);
  }
  EXPORT_SYMBOL(mcp_host_unregister);
  
  int mcp_driver_register(struct mcp_driver *mcpdrv)
  {
  	mcpdrv->drv.bus = &mcp_bus_type;
a4e137ab1   Russell King   [MFD] Add multime...
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
  	return driver_register(&mcpdrv->drv);
  }
  EXPORT_SYMBOL(mcp_driver_register);
  
  void mcp_driver_unregister(struct mcp_driver *mcpdrv)
  {
  	driver_unregister(&mcpdrv->drv);
  }
  EXPORT_SYMBOL(mcp_driver_unregister);
  
  static int __init mcp_init(void)
  {
  	return bus_register(&mcp_bus_type);
  }
  
  static void __exit mcp_exit(void)
  {
  	bus_unregister(&mcp_bus_type);
  }
  
  module_init(mcp_init);
  module_exit(mcp_exit);
  
  MODULE_AUTHOR("Russell King <rmk@arm.linux.org.uk>");
  MODULE_DESCRIPTION("Core multimedia communications port driver");
  MODULE_LICENSE("GPL");