linux 内核源代码

				/*				 * i2sbus driver -- bus control routines				 *				 * Copyright 2006 Johannes Berg 				 *				 * GPL v2, can be found in COPYING.				 */								#include 				#include 								#include 				#include 				#include 				#include 				#include 				#include 								#include "i2sbus.h"								int i2sbus_control_init(struct macio_dev* dev, struct i2sbus_control **c)				{					*c = kzalloc(sizeof(struct i2sbus_control), GFP_KERNEL);					if (!*c)						return -ENOMEM;									INIT_LIST_HEAD(&(*c)->list);									(*c)->macio = dev->bus->chip;					return 0;				}								void i2sbus_control_destroy(struct i2sbus_control *c)				{					kfree(c);				}								/* this is serialised externally */				int i2sbus_control_add_dev(struct i2sbus_control *c,							   struct i2sbus_dev *i2sdev)				{					struct device_node *np;									np = i2sdev->sound.ofdev.node;					i2sdev->enable = pmf_find_function(np, "enable");					i2sdev->cell_enable = pmf_find_function(np, "cell-enable");					i2sdev->clock_enable = pmf_find_function(np, "clock-enable");					i2sdev->cell_disable = pmf_find_function(np, "cell-disable");					i2sdev->clock_disable = pmf_find_function(np, "clock-disable");									/* if the bus number is not 0 or 1 we absolutely need to use					 * the platform functions -- there's nothing in Darwin that					 * would allow seeing a system behind what the FCRs are then,					 * and I don't want to go parsing a bunch of platform functions					 * by hand to try finding a system... */					if (i2sdev->bus_number != 0 && i2sdev->bus_number != 1 &&					    (!i2sdev->enable ||					     !i2sdev->cell_enable || !i2sdev->clock_enable ||					     !i2sdev->cell_disable || !i2sdev->clock_disable)) {						pmf_put_function(i2sdev->enable);						pmf_put_function(i2sdev->cell_enable);						pmf_put_function(i2sdev->clock_enable);						pmf_put_function(i2sdev->cell_disable);						pmf_put_function(i2sdev->clock_disable);						return -ENODEV;					}									list_add(&i2sdev->item, &c->list);									return 0;				}								void i2sbus_control_remove_dev(struct i2sbus_control *c,							       struct i2sbus_dev *i2sdev)				{					/* this is serialised externally */					list_del(&i2sdev->item);					if (list_empty(&c->list))						i2sbus_control_destroy(c);				}								int i2sbus_control_enable(struct i2sbus_control *c,							  struct i2sbus_dev *i2sdev)				{					struct pmf_args args = { .count = 0 };					struct macio_chip *macio = c->macio;									if (i2sdev->enable)						return pmf_call_one(i2sdev->enable, &args);									if (macio == NULL || macio->base == NULL)						return -ENODEV;									switch (i2sdev->bus_number) {					case 0:						/* these need to be locked or done through						 * newly created feature calls! */						MACIO_BIS(KEYLARGO_FCR1, KL1_I2S0_ENABLE);						break;					case 1:						MACIO_BIS(KEYLARGO_FCR1, KL1_I2S1_ENABLE);						break;					default:						return -ENODEV;					}					return 0;				}								int i2sbus_control_cell(struct i2sbus_control *c,							struct i2sbus_dev *i2sdev,							int enable)				{					struct pmf_args args = { .count = 0 };					struct macio_chip *macio = c->macio;									switch (enable) {					case 0:						if (i2sdev->cell_disable)							return pmf_call_one(i2sdev->cell_disable, &args);						break;					case 1:						if (i2sdev->cell_enable)							return pmf_call_one(i2sdev->cell_enable, &args);						break;					default:						printk(KERN_ERR "i2sbus: INVALID CELL ENABLE VALUE\n");						return -ENODEV;					}									if (macio == NULL || macio->base == NULL)						return -ENODEV;									switch (i2sdev->bus_number) {					case 0:						if (enable)							MACIO_BIS(KEYLARGO_FCR1, KL1_I2S0_CELL_ENABLE);						else							MACIO_BIC(KEYLARGO_FCR1, KL1_I2S0_CELL_ENABLE);						break;					case 1:						if (enable)							MACIO_BIS(KEYLARGO_FCR1, KL1_I2S1_CELL_ENABLE);						else							MACIO_BIC(KEYLARGO_FCR1, KL1_I2S1_CELL_ENABLE);						break;					default:						return -ENODEV;					}					return 0;				}								int i2sbus_control_clock(struct i2sbus_control *c,							 struct i2sbus_dev *i2sdev,							 int enable)				{					struct pmf_args args = { .count = 0 };					struct macio_chip *macio = c->macio;									switch (enable) {					case 0:						if (i2sdev->clock_disable)							return pmf_call_one(i2sdev->clock_disable, &args);						break;					case 1:						if (i2sdev->clock_enable)							return pmf_call_one(i2sdev->clock_enable, &args);						break;					default:						printk(KERN_ERR "i2sbus: INVALID CLOCK ENABLE VALUE\n");						return -ENODEV;					}									if (macio == NULL || macio->base == NULL)						return -ENODEV;									switch (i2sdev->bus_number) {					case 0:						if (enable)							MACIO_BIS(KEYLARGO_FCR1, KL1_I2S0_CLK_ENABLE_BIT);						else							MACIO_BIC(KEYLARGO_FCR1, KL1_I2S0_CLK_ENABLE_BIT);						break;					case 1:						if (enable)							MACIO_BIS(KEYLARGO_FCR1, KL1_I2S1_CLK_ENABLE_BIT);						else							MACIO_BIC(KEYLARGO_FCR1, KL1_I2S1_CLK_ENABLE_BIT);						break;					default:						return -ENODEV;					}					return 0;				}