utils/usbctrl.cpp

/* main.c */  

#include <stdio.h>
#include <stdlib.h>
#include <errno.h>
#include <string.h>
#include <sys/stat.h>
#include <sys/types.h>

#include <fcntl.h>
#include <dirent.h>
#include "porting.h"

#define LOG_TAG "USBPower"

#include "usbctrl.h"

#define TOLOWER(x) ((x) | 0x20)

//driver support 0-kernel2.6 1-kernel3.0(before M6) 2-kernel3.0(M6&later)
#define DWC_DRIVER_1			0
#define DWC_DRIVER_2			1
#define DWC_DRIVER_3			2
#define DWC_DRIVER_4			3
#define DWC_DRIVER_MAX			4

#define DWC_DRIVER_VERSION_1	"2.60a"
#define DWC_DRIVER_VERSION_2  	"2.20a"
#define DWC_DRIVER_VERSION_3  	"2.94a"
#define DWC_DRIVER_VERSION_4  	"3.10a"
#define DWC_DRIVER_VERSION_LEN	5

#define DWC_OTG_VERSION_DIR	"/sys/bus/logicmodule/drivers/dwc_otg/version"

#define IDX_ATTR_FILENAME	"/sys/devices/platform/usb_phy_control/index"

#define POWER_ATTR_FILENAME_1		"/sys/devices/platform/usb_phy_control/por"
#define POWER_ATTR_FILENAME_2		"/sys/devices/lm0/peri_sleepm"
#define POWER_ATTR_FILENAME_3		"/sys/devices/lm0/peri_sleepm"
#define POWER_ATTR_FILENAME_4		"/sys/devices/lm0/peri_sleepm"
//#define POWER_ATTR_FILENAME_2		"/sys/devices/lm0/peri_power"
//#define POWER_ATTR_FILENAME_3		"/sys/devices/lm0/peri_power"

#define OTG_DISABLE_FILE_NAME_1	"/sys/devices/platform/usb_phy_control/otgdisable"
#define OTG_DISABLE_FILE_NAME_2	"/sys/devices/lm0/peri_otg_disable"
#define OTG_DISABLE_FILE_NAME_3	"/sys/devices/lm0/peri_otg_disable"
#define OTG_DISABLE_FILE_NAME_4	"/sys/devices/lm0/peri_otg_disable"

#define CONNECT_STR			"Bus Connected = 0x"
#define CONNECT_FILE_NAME	"/sys/devices/lm0/busconnected"
#define PULLUP_FILE_NAME	"/sys/devices/lm0/pullup"

#define GOTGCTL_STR			"GOTGCTL = 0x"
#define GOTGCTL_FILE_NAME	"/sys/devices/lm0/gotgctl"

#define USB_GATE_OFF_FILE_NAME	"/sys/class/aml_mod/mod_off"
#define USB_GATE_ON_FILE_NAME	"/sys/class/aml_mod/mod_on"

#define USB_ID			16
#define USB_ID_HOST		0x0
#define USB_ID_DEVICE	0x1

#define USB_SES			18
#define USB_SES_VALID	0x3

int dwc_driver_version=-1;   //if dwc_driver_version == -1(not support) 0--2(driver version)
char dwc_driver_version_str[DWC_DRIVER_MAX][DWC_DRIVER_VERSION_LEN+1] = 
{
			DWC_DRIVER_VERSION_1,
			DWC_DRIVER_VERSION_2,
			DWC_DRIVER_VERSION_3,
			DWC_DRIVER_VERSION_4
};

char power_attr_filename_str[DWC_DRIVER_MAX][64] = 
{
			POWER_ATTR_FILENAME_1,
			POWER_ATTR_FILENAME_2,
			POWER_ATTR_FILENAME_3,
			POWER_ATTR_FILENAME_4
};

char otg_disable_filename_str[DWC_DRIVER_MAX][64]=
{
			OTG_DISABLE_FILE_NAME_1,
			OTG_DISABLE_FILE_NAME_2,
			OTG_DISABLE_FILE_NAME_3,
			OTG_DISABLE_FILE_NAME_4
};

char usb_index_str[USB_IDX_MAX][2]=
{
	"A","B"
};

char usb_state_str[USB_CMD_MAX][8]=
{
	"on","off","if"
};

char usb_state_val[USB_CMD_MAX][2]=
{
	"0","1","2"
};
char pullup_filename_str[32];
char usb_gate_str[8]={"usb0"};

static void usage(void)
{
    printf("usbpower USAGE:\n");
    printf("usbpower <portindex> <cmd> \n");
		printf("        index: A or B ; state: on/off/if(find device exist)\n");
    printf("for example: usbpower A	on\n");
    exit(1);
}

