zhao/QModem
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

解决硬编码导致不兼容hv问题

Browse Source
This commit is contained in:
ling 2024-03-20 18:47:29 +08:00
parent 945723e869
commit adb173a6ca
1 changed files with 146 additions and 154 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

290
quectel_cm_5G/src/device.c
View File

@ -32,21 +32,21 @@
#include "QMIThread.h" #include "QMIThread.h"
#include "ethtool-copy.h" #include "ethtool-copy.h"
#define USB_CLASS_VENDOR_SPEC 0xff #define USB_CLASS_VENDOR_SPEC 0xff
#define USB_CLASS_COMM 2 #define USB_CLASS_COMM 2
#define USB_CDC_SUBCLASS_ACM 0x02 #define USB_CDC_SUBCLASS_ACM 0x02
#define USB_CDC_SUBCLASS_ETHERNET 0x06 #define USB_CDC_SUBCLASS_ETHERNET 0x06
#define USB_CDC_SUBCLASS_NCM 0x0d #define USB_CDC_SUBCLASS_NCM 0x0d
#define USB_CDC_SUBCLASS_MBIM 0x0e #define USB_CDC_SUBCLASS_MBIM 0x0e
#define USB_CLASS_WIRELESS_CONTROLLER 0xe0 #define USB_CLASS_WIRELESS_CONTROLLER 0xe0
#define CM_MAX_PATHLEN 256 #define CM_MAX_PATHLEN 256
#define CM_INVALID_VAL (~((int)0)) #define CM_INVALID_VAL (~((int)0))
/* get first line from file 'fname' /* get first line from file 'fname'
* And convert the content into a hex number, then return this number */ * And convert the content into a hex number, then return this number */
static int file_get_value(const char *fname, int base) { static int file_get_value(const char *fname, int base)
{
FILE *fp = NULL; FILE *fp = NULL;
long num; long num;
char buff[32 + 1] = {'\0'}; char buff[32 + 1] = {'\0'};
@ -58,7 +58,7 @@ static int file_get_value(const char *fname, int base) {
goto error; goto error;
fclose(fp); fclose(fp);
num = (int) strtol(buff, &endptr, base); num = (int)strtol(buff, &endptr, base);
if (errno == ERANGE && (num == LONG_MAX || num == LONG_MIN)) if (errno == ERANGE && (num == LONG_MAX || num == LONG_MIN))
goto error; goto error;
/* if there is no digit in buff */ /* if there is no digit in buff */
@ -67,9 +67,9 @@ static int file_get_value(const char *fname, int base) {
if (debug_qmi) if (debug_qmi)
dbg_time("(%s) = %lx", fname, num); dbg_time("(%s) = %lx", fname, num);
return (int) num; return (int)num;
error: error:
if (fp) fclose(fp); if (fp) fclose(fp);
return CM_INVALID_VAL; return CM_INVALID_VAL;
} }
@ -78,7 +78,8 @@ static int file_get_value(const char *fname, int base) {
* This function will search the directory 'dirname' and return the first child. * This function will search the directory 'dirname' and return the first child.
* '.' and '..' is ignored by default * '.' and '..' is ignored by default
*/ */
static int dir_get_child(const char *dirname, char *buff, unsigned bufsize, const char *prefix) { static int dir_get_child(const char *dirname, char *buff, unsigned bufsize, const char *prefix)
{
struct dirent *entptr = NULL; struct dirent *entptr = NULL;
DIR *dirptr; DIR *dirptr;
@ -101,13 +102,14 @@ static int dir_get_child(const char *dirname, char *buff, unsigned bufsize, cons
return 0; return 0;
} }
static int conf_get_val(const char *fname, const char *key) { static int conf_get_val(const char *fname, const char *key)
{
char buff[128] = {'\0'}; char buff[128] = {'\0'};
FILE *fp = fopen(fname, "r"); FILE *fp = fopen(fname, "r");
if (!fp) if (!fp)
return CM_INVALID_VAL; return CM_INVALID_VAL;
while (fgets(buff, sizeof(buff) - 1, fp)) { while (fgets(buff, sizeof(buff)-1, fp)) {
char prefix[128] = {'\0'}; char prefix[128] = {'\0'};
char tail[128] = {'\0'}; char tail[128] = {'\0'};
/* To eliminate cppcheck warnning: Assume string length is no more than 15 */ /* To eliminate cppcheck warnning: Assume string length is no more than 15 */
@ -188,13 +190,14 @@ static void query_usb_interface_info(char *path, struct usb_interface_info *p) {
break; break;
n--; n--;
} }
strncpy(p->driver, &driver[n + 1], sizeof(p->driver) - 1); strncpy(p->driver, &driver[n+1], sizeof(p->driver) - 1);
} }
path[offset] = '\0'; path[offset] = '\0';
} }
static int detect_path_cdc_wdm_or_qcqmi(char *path, char *devname, size_t bufsize) { static int detect_path_cdc_wdm_or_qcqmi(char *path, char *devname, size_t bufsize)
{
size_t offset = strlen(path); size_t offset = strlen(path);
char tmp[32]; char tmp[32];
@ -220,7 +223,7 @@ static int detect_path_cdc_wdm_or_qcqmi(char *path, char *devname, size_t bufsiz
return -1; return -1;
step_1: step_1:
/* get device(qcqmiX|cdc-wdmX) */ /* get device(qcqmiX|cdc-wdmX) */
if (debug_qmi) dbg_time("%s", path); if (debug_qmi) dbg_time("%s", path);
dir_get_child(path, tmp, sizeof(tmp), NULL); dir_get_child(path, tmp, sizeof(tmp), NULL);
@ -229,7 +232,8 @@ static int detect_path_cdc_wdm_or_qcqmi(char *path, char *devname, size_t bufsiz
/* There is a chance that, no device(qcqmiX|cdc-wdmX) is generated. We should warn user about that! */ /* There is a chance that, no device(qcqmiX|cdc-wdmX) is generated. We should warn user about that! */
snprintf(devname, bufsize, "/dev/%s", tmp); snprintf(devname, bufsize, "/dev/%s", tmp);
if (access(devname, R_OK | F_OK) && errno == ENOENT) { if (access(devname, R_OK | F_OK) && errno == ENOENT)
{
int major, minor; int major, minor;
dbg_time("access %s failed, errno: %d (%s)", devname, errno, strerror(errno)); dbg_time("access %s failed, errno: %d (%s)", devname, errno, strerror(errno));
@ -239,9 +243,9 @@ static int detect_path_cdc_wdm_or_qcqmi(char *path, char *devname, size_t bufsiz
major = conf_get_val(path, "MAJOR"); major = conf_get_val(path, "MAJOR");
minor = conf_get_val(path, "MINOR"); minor = conf_get_val(path, "MINOR");
if (major == CM_INVALID_VAL || minor == CM_INVALID_VAL) if(major == CM_INVALID_VAL || minor == CM_INVALID_VAL)
dbg_time("get major and minor failed"); dbg_time("get major and minor failed");
else if (mknod(devname, S_IFCHR | 0666, (((major & 0xfff) << 8) | (minor & 0xff) | ((minor & 0xfff00) << 12)))) else if (mknod(devname, S_IFCHR|0666, (((major & 0xfff) << 8) | (minor & 0xff) | ((minor & 0xfff00) << 12))))
dbg_time("please mknod %s c %d %d", devname, major, minor); dbg_time("please mknod %s c %d %d", devname, major, minor);
} }
@ -254,11 +258,11 @@ static int detect_path_cdc_wdm_or_qcqmi(char *path, char *devname, size_t bufsiz
* TRUE -> ok * TRUE -> ok
*/ */
BOOL qmidevice_detect(char *qmichannel, char *usbnet_adapter, unsigned bufsize, PROFILE_T *profile) { BOOL qmidevice_detect(char *qmichannel, char *usbnet_adapter, unsigned bufsize, PROFILE_T *profile) {
struct dirent *ent = NULL; struct dirent* ent = NULL;
DIR *pDir; DIR *pDir;
const char *rootdir = "/sys/bus/usb/devices"; const char *rootdir = "/sys/bus/usb/devices";
struct { struct {
char path[255 * 2]; char path[255*2];
} *pl; } *pl;
pl = (typeof(pl)) malloc(sizeof(*pl)); pl = (typeof(pl)) malloc(sizeof(*pl));
memset(pl, 0x00, sizeof(*pl)); memset(pl, 0x00, sizeof(*pl));
@ -269,9 +273,9 @@ BOOL qmidevice_detect(char *qmichannel, char *usbnet_adapter, unsigned bufsize,
goto error; goto error;
} }
while ((ent = readdir(pDir)) != NULL) { while ((ent = readdir(pDir)) != NULL) {
char netcard[32 + 1] = {'\0'}; char netcard[32+1] = {'\0'};
char devname[32 + 5] = {'\0'}; //+strlen("/dev/") char devname[32+5] = {'\0'}; //+strlen("/dev/")
int netIntf; int netIntf;
int driver_type; int driver_type;
@ -285,15 +289,15 @@ BOOL qmidevice_detect(char *qmichannel, char *usbnet_adapter, unsigned bufsize,
if (profile->usb_dev.idVendor == 0x2c7c || profile->usb_dev.idVendor == 0x05c6) { if (profile->usb_dev.idVendor == 0x2c7c || profile->usb_dev.idVendor == 0x05c6) {
dbg_time("Find %s/%s idVendor=0x%x idProduct=0x%x, bus=0x%03x, dev=0x%03x", dbg_time("Find %s/%s idVendor=0x%x idProduct=0x%x, bus=0x%03x, dev=0x%03x",
rootdir, ent->d_name, profile->usb_dev.idVendor, profile->usb_dev.idProduct, rootdir, ent->d_name, profile->usb_dev.idVendor, profile->usb_dev.idProduct,
profile->usb_dev.busnum, profile->usb_dev.devnum); profile->usb_dev.busnum, profile->usb_dev.devnum);
} }
/* get network interface */ /* get network interface */
/* NOTICE: there is a case that, bNumberInterface=6, but the net interface is 8 */ /* NOTICE: there is a case that, bNumberInterface=6, but the net interface is 8 */
/* toolchain-mips_24kc_gcc-5.4.0_musl donot support GLOB_BRACE */ /* toolchain-mips_24kc_gcc-5.4.0_musl donot support GLOB_BRACE */
/* RG500U's MBIM is at inteface 0 */ /* RG500U's MBIM is at inteface 0 */
for (netIntf = 0; netIntf < (profile->usb_dev.bNumInterfaces + 8); netIntf++) { for (netIntf = 0; netIntf < (profile->usb_dev.bNumInterfaces + 8); netIntf++) {
snprintf(pl->path, sizeof(pl->path), "%s/%s:1.%d/net", rootdir, ent->d_name, netIntf); snprintf(pl->path, sizeof(pl->path), "%s/%s:1.%d/net", rootdir, ent->d_name, netIntf);
dir_get_child(pl->path, netcard, sizeof(netcard), NULL); dir_get_child(pl->path, netcard, sizeof(netcard), NULL);
if (netcard[0]) if (netcard[0])
@ -301,7 +305,7 @@ BOOL qmidevice_detect(char *qmichannel, char *usbnet_adapter, unsigned bufsize,
} }
if (netcard[0] == '\0') { //for centos 2.6.x if (netcard[0] == '\0') { //for centos 2.6.x
const char *n = "usb0"; const char *n= "usb0";
const char *c = "qcqmi0"; const char *c = "qcqmi0";
snprintf(pl->path, sizeof(pl->path), "%s/%s:1.4/net:%s", rootdir, ent->d_name, n); snprintf(pl->path, sizeof(pl->path), "%s/%s:1.4/net:%s", rootdir, ent->d_name, n);
@ -330,27 +334,29 @@ BOOL qmidevice_detect(char *qmichannel, char *usbnet_adapter, unsigned bufsize,
if (driver_type == SOFTWARE_QMI || driver_type == SOFTWARE_MBIM) { if (driver_type == SOFTWARE_QMI || driver_type == SOFTWARE_MBIM) {
detect_path_cdc_wdm_or_qcqmi(pl->path, devname, sizeof(devname)); detect_path_cdc_wdm_or_qcqmi(pl->path, devname, sizeof(devname));
} else if (driver_type == SOFTWARE_ECM_RNDIS_NCM) { }
else if (driver_type == SOFTWARE_ECM_RNDIS_NCM)
{
int atIntf = -1; int atIntf = -1;
if (profile->usb_dev.idVendor == 0x2c7c) { //Quectel if (profile->usb_dev.idVendor == 0x2c7c) { //Quectel
switch (profile->usb_dev.idProduct) { //EC200U switch (profile->usb_dev.idProduct) { //EC200U
case 0x0901: //EC200U case 0x0901: //EC200U
case 0x8101: //RG801H case 0x8101: //RG801H
atIntf = 2; atIntf = 2;
break; break;
case 0x0900: //RG500U case 0x0900: //RG500U
atIntf = 4; atIntf = 4;
break; break;
case 0x6026: //EC200T case 0x6026: //EC200T
case 0x6005: //EC200A case 0x6005: //EC200A
case 0x6002: //EC200S case 0x6002: //EC200S
case 0x6001: //EC100Y case 0x6001: //EC100Y
atIntf = 3; atIntf = 3;
break; break;
default: default:
dbg_time("unknow at interface for USB idProduct:%04x\n", profile->usb_dev.idProduct); dbg_time("unknow at interface for USB idProduct:%04x\n", profile->usb_dev.idProduct);
break; break;
} }
} }
@ -383,71 +389,47 @@ BOOL qmidevice_detect(char *qmichannel, char *usbnet_adapter, unsigned bufsize,
} }
free(pl); free(pl);
return TRUE; return TRUE;
error: error:
free(pl); free(pl);
return FALSE; return FALSE;
} }
int isContain(const char *str1, const char *str2) {
if (strstr(str1, str2) != NULL) {
return 1;
} else {
return 0;
}
}
void replaceStr(char *str, char *orig, char *rep) {
char buffer[1024];
char *p;
while (p = strstr(str, orig)) {
memcpy(buffer, str, p - str);
buffer[p - str] = '\0';
sprintf(buffer + strlen(buffer), "%s%s", rep, p + strlen(orig));
strcpy(str, buffer);
}
}
int mhidevice_detect(char *qmichannel, char *usbnet_adapter, PROFILE_T *profile) { int mhidevice_detect(char *qmichannel, char *usbnet_adapter, PROFILE_T *profile) {
struct dirent *ent = NULL; struct dirent* ent = NULL;
DIR *pDir; DIR *pDir;
const char *rootdir_mhi[] = {"/sys/bus/mhi_q/devices", "/sys/bus/mhi/devices", NULL}; const char *rootdir_mhi[] = {"/sys/bus/mhi_q/devices", "/sys/bus/mhi/devices", NULL};
int i = 0; int i = 0;
char path[256]; char path[256];
int find = 0; int find = 0;
while (rootdir_mhi[i]) { while (rootdir_mhi[i]) {
const char *rootdir = rootdir_mhi[i++]; const char *rootdir = rootdir_mhi[i++];
dbg_time("rootdir : %s ", rootdir);
pDir = opendir(rootdir); pDir = opendir(rootdir);
if (!pDir) { if (!pDir) {
if (errno != ENOENT) { if (errno != ENOENT)
dbg_time("opendir %s failed: %s", rootdir, strerror(errno)); dbg_time("opendir %s failed: %s", rootdir, strerror(errno));
}
continue; continue;
} }
while ((ent = readdir(pDir)) != NULL) {
while ((ent = readdir(pDir)) != NULL) {
char netcard[32] = {'\0'}; char netcard[32] = {'\0'};
char devname[32] = {'\0'}; char devname[32] = {'\0'};
int software_interface = SOFTWARE_QMI; int software_interface = SOFTWARE_QMI;
char *pNode = NULL; char *pNode = NULL;
pNode = strstr(ent->d_name, "_IP_HW0"); //0306_00.01.00_IP_HW0
if (!pNode) {
continue;
}
char *d_name[32]; pNode = strstr(ent->d_name, "_IP_HW0"); //0306_00.01.00_IP_HW0
strcpy(d_name, ent->d_name); if (!pNode)
replaceStr(d_name, "_IP_HW0", ""); continue;
dbg_time("while -> pcie_name = : %s ", d_name);
snprintf(path, sizeof(path), "%s/%.32s/net", rootdir, ent->d_name); snprintf(path, sizeof(path), "%s/%.32s/net", rootdir, ent->d_name);
dir_get_child(path, netcard, sizeof(netcard), NULL); dir_get_child(path, netcard, sizeof(netcard), NULL);
if (!netcard[0]) { if (!netcard[0])
continue; continue;
}
if (usbnet_adapter[0] && strcmp(netcard, usbnet_adapter)) { //not '-i x if (usbnet_adapter[0] && strcmp(netcard, usbnet_adapter)) //not '-i x'
continue; continue;
}
if (!strcmp(rootdir, "/sys/bus/mhi/devices")) { if (!strcmp(rootdir, "/sys/bus/mhi/devices")) {
snprintf(path, sizeof(path), "%s/%.13s_IPCR", rootdir, ent->d_name); // 13 is sizeof(0306_00.01.00) snprintf(path, sizeof(path), "%s/%.13s_IPCR", rootdir, ent->d_name); // 13 is sizeof(0306_00.01.00)
if (!access(path, F_OK)) { if (!access(path, F_OK)) {
@ -462,59 +444,55 @@ int mhidevice_detect(char *qmichannel, char *usbnet_adapter, PROFILE_T *profile)
continue; continue;
} }
//修改为动态获取 // 解决硬编码导致不兼容hv问题
snprintf(path, sizeof(path), "%s/%s_IPCR", rootdir, d_name); snprintf(path, sizeof(path), "%s/%s_IPCR", rootdir, d_name);
if (access(path, F_OK)) { if (access(path, F_OK)) {
snprintf(path, sizeof(path), "%s/%s_QMI0", rootdir, d_name); snprintf(path, sizeof(path), "%s/%s_QMI0", rootdir, d_name);
if (access(path, F_OK)) { if (access(path, F_OK)) {
snprintf(path, sizeof(path), "%s/%s_MBIM", rootdir, d_name); snprintf(path, sizeof(path), "%s/%s_MBIM", rootdir, d_name);
if (!access(path, F_OK)) { if (!access(path, F_OK))
software_interface = SOFTWARE_MBIM; software_interface = SOFTWARE_MBIM;
}
} }
} }
// 原代码 // 原代码
// snprintf(path, sizeof(path), "%s/%.14s_IPCR", rootdir, ent->d_name); // snprintf(path, sizeof(path), "%s/%.13s_IPCR", rootdir, ent->d_name);
// dbg_time("while -> path3 : %s ", path); // if (access(path, F_OK)) {
// if (access(path, F_OK)) { // snprintf(path, sizeof(path), "%s/%.13s_QMI0", rootdir, ent->d_name);
// snprintf(path, sizeof(path), "%s/%.14s_QMI0", rootdir, ent->d_name); // if (access(path, F_OK)) {
// dbg_time("while -> path4 : %s ", path); // snprintf(path, sizeof(path), "%s/%.13s_MBIM", rootdir, ent->d_name);
// if (access(path, F_OK)) { // if (!access(path, F_OK))
// snprintf(path, sizeof(path), "%s/%.14s_MBIM", rootdir, ent->d_name); // software_interface = SOFTWARE_MBIM;
// dbg_time("while -> path5 : %s ", path); // }
// if (!access(path, F_OK)) { // }
// software_interface = SOFTWARE_MBIM;
// }
// }
// }
dbg_time("while -> path_final : %s ", path); if (access(path, F_OK))
if (access(path, F_OK)) {
continue; continue;
}
strncat(path, "/mhi_uci_q", sizeof(path) - 1); strncat(path, "/mhi_uci_q", sizeof(path)-1);
dir_get_child(path, devname, sizeof(devname), NULL); dir_get_child(path, devname, sizeof(devname), NULL);
if (!devname[0]) { if (!devname[0])
continue; continue;
}
dbg_time("while -> path_final_sub : %s ,dev_name: %s ", path, devname);
sprintf(usbnet_adapter, "%s", netcard); sprintf(usbnet_adapter, "%s", netcard);
sprintf(qmichannel, "/dev/%s", devname); sprintf(qmichannel, "/dev/%s", devname);
profile->software_interface = software_interface; profile->software_interface = software_interface;
find = 1; find = 1;
break; break;
} }
closedir(pDir); closedir(pDir);
} }
return find; return find;
} }
int atdevice_detect(char *atchannel, char *usbnet_adapter, PROFILE_T *profile) { int atdevice_detect(char *atchannel, char *usbnet_adapter, PROFILE_T *profile) {
if (!access("/sys/class/net/sipa_dummy0", F_OK)) { if (!access("/sys/class/net/sipa_dummy0", F_OK)) {
strcpy(usbnet_adapter, "sipa_dummy0"); strcpy(usbnet_adapter, "sipa_dummy0");
snprintf(profile->qmapnet_adapter, sizeof(profile->qmapnet_adapter), "%s%d", "pcie", profile->pdp - 1); snprintf(profile->qmapnet_adapter, sizeof(profile->qmapnet_adapter), "%s%d", "pcie", profile->pdp - 1);
} else { }
else {
dbg_time("atdevice_detect failed"); dbg_time("atdevice_detect failed");
goto error; goto error;
} }
@ -522,58 +500,65 @@ int atdevice_detect(char *atchannel, char *usbnet_adapter, PROFILE_T *profile) {
if (!access("/dev/stty_nr31", F_OK)) { if (!access("/dev/stty_nr31", F_OK)) {
strcpy(atchannel, "/dev/stty_nr31"); strcpy(atchannel, "/dev/stty_nr31");
profile->software_interface = SOFTWARE_ECM_RNDIS_NCM; profile->software_interface = SOFTWARE_ECM_RNDIS_NCM;
} else { }
else {
goto error; goto error;
} }
return 1; return 1;
error: error:
return 0; return 0;
} }
int get_driver_type(PROFILE_T *profile) { int get_driver_type(PROFILE_T *profile)
{
/* QMI_WWAN */ /* QMI_WWAN */
if (profile->usb_intf.bInterfaceClass == USB_CLASS_VENDOR_SPEC) { if (profile->usb_intf.bInterfaceClass == USB_CLASS_VENDOR_SPEC) {
return SOFTWARE_QMI; return SOFTWARE_QMI;
} else if (profile->usb_intf.bInterfaceClass == USB_CLASS_COMM) { }
else if (profile->usb_intf.bInterfaceClass == USB_CLASS_COMM) {
switch (profile->usb_intf.bInterfaceSubClass) { switch (profile->usb_intf.bInterfaceSubClass) {
case USB_CDC_SUBCLASS_MBIM: case USB_CDC_SUBCLASS_MBIM:
return SOFTWARE_MBIM; return SOFTWARE_MBIM;
break; break;
case USB_CDC_SUBCLASS_ETHERNET: case USB_CDC_SUBCLASS_ETHERNET:
case USB_CDC_SUBCLASS_NCM: case USB_CDC_SUBCLASS_NCM:
return SOFTWARE_ECM_RNDIS_NCM; return SOFTWARE_ECM_RNDIS_NCM;
break; break;
default: default:
break; break;
} }
} else if (profile->usb_intf.bInterfaceClass == USB_CLASS_WIRELESS_CONTROLLER) { }
else if (profile->usb_intf.bInterfaceClass == USB_CLASS_WIRELESS_CONTROLLER) {
if (profile->usb_intf.bInterfaceSubClass == 1 && profile->usb_intf.bInterfaceProtocol == 3) if (profile->usb_intf.bInterfaceSubClass == 1 && profile->usb_intf.bInterfaceProtocol == 3)
return SOFTWARE_ECM_RNDIS_NCM; return SOFTWARE_ECM_RNDIS_NCM;
} }
dbg_time("%s unknow bInterfaceClass=%d, bInterfaceSubClass=%d", __func__, dbg_time("%s unknow bInterfaceClass=%d, bInterfaceSubClass=%d", __func__,
profile->usb_intf.bInterfaceClass, profile->usb_intf.bInterfaceSubClass); profile->usb_intf.bInterfaceClass, profile->usb_intf.bInterfaceSubClass);
return DRV_INVALID; return DRV_INVALID;
} }
struct usbfs_getdriver { struct usbfs_getdriver
{
unsigned int interface; unsigned int interface;
char driver[255 + 1]; char driver[255 + 1];
}; };
struct usbfs_ioctl { struct usbfs_ioctl
{
int ifno; /* interface 0..N ; negative numbers reserved */ int ifno; /* interface 0..N ; negative numbers reserved */
int ioctl_code; /* MUST encode size + direction of data so the int ioctl_code; /* MUST encode size + direction of data so the
* macros in <asm/ioctl.h> give correct values */ * macros in <asm/ioctl.h> give correct values */
void *data; /* param buffer (in, or out) */ void *data; /* param buffer (in, or out) */
}; };
#define IOCTL_USBFS_DISCONNECT _IO('U', 22) #define IOCTL_USBFS_DISCONNECT _IO('U', 22)
#define IOCTL_USBFS_CONNECT _IO('U', 23) #define IOCTL_USBFS_CONNECT _IO('U', 23)
int usbfs_is_kernel_driver_alive(int fd, int ifnum) { int usbfs_is_kernel_driver_alive(int fd, int ifnum)
{
struct usbfs_getdriver getdrv; struct usbfs_getdriver getdrv;
getdrv.interface = ifnum; getdrv.interface = ifnum;
if (ioctl(fd, USBDEVFS_GETDRIVER, &getdrv) < 0) { if (ioctl(fd, USBDEVFS_GETDRIVER, &getdrv) < 0) {
@ -584,7 +569,8 @@ int usbfs_is_kernel_driver_alive(int fd, int ifnum) {
return 1; return 1;
} }
void usbfs_detach_kernel_driver(int fd, int ifnum) { void usbfs_detach_kernel_driver(int fd, int ifnum)
{
struct usbfs_ioctl operate; struct usbfs_ioctl operate;
operate.data = NULL; operate.data = NULL;
operate.ifno = ifnum; operate.ifno = ifnum;
@ -596,7 +582,8 @@ void usbfs_detach_kernel_driver(int fd, int ifnum) {
} }
} }
void usbfs_attach_kernel_driver(int fd, int ifnum) { void usbfs_attach_kernel_driver(int fd, int ifnum)
{
struct usbfs_ioctl operate; struct usbfs_ioctl operate;
operate.data = NULL; operate.data = NULL;
operate.ifno = ifnum; operate.ifno = ifnum;
@ -608,13 +595,15 @@ void usbfs_attach_kernel_driver(int fd, int ifnum) {
} }
} }
int reattach_driver(PROFILE_T *profile) { int reattach_driver(PROFILE_T *profile)
{
int ifnum = 4; int ifnum = 4;
int fd; int fd;
char devpath[128] = {'\0'}; char devpath[128] = {'\0'};
snprintf(devpath, sizeof(devpath), "/dev/bus/usb/%03d/%03d", profile->usb_dev.busnum, profile->usb_dev.devnum); snprintf(devpath, sizeof(devpath), "/dev/bus/usb/%03d/%03d", profile->usb_dev.busnum, profile->usb_dev.devnum);
fd = open(devpath, O_RDWR | O_NOCTTY); fd = open(devpath, O_RDWR | O_NOCTTY);
if (fd < 0) { if (fd < 0)
{
dbg_time("%s fail to open %s", __func__, devpath); dbg_time("%s fail to open %s", __func__, devpath);
return -1; return -1;
} }
@ -625,11 +614,11 @@ int reattach_driver(PROFILE_T *profile) {
} }
#define SIOCETHTOOL 0x8946 #define SIOCETHTOOL 0x8946
int ql_get_netcard_driver_info(const char *devname)
int ql_get_netcard_driver_info(const char *devname) { {
int fd = -1; int fd = -1;
struct ethtool_drvinfo drvinfo; struct ethtool_drvinfo drvinfo;
struct ifreq ifr; /* ifreq suitable for ethtool ioctl */ struct ifreq ifr; /* ifreq suitable for ethtool ioctl */
memset(&ifr, 0, sizeof(ifr)); memset(&ifr, 0, sizeof(ifr));
strcpy(ifr.ifr_name, devname); strcpy(ifr.ifr_name, devname);
@ -641,7 +630,7 @@ int ql_get_netcard_driver_info(const char *devname) {
} }
drvinfo.cmd = ETHTOOL_GDRVINFO; drvinfo.cmd = ETHTOOL_GDRVINFO;
ifr.ifr_data = (void *) &drvinfo; ifr.ifr_data = (void *)&drvinfo;
if (ioctl(fd, SIOCETHTOOL, &ifr) < 0) { if (ioctl(fd, SIOCETHTOOL, &ifr) < 0) {
dbg_time("ioctl() error: errno(%d)(%s)", errno, strerror(errno)); dbg_time("ioctl() error: errno(%d)(%s)", errno, strerror(errno));
@ -656,10 +645,11 @@ int ql_get_netcard_driver_info(const char *devname) {
return 0; return 0;
} }
int ql_get_netcard_carrier_state(const char *devname) { int ql_get_netcard_carrier_state(const char *devname)
{
int fd = -1; int fd = -1;
struct ethtool_value edata; struct ethtool_value edata;
struct ifreq ifr; /* ifreq suitable for ethtool ioctl */ struct ifreq ifr; /* ifreq suitable for ethtool ioctl */
memset(&ifr, 0, sizeof(ifr)); memset(&ifr, 0, sizeof(ifr));
strcpy(ifr.ifr_name, devname); strcpy(ifr.ifr_name, devname);
@ -672,7 +662,7 @@ int ql_get_netcard_carrier_state(const char *devname) {
edata.cmd = ETHTOOL_GLINK; edata.cmd = ETHTOOL_GLINK;
edata.data = 0; edata.data = 0;
ifr.ifr_data = (void *) &edata; ifr.ifr_data = (void *)&edata;
if (ioctl(fd, SIOCETHTOOL, &ifr) < 0) { if (ioctl(fd, SIOCETHTOOL, &ifr) < 0) {
dbg_time("ioctl('%s') error: errno(%d)(%s)", devname, errno, strerror(errno)); dbg_time("ioctl('%s') error: errno(%d)(%s)", devname, errno, strerror(errno));
@ -687,16 +677,17 @@ int ql_get_netcard_carrier_state(const char *devname) {
return edata.data; return edata.data;
} }
static void *catch_log(void *arg) { static void *catch_log(void *arg)
PROFILE_T *profile = (PROFILE_T *) arg; {
PROFILE_T *profile = (PROFILE_T *)arg;
int nreads = 0; int nreads = 0;
char tbuff[256 + 32]; char tbuff[256+32];
char filter[32]; char filter[32];
size_t tsize = strlen(get_time()) + 1; size_t tsize = strlen(get_time()) + 1;
snprintf(filter, sizeof(filter), ":%d:%03d:", profile->usb_dev.busnum, profile->usb_dev.devnum); snprintf(filter, sizeof(filter), ":%d:%03d:", profile->usb_dev.busnum, profile->usb_dev.devnum);
while (1) { while(1) {
nreads = read(profile->usbmon_fd, tbuff + tsize, sizeof(tbuff) - tsize - 1); nreads = read(profile->usbmon_fd, tbuff + tsize, sizeof(tbuff) - tsize - 1);
if (nreads <= 0) { if (nreads <= 0) {
if (nreads == -1 && errno == EINTR) if (nreads == -1 && errno == EINTR)
@ -704,13 +695,13 @@ static void *catch_log(void *arg) {
break; break;
} }
tbuff[tsize + nreads] = '\0'; // printf("%s", buff); tbuff[tsize+nreads] = '\0'; // printf("%s", buff);
if (!strstr(tbuff + tsize, filter)) if (!strstr(tbuff+tsize, filter))
continue; continue;
snprintf(tbuff, sizeof(tbuff), "%s", get_time()); snprintf(tbuff, sizeof(tbuff), "%s", get_time());
tbuff[tsize - 1] = ' '; tbuff[tsize-1] = ' ';
fwrite(tbuff, strlen(tbuff), 1, profile->usbmon_logfile_fp); fwrite(tbuff, strlen(tbuff), 1, profile->usbmon_logfile_fp);
} }
@ -718,7 +709,8 @@ static void *catch_log(void *arg) {
return NULL; return NULL;
} }
int ql_capture_usbmon_log(PROFILE_T *profile, const char *log_path) { int ql_capture_usbmon_log(PROFILE_T *profile, const char *log_path)
{
char usbmon_path[256]; char usbmon_path[256];
pthread_t pt; pthread_t pt;
pthread_attr_t attr; pthread_attr_t attr;
@ -745,16 +737,16 @@ int ql_capture_usbmon_log(PROFILE_T *profile, const char *log_path) {
profile->usbmon_logfile_fp = fopen(log_path, "wb"); profile->usbmon_logfile_fp = fopen(log_path, "wb");
if (!profile->usbmon_logfile_fp) { if (!profile->usbmon_logfile_fp) {
dbg_time("open %s error(%d) (%s)", log_path, errno, strerror(errno)); dbg_time("open %s error(%d) (%s)", log_path, errno, strerror(errno));
close(profile->usbmon_fd); close(profile->usbmon_fd);
profile->usbmon_fd = -1; profile->usbmon_fd = -1;
return -1; return -1;
} }
pthread_attr_init(&attr); pthread_attr_init(&attr);
pthread_attr_setdetachstate(&attr, PTHREAD_CREATE_DETACHED); pthread_attr_setdetachstate(&attr, PTHREAD_CREATE_DETACHED);
pthread_create(&pt, &attr, catch_log, (void *) profile); pthread_create(&pt, &attr, catch_log, (void *)profile);
return 0; return 0;
} }