Commit a31b83fc authored by Oleg Dzhimiev's avatar Oleg Dzhimiev
Browse files

PCA9571 controlling

parent 1809d055

src/drivers/elphel/elphel393-pwr.c

+62 −13
Original line number Diff line number Diff line
@@ -73,7 +73,7 @@ struct pwr_gpio_t { 
struct elphel393_pwr_data_t {

	int chip_i2c_addr[4];

	struct device * ltc3489_dev;

	struct pwr_gpio_t pwr_gpio [16];

	struct pwr_gpio_t pwr_gpio [24];

	int simulate; /* do not perform actual i2c writes */

	struct mutex lock;

	int pgoot_timeout;
@@ -204,7 +204,7 @@ static struct voltage_reg_t voltage_reg[]={ 
		},

}; 



static struct pwr_gpio_t pwr_gpio[16]={

static struct pwr_gpio_t pwr_gpio[24]={

/* 0x20: */

		{"PWR_MGB1",    0, 0, 0}, /* 1.8V margining magnitude (0 - 5%, 1 - 10%, float - 15%) */

		{"PWR_MG1",     1, 0, 0}, /* 1.8V margining enable 0 - negative margining, 1 - positive margining, float - no margining */
@@ -262,9 +262,12 @@ static ssize_t pgood_show(struct device *dev, struct device_attribute *attr, cha 
static ssize_t pbad_show(struct device *dev, struct device_attribute *attr, char *buf);

static ssize_t enable_por_show(struct device *dev, struct device_attribute *attr, char *buf);

static ssize_t enable_por_store(struct device *dev, struct device_attribute *attr, const char *buf, size_t count);

static ssize_t gpio_10389_get(struct device *dev, struct device_attribute *attr, char *buf);

static ssize_t gpio_10389_set(struct device *dev, struct device_attribute *attr, char *buf, size_t count);

static ssize_t gpio_poweroff(struct device *dev, struct device_attribute *attr, char *buf, size_t count);



static int por_ctrl(struct device *dev, int disable_por);

static int gpio_shutdown(struct device *dev);

static int por_ctrl(struct device *dev, int disable_por);

static int get_and_disable_por(struct device *dev, int chn_bits, int * old_dis_por);

static int reenable_por(struct device *dev);

static int wait_all_pgood(struct device *dev);
@@ -312,8 +315,8 @@ static DEVICE_ATTR(channels_dis, SYSFS_PERMISSIONS, channels 
static DEVICE_ATTR(power_good,   SYSFS_PERMISSIONS & SYSFS_READONLY,    pgood_show,          NULL);

static DEVICE_ATTR(power_bad,    SYSFS_PERMISSIONS & SYSFS_READONLY,    pbad_show,           NULL);

static DEVICE_ATTR(enable_por,   SYSFS_PERMISSIONS,                     enable_por_show,     enable_por_store);

static DEVICE_ATTR(power_off,    SYSFS_PERMISSIONS                 ,    NULL,                gpio_shutdown);



static DEVICE_ATTR(power_off,    SYSFS_PERMISSIONS                 ,    NULL,                gpio_poweroff);

static DEVICE_ATTR(gpio_10389,   SYSFS_PERMISSIONS,                     gpio_10389_get,      gpio_10389_set);



static struct attribute *root_dev_attrs[] = {

		&dev_attr_simulate.attr,
@@ -325,6 +328,7 @@ static struct attribute *root_dev_attrs[] = { 
		&dev_attr_power_bad.attr,

		&dev_attr_enable_por.attr,

		&dev_attr_power_off.attr,

		&dev_attr_gpio_10389.attr,

	    NULL

};

static const struct attribute_group dev_attr_root_group = {
@@ -589,6 +593,54 @@ static ssize_t enable_por_store(struct device *dev, struct device_attribute *att 
	return count;

}



int gpio_10389_ctrl(struct device *dev, int value){

	int i, res;

	int val = 0;

	//lock here

	for(i=16;i<20;i++){

		if ((value>>(i-8))&0x1){

			val = (value>>(i-16))&0x1;

			res = gpio_conf_by_index(dev, i, 1, ~val);

			if (res<0) return res;

			res = gpio_conf_by_index(dev, i, 1, val);

			if (res<0) return res;

		}

	}

	//unlock somewhere here

	return 0;

}



static ssize_t gpio_10389_set(struct device *dev, struct device_attribute *attr, char *buf, size_t count)

{

	int result;

	int value;

	sscanf(buf, "%x", &value);

	result = gpio_10389_ctrl(dev,value);

	if (result<0) return result;

	return count;

}



static ssize_t gpio_10389_get(struct device *dev, struct device_attribute *attr, char *buf)

{

	int i;

	unsigned int res=0;

	struct elphel393_pwr_data_t *clientdata=platform_get_drvdata(to_platform_device(dev));

	// just 4 of them

	for (i=16;i<20;i++){

		if (pwr_gpio[i].label){

			res += ((clientdata->pwr_gpio[i].out_val)?1:0)<<(i-16);

		}

	}

	return sprintf(buf,"%02x\n",res);

}



static ssize_t gpio_poweroff(struct device *dev, struct device_attribute *attr, char *buf, size_t count)

{

	int rc=gpio_shutdown(dev);

	if (rc<0) return rc;

	return count;

}



int gpio_shutdown(struct device *dev)

{

	int gpio_shutdown_index=get_gpio_index_by_name("NSHUTDOWN");
@@ -1157,11 +1209,8 @@ static int elphel393_pwr_probe(struct platform_device *pdev) 
    for (i=0;i<ARRAY_SIZE(pwr_gpio);i++) if (pwr_gpio[i].label){

    	clientdata->pwr_gpio[i].label=pwr_gpio[i].label;

    	clientdata->pwr_gpio[i].pin=base[i>>3]+(i & 7);

    	if (i<16) {

    		clientdata->pwr_gpio[i].dir=0; /* input */

    	}else{

    		clientdata->pwr_gpio[i].dir=1; /* output */

    	}

    	if (i<16) clientdata->pwr_gpio[i].dir=0; /* input */

    	else      clientdata->pwr_gpio[i].dir=1; /* output */

    	clientdata->pwr_gpio[i].out_val=0; 

    	rc=gpio_request(clientdata->pwr_gpio[i].pin, clientdata->pwr_gpio[i].label);

    	if (rc<0){