/* An hwmon driver for Cameo esqc610-56sq Innovium i2c Module */
#pragma GCC diagnostic ignored "-Wformat-zero-length"
#include "x86-64-cameo-esqc610-56sq.h"
#include "x86-64-cameo-esqc610-56sq-common.h"
#include "x86-64-cameo-esqc610-56sq-led.h"

/* i2c_client Declaration */
extern struct i2c_client *Cameo_CPLD_30_client; //0x30 for SYS CPLD
/* end of i2c_client Declaration */

/* implement i2c_function */
ssize_t led_ctrl_get(struct device *dev, struct device_attribute *da, char *buf)
{
    int status = -EPERM;
    int res = 0x1;
    int i;
    int led_a_status = 0;
    int led_g_status = 0;
    int led_b_status = 0;
    struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
    
    status = i2c_smbus_read_byte_data(Cameo_CPLD_30_client, LED_CTRL_REG);
    sprintf(buf, "");
    
    for (i = 1; i <= 4; i++)
    {
        if ( i == attr->index)
        {
            if (status & res)
            {
                led_a_status = ENABLE;
            }
            else
            {
                led_a_status = DISABLE;
            }
        }
        res = res << 1;
        if( i == (attr->index + 1) )
        {
            if (status & res)
            {
                led_g_status = ENABLE;
            }
            else
            {
                led_g_status = DISABLE;
            }
        }
        res = res << 1;
    }
    res = 0x1;

    status = i2c_smbus_read_byte_data(Cameo_CPLD_30_client, LED_BLINK_REG); 
    for (i = 1; i <= 4; i++)
    {
        if ( i == attr->index)
        {
            if (status & res)
            {
                led_b_status = ENABLE;
            }
            else
            {
                led_b_status = DISABLE;
            }
        }
        res = res << 1;
    }
    if(led_a_status == ENABLE && led_b_status == ENABLE)
    {
        sprintf(buf, "%s2\n", buf);
    }
    else if(led_a_status == ENABLE && led_b_status == DISABLE)
    {
        sprintf(buf, "%s1\n", buf);
    }
    else if(led_g_status == ENABLE && led_b_status == ENABLE)
    {
        sprintf(buf, "%s4\n", buf);
    }
    else if(led_g_status == ENABLE && led_b_status == DISABLE)
    {
        sprintf(buf, "%s3\n", buf);
    }
    else
    {
        sprintf(buf, "%s0\n", buf);
    }
    
    return sprintf(buf, "%s", buf);
}

ssize_t led_ctrl_set(struct device *dev, struct device_attribute *da, const char *buf, size_t count)
{
    int led_value  = -EPERM;
    int blk_value  = -EPERM;
    int result = -EPERM;
    int offset = 0;
    u16 i;
    struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
	struct Cameo_i2c_data *data = i2c_get_clientdata(Cameo_CPLD_30_client);
    
    mutex_lock(&data->update_lock);
    led_value = i2c_smbus_read_byte_data(Cameo_CPLD_30_client, LED_CTRL_REG);
    blk_value = i2c_smbus_read_byte_data(Cameo_CPLD_30_client, LED_BLINK_REG);
    if (attr->index != 0)
    {
        i = simple_strtol(buf, NULL, 10);
        if(attr->index == 1)
        {
            offset = 0;
        }
        else
        {
            offset = 2*((attr->index)-1);
        }
        switch(i)
        {
            case SWITCH_LED_OFF: //i=0
                led_value   &= ~(0x03 << offset);
                blk_value   &= ~(1 << ((attr->index)-1));
                break;
            case SWITCH_LED_A_N: //i=1
                led_value   &= ~(0x03 << offset);
                led_value   |= (0x01 << offset);
                blk_value   &= ~(1 << ((attr->index)-1));
                break;
            case SWITCH_LED_A_B: //i=2
                led_value   &= ~(0x03 << offset);
                led_value   |= (0x01 << offset);
                blk_value   |= (1 << ((attr->index)-1));
                break;
            case SWITCH_LED_G_N: //i=3
                led_value   &= ~(0x03 << offset);
                led_value   |= (0x02 << offset);
                blk_value   &= ~(1 << ((attr->index)-1));
                break;
            case SWITCH_LED_G_B: //i=4
                led_value   &= ~(0x03 << offset);
                led_value   |= (0x02 << offset);
                blk_value   |= (1 << ((attr->index)-1));
                break;
            default:
                printk(KERN_ALERT "led_ctrl_set wrong Value\n");
                return count;
        }
        result  = i2c_smbus_write_byte_data(Cameo_CPLD_30_client, LED_CTRL_REG, led_value);
        result |= i2c_smbus_write_byte_data(Cameo_CPLD_30_client, LED_BLINK_REG, blk_value);
        if (result < 0)
        {
            printk(KERN_ALERT "ERROR: led_ctrl_set FAILED!\n");
        }
    }
    mutex_unlock(&data->update_lock);
    return count;
}

ssize_t led_fiber_get(struct device *dev, struct device_attribute *da, char *buf)
{
    struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
	struct Cameo_i2c_data *data = i2c_get_clientdata(Cameo_CPLD_30_client);
    
    mutex_lock(&data->update_lock);
    sprintf(buf, "");
    if (attr->index == LED_FIBER)
    {
        if (i2c_smbus_read_byte_data(Cameo_CPLD_30_client, LED_FIBER_REG) & BIT_0_MASK)
        {
            sprintf(buf, "%s%d\n", buf, ENABLE);
        }
        else
        {
            sprintf(buf, "%s%d\n", buf, DISABLE);
        }
    }
    mutex_unlock(&data->update_lock);
    return sprintf(buf, "%s\n", buf);
}
ssize_t led_fiber_set(struct device *dev, struct device_attribute *da, const char *buf, size_t count)
{
    int status = -EPERM;
    int value  = -EPERM;
    int result = -EPERM;
    int input;
    struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
	struct Cameo_i2c_data *data = i2c_get_clientdata(Cameo_CPLD_30_client);
    
    mutex_lock(&data->update_lock);
    status = i2c_smbus_read_byte_data(Cameo_CPLD_30_client, LED_CTRL_REG);
    if (attr->index == LED_FIBER)
    {
        input = simple_strtol(buf, NULL, 10);
        if (input == ENABLE)
        {
            value = status | LED_FIBER_ENABLE;
            result = i2c_smbus_write_byte_data(Cameo_CPLD_30_client, LED_FIBER_REG, value);
            if (result < 0)
            {
                printk(KERN_ALERT "ERROR: led_ctrl_set FAILED!\n");
            }
        }
        else if (input == DISABLE)
        {
            value = status & LED_FIBER_DISABLE;
            result = i2c_smbus_write_byte_data(Cameo_CPLD_30_client, LED_FIBER_REG, value);
            if (result < 0)
            {
                printk(KERN_ALERT "ERROR: led_ctrl_set FAILED!\n");
            }
        }
        else
        {
            printk(KERN_ALERT "led_ctrl_set wrong Value\n");
        }
    }
    mutex_unlock(&data->update_lock);
    return count;
}
/* end of implement i2c_function */