sonic-buildimage/platform/nephos/sonic-platform-modules-accton/as7116-54x/modules/x86-64-accton-as7116-54x-cpld.c

/*
 * A hwmon driver for the as7116_54x_cpld
 *
 * Copyright (C) 2017 Accton Technology Corporation.
 * Brandon Chuang <brandon_chuang@accton.com.tw>
 *
 * Based on ad7414.c
 * Copyright 2006 Stefan Roese <sr at denx.de>, DENX Software Engineering
 *
 * 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, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
 */

#include <linux/module.h>
#include <linux/i2c.h>
#include <linux/slab.h>
#include <linux/list.h>
#include <linux/dmi.h>

static LIST_HEAD(cpld_client_list);
static struct mutex	 list_lock;

struct cpld_client_node {
	struct i2c_client *client;
	struct list_head   list;
};

/* Addresses scanned for as7116_54x_cpld
 */
static const unsigned short normal_i2c[] = { I2C_CLIENT_END };

static ssize_t show_cpld_version(struct device *dev, struct device_attribute *attr, char *buf)
{
    int val = 0;
    struct i2c_client *client = to_i2c_client(dev);
	
	val = i2c_smbus_read_byte_data(client, 0x1);

    if (val < 0) {
        dev_dbg(&client->dev, "cpld(0x%x) reg(0x1) err %d\n", client->addr, val);
    }
	
    return sprintf(buf, "%d\n", val);
}	

static struct device_attribute ver = __ATTR(version, 0600, show_cpld_version, NULL);

static void as7116_54x_cpld_add_client(struct i2c_client *client)
{
	struct cpld_client_node *node = kzalloc(sizeof(struct cpld_client_node), GFP_KERNEL);
	
	if (!node) {
		dev_dbg(&client->dev, "Can't allocate cpld_client_node (0x%x)\n", client->addr);
		return;
	}
	
	node->client = client;
	
	mutex_lock(&list_lock);
	list_add(&node->list, &cpld_client_list);
	mutex_unlock(&list_lock);
}

static void as7116_54x_cpld_remove_client(struct i2c_client *client)
{
	struct list_head		*list_node = NULL;
	struct cpld_client_node *cpld_node = NULL;
	int found = 0;
	
	mutex_lock(&list_lock);

	list_for_each(list_node, &cpld_client_list)
	{
		cpld_node = list_entry(list_node, struct cpld_client_node, list);
		
		if (cpld_node->client == client) {
			found = 1;
			break;
		}
	}
	
	if (found) {
		list_del(list_node);
		kfree(cpld_node);
	}
	
	mutex_unlock(&list_lock);
}

static int as7116_54x_cpld_probe(struct i2c_client *client,
			const struct i2c_device_id *dev_id)
{
	int status;

	if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA)) {
		dev_dbg(&client->dev, "i2c_check_functionality failed (0x%x)\n", client->addr);
		status = -EIO;
		goto exit;
	}

	status = sysfs_create_file(&client->dev.kobj, &ver.attr);
	if (status) {
		goto exit;
	}

	dev_info(&client->dev, "chip found\n");
	as7116_54x_cpld_add_client(client);
	
	return 0;

exit:
	return status;
}

static int as7116_54x_cpld_remove(struct i2c_client *client)
{
	sysfs_remove_file(&client->dev.kobj, &ver.attr);
	as7116_54x_cpld_remove_client(client);
	
	return 0;
}

enum cpld_chips 
{ 
    as7116_54x_cpld1,
	as7116_54x_cpld2,
	as7116_54x_cpld3
};

static const struct i2c_device_id as7116_54x_cpld_id[] = {
	{ "as7116_54x_cpld1", as7116_54x_cpld1 },
	{ "as7116_54x_cpld2", as7116_54x_cpld2 },
	{ "as7116_54x_cpld3", as7116_54x_cpld3 },
	{}
};
MODULE_DEVICE_TABLE(i2c, as7116_54x_cpld_id);

static struct i2c_driver as7116_54x_cpld_driver = {
	.class		= I2C_CLASS_HWMON,
	.driver = {
		.name = "as7116_54x_cpld",
	},
	.probe		= as7116_54x_cpld_probe,
	.remove	   	= as7116_54x_cpld_remove,
	.id_table	= as7116_54x_cpld_id,
	.address_list = normal_i2c,
};

int as7116_54x_cpld_read(unsigned short cpld_addr, u8 reg)
{
	struct list_head   *list_node = NULL;
	struct cpld_client_node *cpld_node = NULL;
	int ret = -EPERM;
	
	mutex_lock(&list_lock);

	list_for_each(list_node, &cpld_client_list)
	{
		cpld_node = list_entry(list_node, struct cpld_client_node, list);
		
		if (cpld_node->client->addr == cpld_addr) {
			ret = i2c_smbus_read_byte_data(cpld_node->client, reg);
			break;
		}
	}
	
	mutex_unlock(&list_lock);

	return ret;
}
EXPORT_SYMBOL(as7116_54x_cpld_read);

int as7116_54x_cpld_write(unsigned short cpld_addr, u8 reg, u8 value)
{
	struct list_head   *list_node = NULL;
	struct cpld_client_node *cpld_node = NULL;
	int ret = -EIO;
	
	mutex_lock(&list_lock);

	list_for_each(list_node, &cpld_client_list)
	{
		cpld_node = list_entry(list_node, struct cpld_client_node, list);
		
		if (cpld_node->client->addr == cpld_addr) {
			ret = i2c_smbus_write_byte_data(cpld_node->client, reg, value);
			break;
		}
	}
	
	mutex_unlock(&list_lock);

	return ret;
}
EXPORT_SYMBOL(as7116_54x_cpld_write);

static int __init as7116_54x_cpld_init(void)
{
	mutex_init(&list_lock);
	return i2c_add_driver(&as7116_54x_cpld_driver);
}

static void __exit as7116_54x_cpld_exit(void)
{
	i2c_del_driver(&as7116_54x_cpld_driver);
}

static struct dmi_system_id as7116_54x_dmi_table[] = {
        {
                .ident = "Accton AS7716",
                .matches = {
                        DMI_MATCH(DMI_BOARD_VENDOR, "Accton"),
                        DMI_MATCH(DMI_PRODUCT_NAME, "AS7116"),
                },
        }
};

int platform_accton_as7116_54x(void)
{
    //return dmi_check_system(as7116_54x_dmi_table);
	return 1;
}
EXPORT_SYMBOL(platform_accton_as7116_54x);

MODULE_AUTHOR("Brandon Chuang <brandon_chuang@accton.com.tw>");
MODULE_DESCRIPTION("accton_as7116_54x driver");
MODULE_LICENSE("GPL");

module_init(as7116_54x_cpld_init);
module_exit(as7116_54x_cpld_exit);