static int get_device_if(int idx)
{
	int ret = 0;
	int err = 0;
	char line[32];
	char filename[32];
	FILE *fp;
	unsigned int busconnect,gotgctl;

	strcpy(filename,GOTGCTL_FILE_NAME);
	filename[15] = idx + '0';

	if((fp = fopen(filename,"r"))) {
		if (fgets(line, 32, fp)) {
			if (!strncmp(line, GOTGCTL_STR, strlen(GOTGCTL_STR))) {
				sscanf(line+strlen(GOTGCTL_STR),"%x",&gotgctl);
			}
			else
			{
				SLOGE("gotgctl txt is error\n");
				err =1;
			}
		} else {
			SLOGE("Failed to read gotgctl\n");
			err=2;
		}

		fclose(fp);
	} else {
		//SLOGW("No usb device\n");
		err=3;
	}
	
	if(err)
		return 0;
	
	strcpy(filename,CONNECT_FILE_NAME);
	filename[15] = idx + '0';

	if((fp = fopen(filename,"r"))) {
		if (fgets(line, 32, fp)) {
			if (!strncmp(line, CONNECT_STR, strlen(CONNECT_STR))) {
				sscanf(line+strlen(CONNECT_STR),"%x",&busconnect);
      			}else{
				SLOGE("busconnected txt is error\n");
				err=4;
			}
		} else {
			SLOGE("Failed to read busconnected\n");
			err=5;
		}

		fclose(fp);
	} else {
		//SLOGW("No usb device\n");
		err=6;
	}

	if(err)
		return 0;
		
	if(((gotgctl>>USB_ID)&0x1)==	USB_ID_HOST)
	{
		if(idx==0)
		{		
		if(((gotgctl>>USB_SES)&0x3)== USB_SES_VALID)
		{
			// this case,check busconnected
			if(busconnect==1)
				ret = 1;
		}
		else
		{
			//this case ,can't power of,so we look it as connect
			ret = 1;
		}
	}
	else
	{
			if(busconnect==1)
					ret = 1;
		}
	}
	else
	{
		// this case,check gotgctl USB_SES_VALID
		if(((gotgctl>>USB_SES)&0x3)== USB_SES_VALID)
			ret = 1;
	}
	return ret;
}

