drivers/pcmcia/socket_sysfs.c - android_kernel_htc_msm8960 - Gitiles

 /*
  * socket_sysfs.c -- most of socket-related sysfs output
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 as
  * published by the Free Software Foundation.
  *
  * (C) 2003 - 2004		Dominik Brodowski
  */

 #include <linux/module.h>
 #include <linux/moduleparam.h>
 #include <linux/init.h>
 #include <linux/kernel.h>
 #include <linux/config.h>
 #include <linux/string.h>
 #include <linux/major.h>
 #include <linux/errno.h>
 #include <linux/slab.h>
 #include <linux/mm.h>
 #include <linux/interrupt.h>
 #include <linux/timer.h>
 #include <linux/ioport.h>
 #include <linux/delay.h>
 #include <linux/pm.h>
 #include <linux/pci.h>
 #include <linux/device.h>
 #include <asm/system.h>
 #include <asm/irq.h>

 #define IN_CARD_SERVICES
 #include <pcmcia/cs_types.h>
 #include <pcmcia/ss.h>
 #include <pcmcia/cs.h>
 #include <pcmcia/bulkmem.h>
 #include <pcmcia/cistpl.h>
 #include <pcmcia/cisreg.h>
 #include <pcmcia/ds.h>
 #include "cs_internal.h"

 #define to_socket(_dev) container_of(_dev, struct pcmcia_socket, dev)

 static ssize_t pccard_show_type(struct class_device *dev, char *buf)
 {
 	int val;
 	struct pcmcia_socket *s = to_socket(dev);

 	if (!(s->state & SOCKET_PRESENT))
 		return -ENODEV;
 	s->ops->get_status(s, &val);
 	if (val & SS_CARDBUS)
 		return sprintf(buf, "32-bit\n");
 	if (val & SS_DETECT)
 		return sprintf(buf, "16-bit\n");
 	return sprintf(buf, "invalid\n");
 }
 static CLASS_DEVICE_ATTR(card_type, 0400, pccard_show_type, NULL);

 static ssize_t pccard_show_voltage(struct class_device *dev, char *buf)
 {
 	int val;
 	struct pcmcia_socket *s = to_socket(dev);

 	if (!(s->state & SOCKET_PRESENT))
 		return -ENODEV;
 	s->ops->get_status(s, &val);
 	if (val & SS_3VCARD)
 		return sprintf(buf, "3.3V\n");
 	if (val & SS_XVCARD)
 		return sprintf(buf, "X.XV\n");
 	return sprintf(buf, "5.0V\n");
 }
 static CLASS_DEVICE_ATTR(card_voltage, 0400, pccard_show_voltage, NULL);

 static ssize_t pccard_show_vpp(struct class_device *dev, char *buf)
 {
 	struct pcmcia_socket *s = to_socket(dev);
 	if (!(s->state & SOCKET_PRESENT))
 		return -ENODEV;
 	return sprintf(buf, "%d.%dV\n", s->socket.Vpp / 10, s->socket.Vpp % 10);
 }
 static CLASS_DEVICE_ATTR(card_vpp, 0400, pccard_show_vpp, NULL);

 static ssize_t pccard_show_vcc(struct class_device *dev, char *buf)
 {
 	struct pcmcia_socket *s = to_socket(dev);
 	if (!(s->state & SOCKET_PRESENT))
 		return -ENODEV;
 	return sprintf(buf, "%d.%dV\n", s->socket.Vcc / 10, s->socket.Vcc % 10);
 }
 static CLASS_DEVICE_ATTR(card_vcc, 0400, pccard_show_vcc, NULL);


 static ssize_t pccard_store_insert(struct class_device *dev, const char *buf, size_t count)
 {
 	ssize_t ret;
 	struct pcmcia_socket *s = to_socket(dev);

 	if (!count)
 		return -EINVAL;

 	ret = pcmcia_insert_card(s);

 	return ret ? ret : count;
 }
 static CLASS_DEVICE_ATTR(card_insert, 0200, NULL, pccard_store_insert);

 static ssize_t pccard_store_eject(struct class_device *dev, const char *buf, size_t count)
 {
 	ssize_t ret;
 	struct pcmcia_socket *s = to_socket(dev);

 	if (!count)
 		return -EINVAL;

 	ret = pcmcia_eject_card(s);

 	return ret ? ret : count;
 }
 static CLASS_DEVICE_ATTR(card_eject, 0200, NULL, pccard_store_eject);


 static ssize_t pccard_show_irq_mask(struct class_device *dev, char *buf)
 {
 	struct pcmcia_socket *s = to_socket(dev);
 	return sprintf(buf, "0x%04x\n", s->irq_mask);
 }

 static ssize_t pccard_store_irq_mask(struct class_device *dev, const char *buf, size_t count)
 {
 	ssize_t ret;
 	struct pcmcia_socket *s = to_socket(dev);
 	u32 mask;

 	if (!count)
 		return -EINVAL;

 	ret = sscanf (buf, "0x%x\n", &mask);

 	if (ret == 1) {
 		s->irq_mask &= mask;
 		ret = 0;
 	}

 	return ret ? ret : count;
 }
 static CLASS_DEVICE_ATTR(card_irq_mask, 0600, pccard_show_irq_mask, pccard_store_irq_mask);


 static ssize_t pccard_show_resource(struct class_device *dev, char *buf)
 {
 	struct pcmcia_socket *s = to_socket(dev);
 	return sprintf(buf, "%s\n", s->resource_setup_done ? "yes" : "no");
 }

 static ssize_t pccard_store_resource(struct class_device *dev, const char *buf, size_t count)
 {
 	unsigned long flags;
 	struct pcmcia_socket *s = to_socket(dev);

 	if (!count)
 		return -EINVAL;

 	spin_lock_irqsave(&s->lock, flags);
 	if (!s->resource_setup_done)
 		s->resource_setup_done = 1;
 	spin_unlock_irqrestore(&s->lock, flags);

 	down(&s->skt_sem);
 	if ((s->callback) &&
 	    (s->state & SOCKET_PRESENT) &&
 	    !(s->state & SOCKET_CARDBUS)) {
 		if (try_module_get(s->callback->owner)) {
 			s->callback->requery(s);
 			module_put(s->callback->owner);
 		}
 	}
 	up(&s->skt_sem);

 	return count;
 }
 static CLASS_DEVICE_ATTR(available_resources_setup_done, 0600, pccard_show_resource, pccard_store_resource);


 static ssize_t pccard_extract_cis(struct pcmcia_socket *s, char *buf, loff_t off, size_t count)
 {
 	tuple_t tuple;
 	int status, i;
 	loff_t pointer = 0;
 	ssize_t ret = 0;
 	u_char *tuplebuffer;
 	u_char *tempbuffer;

 	tuplebuffer = kmalloc(sizeof(u_char) * 256, GFP_KERNEL);
 	if (!tuplebuffer)
 		return -ENOMEM;

 	tempbuffer = kmalloc(sizeof(u_char) * 258, GFP_KERNEL);
 	if (!tempbuffer) {
 		ret = -ENOMEM;
 		goto free_tuple;
 	}

 	memset(&tuple, 0, sizeof(tuple_t));

 	tuple.Attributes = TUPLE_RETURN_LINK | TUPLE_RETURN_COMMON;
 	tuple.DesiredTuple = RETURN_FIRST_TUPLE;
 	tuple.TupleOffset = 0;

 	status = pccard_get_first_tuple(s, BIND_FN_ALL, &tuple);
 	while (!status) {
 		tuple.TupleData = tuplebuffer;
 		tuple.TupleDataMax = 255;
 		memset(tuplebuffer, 0, sizeof(u_char) * 255);

 		status = pccard_get_tuple_data(s, &tuple);
 		if (status)
 			break;

 		if (off < (pointer + 2 + tuple.TupleDataLen)) {
 			tempbuffer[0] = tuple.TupleCode & 0xff;
 			tempbuffer[1] = tuple.TupleLink & 0xff;
 			for (i = 0; i < tuple.TupleDataLen; i++)
 				tempbuffer[i + 2] = tuplebuffer[i] & 0xff;

 			for (i = 0; i < (2 + tuple.TupleDataLen); i++) {
 				if (((i + pointer) >= off) &&
 				    (i + pointer) < (off + count)) {
 					buf[ret] = tempbuffer[i];
 					ret++;
 				}
 			}
 		}

 		pointer += 2 + tuple.TupleDataLen;

 		if (pointer >= (off + count))
 			break;

 		if (tuple.TupleCode == CISTPL_END)
 			break;
 		status = pccard_get_next_tuple(s, BIND_FN_ALL, &tuple);
 	}

 	kfree(tempbuffer);
  free_tuple:
 	kfree(tuplebuffer);

 	return (ret);
 }

 static ssize_t pccard_show_cis(struct kobject *kobj, char *buf, loff_t off, size_t count)
 {
 	unsigned int size = 0x200;

 	if (off >= size)
 		count = 0;
 	else {
 		struct pcmcia_socket *s;
 		cisinfo_t cisinfo;

 		if (off + count > size)
 			count = size - off;

 		s = to_socket(container_of(kobj, struct class_device, kobj));

 		if (!(s->state & SOCKET_PRESENT))
 			return -ENODEV;
 		if (pccard_validate_cis(s, BIND_FN_ALL, &cisinfo))
 			return -EIO;
 		if (!cisinfo.Chains)
 			return -ENODATA;

 		count = pccard_extract_cis(s, buf, off, count);
 	}

 	return (count);
 }

 static ssize_t pccard_store_cis(struct kobject *kobj, char *buf, loff_t off, size_t count)
 {
 	struct pcmcia_socket *s = to_socket(container_of(kobj, struct class_device, kobj));
 	cisdump_t *cis;
 	ssize_t ret = count;

 	if (off)
 		return -EINVAL;

 	if (count >= 0x200)
 		return -EINVAL;

 	if (!(s->state & SOCKET_PRESENT))
 		return -ENODEV;

 	cis = kmalloc(sizeof(cisdump_t), GFP_KERNEL);
 	if (!cis)
 		return -ENOMEM;
 	memset(cis, 0, sizeof(cisdump_t));

 	cis->Length = count + 1;
 	memcpy(cis->Data, buf, count);

 	if (pcmcia_replace_cis(s, cis))
 		ret  = -EIO;

 	kfree(cis);

 	if (!ret) {
 		down(&s->skt_sem);
 		if ((s->callback) && (s->state & SOCKET_PRESENT) &&
 		    !(s->state & SOCKET_CARDBUS)) {
 			if (try_module_get(s->callback->owner)) {
 				s->callback->requery(s);
 				module_put(s->callback->owner);
 			}
 		}
 		up(&s->skt_sem);
 	}


 	return (ret);
 }


 static struct class_device_attribute *pccard_socket_attributes[] = {
 	&class_device_attr_card_type,
 	&class_device_attr_card_voltage,
 	&class_device_attr_card_vpp,
 	&class_device_attr_card_vcc,
 	&class_device_attr_card_insert,
 	&class_device_attr_card_eject,
 	&class_device_attr_card_irq_mask,
 	&class_device_attr_available_resources_setup_done,
 	NULL,
 };

 static struct bin_attribute pccard_cis_attr = {
 	.attr = { .name = "cis", .mode = S_IRUGO | S_IWUSR, .owner = THIS_MODULE},
 	.size = 0x200,
 	.read = pccard_show_cis,
 	.write = pccard_store_cis,
 };

 static int __devinit pccard_sysfs_add_socket(struct class_device *class_dev)
 {
 	struct class_device_attribute **attr;
 	int ret = 0;

 	for (attr = pccard_socket_attributes; *attr; attr++) {
 		ret = class_device_create_file(class_dev, *attr);
 		if (ret)
 			break;
 	}
 	if (!ret)
 		ret = sysfs_create_bin_file(&class_dev->kobj, &pccard_cis_attr);

 	return ret;
 }

 static void __devexit pccard_sysfs_remove_socket(struct class_device *class_dev)
 {
 	struct class_device_attribute **attr;

 	sysfs_remove_bin_file(&class_dev->kobj, &pccard_cis_attr);
 	for (attr = pccard_socket_attributes; *attr; attr++)
 		class_device_remove_file(class_dev, *attr);
 }

 struct class_interface pccard_sysfs_interface = {
 	.class = &pcmcia_socket_class,
 	.add = &pccard_sysfs_add_socket,
 	.remove = __devexit_p(&pccard_sysfs_remove_socket),
 };
	/*
	* socket_sysfs.c -- most of socket-related sysfs output
	*
	* This program is free software; you can redistribute it and/or modify
	* it under the terms of the GNU General Public License version 2 as
	* published by the Free Software Foundation.
	*
	* (C) 2003 - 2004 Dominik Brodowski
	*/

	#include <linux/module.h>
	#include <linux/moduleparam.h>
	#include <linux/init.h>
	#include <linux/kernel.h>
	#include <linux/config.h>
	#include <linux/string.h>
	#include <linux/major.h>
	#include <linux/errno.h>
	#include <linux/slab.h>
	#include <linux/mm.h>
	#include <linux/interrupt.h>
	#include <linux/timer.h>
	#include <linux/ioport.h>
	#include <linux/delay.h>
	#include <linux/pm.h>
	#include <linux/pci.h>
	#include <linux/device.h>
	#include <asm/system.h>
	#include <asm/irq.h>

	#define IN_CARD_SERVICES
	#include <pcmcia/cs_types.h>
	#include <pcmcia/ss.h>
	#include <pcmcia/cs.h>
	#include <pcmcia/bulkmem.h>
	#include <pcmcia/cistpl.h>
	#include <pcmcia/cisreg.h>
	#include <pcmcia/ds.h>
	#include "cs_internal.h"

	#define to_socket(_dev) container_of(_dev, struct pcmcia_socket, dev)

	static ssize_t pccard_show_type(struct class_device dev, char buf)
	{
	int val;
	struct pcmcia_socket *s = to_socket(dev);

	if (!(s->state & SOCKET_PRESENT))
	return -ENODEV;
	s->ops->get_status(s, &val);
	if (val & SS_CARDBUS)
	return sprintf(buf, "32-bit\n");
	if (val & SS_DETECT)
	return sprintf(buf, "16-bit\n");
	return sprintf(buf, "invalid\n");
	}
	static CLASS_DEVICE_ATTR(card_type, 0400, pccard_show_type, NULL);

	static ssize_t pccard_show_voltage(struct class_device dev, char buf)
	{
	int val;
	struct pcmcia_socket *s = to_socket(dev);

	if (!(s->state & SOCKET_PRESENT))
	return -ENODEV;
	s->ops->get_status(s, &val);
	if (val & SS_3VCARD)
	return sprintf(buf, "3.3V\n");
	if (val & SS_XVCARD)
	return sprintf(buf, "X.XV\n");
	return sprintf(buf, "5.0V\n");
	}
	static CLASS_DEVICE_ATTR(card_voltage, 0400, pccard_show_voltage, NULL);

	static ssize_t pccard_show_vpp(struct class_device dev, char buf)
	{
	struct pcmcia_socket *s = to_socket(dev);
	if (!(s->state & SOCKET_PRESENT))
	return -ENODEV;
	return sprintf(buf, "%d.%dV\n", s->socket.Vpp / 10, s->socket.Vpp % 10);
	}
	static CLASS_DEVICE_ATTR(card_vpp, 0400, pccard_show_vpp, NULL);

	static ssize_t pccard_show_vcc(struct class_device dev, char buf)
	{
	struct pcmcia_socket *s = to_socket(dev);
	if (!(s->state & SOCKET_PRESENT))
	return -ENODEV;
	return sprintf(buf, "%d.%dV\n", s->socket.Vcc / 10, s->socket.Vcc % 10);
	}
	static CLASS_DEVICE_ATTR(card_vcc, 0400, pccard_show_vcc, NULL);


	static ssize_t pccard_store_insert(struct class_device dev, const char buf, size_t count)
	{
	ssize_t ret;
	struct pcmcia_socket *s = to_socket(dev);

	if (!count)
	return -EINVAL;

	ret = pcmcia_insert_card(s);

	return ret ? ret : count;
	}
	static CLASS_DEVICE_ATTR(card_insert, 0200, NULL, pccard_store_insert);

	static ssize_t pccard_store_eject(struct class_device dev, const char buf, size_t count)
	{
	ssize_t ret;
	struct pcmcia_socket *s = to_socket(dev);

	if (!count)
	return -EINVAL;

	ret = pcmcia_eject_card(s);

	return ret ? ret : count;
	}
	static CLASS_DEVICE_ATTR(card_eject, 0200, NULL, pccard_store_eject);


	static ssize_t pccard_show_irq_mask(struct class_device dev, char buf)
	{
	struct pcmcia_socket *s = to_socket(dev);
	return sprintf(buf, "0x%04x\n", s->irq_mask);
	}

	static ssize_t pccard_store_irq_mask(struct class_device dev, const char buf, size_t count)
	{
	ssize_t ret;
	struct pcmcia_socket *s = to_socket(dev);
	u32 mask;

	if (!count)
	return -EINVAL;

	ret = sscanf (buf, "0x%x\n", &mask);

	if (ret == 1) {
	s->irq_mask &= mask;
	ret = 0;
	}

	return ret ? ret : count;
	}
	static CLASS_DEVICE_ATTR(card_irq_mask, 0600, pccard_show_irq_mask, pccard_store_irq_mask);


	static ssize_t pccard_show_resource(struct class_device dev, char buf)
	{
	struct pcmcia_socket *s = to_socket(dev);
	return sprintf(buf, "%s\n", s->resource_setup_done ? "yes" : "no");
	}

	static ssize_t pccard_store_resource(struct class_device dev, const char buf, size_t count)
	{
	unsigned long flags;
	struct pcmcia_socket *s = to_socket(dev);

	if (!count)
	return -EINVAL;

	spin_lock_irqsave(&s->lock, flags);
	if (!s->resource_setup_done)
	s->resource_setup_done = 1;
	spin_unlock_irqrestore(&s->lock, flags);

	down(&s->skt_sem);
	if ((s->callback) &&
	(s->state & SOCKET_PRESENT) &&
	!(s->state & SOCKET_CARDBUS)) {
	if (try_module_get(s->callback->owner)) {
	s->callback->requery(s);
	module_put(s->callback->owner);
	}
	}
	up(&s->skt_sem);

	return count;
	}
	static CLASS_DEVICE_ATTR(available_resources_setup_done, 0600, pccard_show_resource, pccard_store_resource);


	static ssize_t pccard_extract_cis(struct pcmcia_socket s, char buf, loff_t off, size_t count)
	{
	tuple_t tuple;
	int status, i;
	loff_t pointer = 0;
	ssize_t ret = 0;
	u_char *tuplebuffer;
	u_char *tempbuffer;

	tuplebuffer = kmalloc(sizeof(u_char) * 256, GFP_KERNEL);
	if (!tuplebuffer)
	return -ENOMEM;

	tempbuffer = kmalloc(sizeof(u_char) * 258, GFP_KERNEL);
	if (!tempbuffer) {
	ret = -ENOMEM;
	goto free_tuple;
	}

	memset(&tuple, 0, sizeof(tuple_t));

	tuple.Attributes = TUPLE_RETURN_LINK \| TUPLE_RETURN_COMMON;
	tuple.DesiredTuple = RETURN_FIRST_TUPLE;
	tuple.TupleOffset = 0;

	status = pccard_get_first_tuple(s, BIND_FN_ALL, &tuple);
	while (!status) {
	tuple.TupleData = tuplebuffer;
	tuple.TupleDataMax = 255;
	memset(tuplebuffer, 0, sizeof(u_char) * 255);

	status = pccard_get_tuple_data(s, &tuple);
	if (status)
	break;

	if (off < (pointer + 2 + tuple.TupleDataLen)) {
	tempbuffer[0] = tuple.TupleCode & 0xff;
	tempbuffer[1] = tuple.TupleLink & 0xff;
	for (i = 0; i < tuple.TupleDataLen; i++)
	tempbuffer[i + 2] = tuplebuffer[i] & 0xff;

	for (i = 0; i < (2 + tuple.TupleDataLen); i++) {
	if (((i + pointer) >= off) &&
	(i + pointer) < (off + count)) {
	buf[ret] = tempbuffer[i];
	ret++;
	}
	}
	}

	pointer += 2 + tuple.TupleDataLen;

	if (pointer >= (off + count))
	break;

	if (tuple.TupleCode == CISTPL_END)
	break;
	status = pccard_get_next_tuple(s, BIND_FN_ALL, &tuple);
	}

	kfree(tempbuffer);
	free_tuple:
	kfree(tuplebuffer);

	return (ret);
	}

	static ssize_t pccard_show_cis(struct kobject kobj, char buf, loff_t off, size_t count)
	{
	unsigned int size = 0x200;

	if (off >= size)
	count = 0;
	else {
	struct pcmcia_socket *s;
	cisinfo_t cisinfo;

	if (off + count > size)
	count = size - off;

	s = to_socket(container_of(kobj, struct class_device, kobj));

	if (!(s->state & SOCKET_PRESENT))
	return -ENODEV;
	if (pccard_validate_cis(s, BIND_FN_ALL, &cisinfo))
	return -EIO;
	if (!cisinfo.Chains)
	return -ENODATA;

	count = pccard_extract_cis(s, buf, off, count);
	}

	return (count);
	}

	static ssize_t pccard_store_cis(struct kobject kobj, char buf, loff_t off, size_t count)
	{
	struct pcmcia_socket *s = to_socket(container_of(kobj, struct class_device, kobj));
	cisdump_t *cis;
	ssize_t ret = count;

	if (off)
	return -EINVAL;

	if (count >= 0x200)
	return -EINVAL;

	if (!(s->state & SOCKET_PRESENT))
	return -ENODEV;

	cis = kmalloc(sizeof(cisdump_t), GFP_KERNEL);
	if (!cis)
	return -ENOMEM;
	memset(cis, 0, sizeof(cisdump_t));

	cis->Length = count + 1;
	memcpy(cis->Data, buf, count);

	if (pcmcia_replace_cis(s, cis))
	ret = -EIO;

	kfree(cis);

	if (!ret) {
	down(&s->skt_sem);
	if ((s->callback) && (s->state & SOCKET_PRESENT) &&
	!(s->state & SOCKET_CARDBUS)) {
	if (try_module_get(s->callback->owner)) {
	s->callback->requery(s);
	module_put(s->callback->owner);
	}
	}
	up(&s->skt_sem);
	}


	return (ret);
	}


	static struct class_device_attribute *pccard_socket_attributes[] = {
	&class_device_attr_card_type,
	&class_device_attr_card_voltage,
	&class_device_attr_card_vpp,
	&class_device_attr_card_vcc,
	&class_device_attr_card_insert,
	&class_device_attr_card_eject,
	&class_device_attr_card_irq_mask,
	&class_device_attr_available_resources_setup_done,
	NULL,
	};

	static struct bin_attribute pccard_cis_attr = {
	.attr = { .name = "cis", .mode = S_IRUGO \| S_IWUSR, .owner = THIS_MODULE},
	.size = 0x200,
	.read = pccard_show_cis,
	.write = pccard_store_cis,
	};

	static int __devinit pccard_sysfs_add_socket(struct class_device *class_dev)
	{
	struct class_device_attribute **attr;
	int ret = 0;

	for (attr = pccard_socket_attributes; *attr; attr++) {
	ret = class_device_create_file(class_dev, *attr);
	if (ret)
	break;
	}
	if (!ret)
	ret = sysfs_create_bin_file(&class_dev->kobj, &pccard_cis_attr);

	return ret;
	}

	static void __devexit pccard_sysfs_remove_socket(struct class_device *class_dev)
	{
	struct class_device_attribute **attr;

	sysfs_remove_bin_file(&class_dev->kobj, &pccard_cis_attr);
	for (attr = pccard_socket_attributes; *attr; attr++)
	class_device_remove_file(class_dev, *attr);
	}

	struct class_interface pccard_sysfs_interface = {
	.class = &pcmcia_socket_class,
	.add = &pccard_sysfs_add_socket,
	.remove = __devexit_p(&pccard_sysfs_remove_socket),
	};