static int set_power_ctl(int idx,int cmd)
{
	int ret = 0;
	int err = 0;
	FILE *fp,*fpp = NULL,*fpo = NULL, *fp_gotgctl,*fp_gate;	
  	unsigned int gotgctl;
  	char filename[32];
  	char line[32];
	int version = dwc_driver_version;
  
	if(cmd == USB_CMD_OFF)
	{
		ret = get_device_if(idx);
		if(ret == 1)
		{
			printf("Has devices on this port,can't power off!\n");
			return ret;
		}
	}
	
	strcpy(filename,GOTGCTL_FILE_NAME);
	filename[15] = idx + '0';

	if((fp_gotgctl = fopen(filename,"r"))) {
		if (fgets(line, 32, fp_gotgctl)) {
			if (!strncmp(line, GOTGCTL_STR, strlen(GOTGCTL_STR))) {
				sscanf(line+strlen(GOTGCTL_STR),"%x",&gotgctl);
			}
			else
			{
				SLOGE("gotgctl txt is error\n");
				err =1;
			}
		} else {
			SLOGE("Failed to read gotgctl\n");
			err=2;
		}

		fclose(fp_gotgctl);
	} else {
		//SLOGW("No usb device\n");
		err=3;
	}
	
	if(err)
		return -1;

	if(version == DWC_DRIVER_1)
	{
		if((fp = fopen(IDX_ATTR_FILENAME,"w"))){   
		    	fwrite(usb_index_str[idx], 1, strlen(usb_index_str[idx]),fp);
		    	fclose(fp);
		}
		else
		{
			ret = -1;
		}
		
		if(ret == 0)
		{
			if(((gotgctl>>USB_ID)&0x1)==	USB_ID_HOST)
			{
				if((fp = fopen(power_attr_filename_str[version],"w"))){
					fwrite(usb_state_str[cmd], 1, strlen(usb_state_str[cmd]),fp);	//power	
				}
				else
				{
					ret = -2;
				}
				if(fp) fclose(fp);
			}
			else
			{
				strcpy(pullup_filename_str,PULLUP_FILE_NAME);
				pullup_filename_str[15] = idx + '0';
			  	if((fp = fopen(power_attr_filename_str[version],"w")) && (fpp = fopen(pullup_filename_str,"w"))
					 && (fpo = fopen(otg_disable_filename_str[version],"w"))){ 
					if(cmd == USB_CMD_OFF)
					{
					 	fwrite(usb_state_str[cmd], 1, strlen(usb_state_str[cmd]),fpo);	//otg		
				    		fwrite(usb_state_str[cmd], 1, strlen(usb_state_str[cmd]),fpp);	//pullup
				    		fwrite(usb_state_str[cmd], 1, strlen(usb_state_str[cmd]),fp);	//power
					}
					else
					{ 
					  	fwrite(usb_state_str[cmd], 1, strlen(usb_state_str[cmd]),fp);	//power 				
				    		fwrite(usb_state_str[cmd], 1, strlen(usb_state_str[cmd]),fpo);	//otg		
				    		fwrite(usb_state_str[cmd], 1, strlen(usb_state_str[cmd]),fpp);	//pullup
				  	}				
			  	}
			  	else
			  	{
				  	ret = -2;
			  	}
			  	if(fp) 	fclose(fp);
	    			if(fpp)	fclose(fpp);
			  	if(fpo)	fclose(fpo);
			}		
		}
	}
	else 
	{
		power_attr_filename_str[version][15] = idx + '0';
		otg_disable_filename_str[version][15]= idx + '0';
		usb_gate_str[3] = idx + '0';

		if(((gotgctl>>USB_ID)&0x1)==	USB_ID_HOST)
		{
			if((fp = fopen(power_attr_filename_str[version],"w"))){
				if(cmd == USB_CMD_OFF)
				{
				fwrite(usb_state_val[cmd], 1, strlen(usb_state_val[cmd]),fp);	//power	
					fp_gate = fopen(USB_GATE_OFF_FILE_NAME,"w");
					if(fp_gate){
						fwrite(usb_gate_str,1,strlen(usb_gate_str),fp_gate);
						fclose(fp_gate);
					}
				}
				else
				{ 
				  	fp_gate = fopen(USB_GATE_ON_FILE_NAME,"w");
					if(fp_gate){
						fwrite(usb_gate_str,1,strlen(usb_gate_str),fp_gate);
						fclose(fp_gate);
					}
					fwrite(usb_state_val[cmd], 1, strlen(usb_state_val[cmd]),fp);	//power
			  	}		
			}
			else
			{
				ret = -2;
			}
			if(fp) fclose(fp);
		}
		else
		{
		  	if((fp = fopen(power_attr_filename_str[version],"w"))
				 && (fpo = fopen(otg_disable_filename_str[version],"w"))){ 
				if(cmd == USB_CMD_OFF)
				{
				 	fwrite(usb_state_val[cmd], 1, strlen(usb_state_val[cmd]),fpo);	//otg		
			    		fwrite(usb_state_val[cmd], 1, strlen(usb_state_val[cmd]),fp);	//power
			    		fp_gate = fopen(USB_GATE_OFF_FILE_NAME,"w");
					if(fp_gate){
						fwrite(usb_gate_str,1,strlen(usb_gate_str),fp_gate);
						fclose(fp_gate);
					}
				}
				else
				{ 
					fp_gate = fopen(USB_GATE_ON_FILE_NAME,"w");
					if(fp_gate){
						fwrite(usb_gate_str,1,strlen(usb_gate_str),fp_gate);
						fclose(fp_gate);
					}
				  	fwrite(usb_state_val[cmd], 1, strlen(usb_state_val[cmd]),fp);	//power 				
			    		fwrite(usb_state_val[cmd], 1, strlen(usb_state_val[cmd]),fpo);	//otg		
			  	}				
		  	}
		  	else
		  	{
			  	ret = -2;
		  	}
		  	if(fp) 	fclose(fp);
		  	if(fpo)	fclose(fpo);
		}	
	}
	
	return ret;
}

char ver_buf[DWC_DRIVER_VERSION_LEN + 1];
int get_dwc_driver_version(void)
{
	FILE *fpv;
	int i;

	dwc_driver_version = -1;
	fpv = fopen(DWC_OTG_VERSION_DIR,"r");
	if(fpv){
		if (fread(ver_buf,1,DWC_DRIVER_VERSION_LEN + 1,fpv) == DWC_DRIVER_VERSION_LEN + 1 ) {
			for (i=DWC_DRIVER_1; i<DWC_DRIVER_MAX; i++) {
				if(strncmp(ver_buf,dwc_driver_version_str[i],DWC_DRIVER_VERSION_LEN)==0){
					dwc_driver_version = i;
					break;
				}
			}
		}
		fclose(fpv);
	}

   	if(dwc_driver_version==-1){
		//used other process for the version different from DWC_DRIVER_VERSION
		return -1;
	}

	if(dwc_driver_version == DWC_DRIVER_2)
	{
		//now we have not supported this version.It will be supported later.
		return -1;
	}
	return 0;
}

int usbpower(int index,int cmd)
{   
	int ret=0;
	
	if((cmd==USB_CMD_ON)||(cmd==USB_CMD_OFF))
	{
		ret = set_power_ctl(index,cmd);
	}
	else if(cmd == USB_CMD_IF)
	{
		ret = get_device_if(index);
#if 0
		if(ret == 1 )
			printf("Has Device\n");
		else
			printf("No device\n");
#endif
	}

	return ret;
}