/****************************************************************************** QTI_RMNET_DATA.C ******************************************************************************/ /****************************************************************************** @file qti_rmnet_data.c @brief Tethering Interface module for RmNET DATA interaction. DESCRIPTION This file has functions which interact with RmNET DATA for RMNET tethering. --------------------------------------------------------------------------- Copyright (c) 2014 Qualcomm Technologies, Inc. All Rights Reserved. Qualcomm Technologies Proprietary and Confidential. --------------------------------------------------------------------------- ******************************************************************************/ /****************************************************************************** EDIT HISTORY FOR FILE when who what, where, why -------- --- ------------------------------------------------------- 01/22/14 sb Add support for Fusion ******************************************************************************/ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include "qti.h" #include "librmnetctl.h" static qti_rmnet_param * rmnet_state_config; /*=========================================================================== FUNCTION DEFINITIONS =========================================================================*/ /*=========================================================================== FUNCTION QTI_RMNET_CALL_IOCTL_ON_DEV() DESCRIPTION - calls the specified IOCTL on the specified interface DEPENDENCIES None. RETURN VALUE QTI_SUCCESS on success QTI_FAILURE on failure SIDE EFFECTS None =========================================================================*/ int qti_rmnet_call_ioctl_on_dev ( const char *dev, unsigned int req, struct ifreq *ifr ) { int fd; /* Open a temporary socket of datagram type to use for issuing the ioctl */ if ((fd = socket(AF_INET, SOCK_DGRAM, 0)) < 0) { LOG_MSG_ERROR("call_ioctl_on_dev: socket open failed", 0, 0, 0); return QTI_FAILURE; } /* Set device name in the ioctl req struct */ (void)strlcpy(ifr->ifr_name, dev, sizeof(ifr->ifr_name)); /* Issue ioctl on the device */ if (ioctl(fd, req, ifr) < 0) { LOG_MSG_ERROR("call_ioctl_on_dev: ioctl failed", 0, 0, 0); close(fd); return QTI_FAILURE; } /* Close temporary socket */ close(fd); return QTI_SUCCESS; } /*=========================================================================== FUNCTION QTI_RMNET_DATA_INIT_BRIDGE() DESCRIPTION - initializes the RmNet data driver DEPENDENCIES None. RETURN VALUE QTI_SUCCESS on success QTI_FAILURE on failure SIDE EFFECTS None =========================================================================*/ int qti_rmnet_data_init_bridge(char* modem_iface, char* peripheral_iface, boolean fusion_dpl_only) { char command[MAX_COMMAND_STR_LEN]; uint16_t status_code; struct rmnetctl_hndl_s *rmnet_cfg_lib_handle; int ret_val; struct ifreq ifr; int mhi_ep_id; int mtu_mru_size = DEFAULT_MTU_MRU_VALUE; static char args[QTI_PROPERTY_VALUE_MAX]; char def[PROPERTY_MTU_SIZE+1]; /*---------------------------------------------------------------------------*/ /*--------------------------------------------------------------------------- To handle QTI restart teardown bridge before setting it up ----------------------------------------------------------------------------*/ qti_rmnet_data_teardown_bridge(modem_iface, peripheral_iface, fusion_dpl_only); /*--------------------------------------------------------------------------- Get the RmNet data driver handle ----------------------------------------------------------------------------*/ if ((ret_val = rmnetctl_init(&rmnet_cfg_lib_handle, &status_code)) != RMNETCTL_SUCCESS) { LOG_MSG_ERROR("Failed to initialize RmNet data driver handle." "Return value = %d. Status code =%d",ret_val, status_code, 0); return QTI_FAILURE; } /*--------------------------------------------------------------------------- Associate MHI interface to RmNet data driver ----------------------------------------------------------------------------*/ if ((ret_val = rmnet_associate_network_device(rmnet_cfg_lib_handle, modem_iface, &status_code, RMNETCTL_DEVICE_ASSOCIATE))!= RMNETCTL_SUCCESS) { LOG_MSG_ERROR("Failed to associate MHI interface with RmNet data driver." "Return value = %d. Status code =%d",ret_val, status_code, 0); rmnetctl_cleanup(rmnet_cfg_lib_handle); return QTI_FAILURE; } /*--------------------------------------------------------------------------- Associate USB interface to RmNet data driver ----------------------------------------------------------------------------*/ if (( ret_val = rmnet_associate_network_device(rmnet_cfg_lib_handle, peripheral_iface, &status_code, RMNETCTL_DEVICE_ASSOCIATE))!= RMNETCTL_SUCCESS) { LOG_MSG_ERROR("Failed to associate USB interface with RmNet data driver." "Return value = %d. Status code =%d",ret_val, status_code, 0); rmnetctl_cleanup(rmnet_cfg_lib_handle); return QTI_FAILURE; } /*--------------------------------------------------------------------------- Set logical EP point config for MHI and USB interface ----------------------------------------------------------------------------*/ if (( ret_val = rmnet_set_logical_ep_config(rmnet_cfg_lib_handle, -1, RMNET_EPMODE_BRIDGE, modem_iface, peripheral_iface, &status_code))!= RMNETCTL_SUCCESS) { LOG_MSG_ERROR("Failed to set logical end point config for MHI and USB interface." "Return value = %d. Status code =%d",ret_val, status_code, 0); rmnetctl_cleanup(rmnet_cfg_lib_handle); return QTI_FAILURE; } /*--------------------------------------------------------------------------- Set logical EP point config for USB and MHI interface ----------------------------------------------------------------------------*/ if (( ret_val = rmnet_set_logical_ep_config(rmnet_cfg_lib_handle, -1, RMNET_EPMODE_BRIDGE, peripheral_iface, modem_iface, &status_code))!= RMNETCTL_SUCCESS) { LOG_MSG_ERROR("Failed to set logical end point config for USB and MHI interface." "Return value = %d. Status code =%d",ret_val, status_code, 0); rmnetctl_cleanup(rmnet_cfg_lib_handle); return QTI_FAILURE; } /*--------------------------------------------------------------------------- Release RmNet data driver handle ----------------------------------------------------------------------------*/ rmnetctl_cleanup(rmnet_cfg_lib_handle); /*--------------------------------------------------------------------------- Set IP mode on USB interface ----------------------------------------------------------------------------*/ if (qti_rmnet_call_ioctl_on_dev(peripheral_iface, RMNET_IOCTL_SET_LLP_IP, &ifr) != QTI_SUCCESS) { LOG_MSG_ERROR("Failed to set IP mode on USB interface", 0, 0, 0); qti_rmnet_data_teardown_bridge(modem_iface, peripheral_iface, fusion_dpl_only); return QTI_FAILURE; } /*--------------------------------------------------------------------------- Set IP mode on MHI interface ----------------------------------------------------------------------------*/ if (qti_rmnet_call_ioctl_on_dev(modem_iface, RMNET_IOCTL_SET_LLP_IP, &ifr) != QTI_SUCCESS) { LOG_MSG_ERROR("Failed to set IP mode on MHI interface", 0, 0, 0); qti_rmnet_data_teardown_bridge(modem_iface, peripheral_iface, fusion_dpl_only); return QTI_FAILURE; } /*--------------------------------------------------------------------------- bring down both USB and MHI interfaces ----------------------------------------------------------------------------*/ snprintf(command, MAX_COMMAND_STR_LEN, "ifconfig %s down", modem_iface); ds_system_call(command, strlen(command)); snprintf(command, MAX_COMMAND_STR_LEN, "ifconfig %s down", peripheral_iface); ds_system_call(command, strlen(command)); /*--------------------------------------------------------------------------- If its DPL usecase, then obtain the aggr info from Android property if set ----------------------------------------------------------------------------*/ if (strncmp(modem_iface, MHI_DPL_DATA_INTERFACE, strlen(MHI_DPL_DATA_INTERFACE)) == 0 && strncmp(peripheral_iface, USB_DPL_DATA_INTERFACE, strlen(USB_DPL_DATA_INTERFACE)) == 0) { LOG_MSG_INFO1("DPL interface", 0, 0, 0); #ifndef FEATURE_MDM_LE memset(args, 0, sizeof(args)); memset( def, 0x0, sizeof(def) ); snprintf( def, sizeof(def)-1, "%d", QTI_PROPERTY_DPL_AGGR_DEFAULT ); ret_val = property_get( QTI_PROPERTY_DPL_AGGR, args, def ); if (ret_val > (PROPERTY_MTU_SIZE)) { LOG_MSG_ERROR("Android property for DPL has unexpected size(%d)", ret_val, 0, 0); } else { mtu_mru_size = ds_atoi(args); LOG_MSG_INFO1("MTU MRU size got for DPL aggr from Android property is %d", mtu_mru_size, 0, 0); if( QTI_MTU_MAX < mtu_mru_size || mtu_mru_size == QTI_MTU_INVALID) { LOG_MSG_ERROR("Android property for DPL has incorrect value (%d). Setting it to default", mtu_mru_size, 0, 0); mtu_mru_size = DEFAULT_DPL_MTU_MRU_VALUE; } else { /* Update MTU value using property */ LOG_MSG_INFO1( "MRU MTU overide specified for DPL, using value %d", mtu_mru_size,0,0 ); } } #endif } /*--------------------------------------------------------------------------- Else the following needs to be done only in RmNet case: Set MTU on modem iface Set MRU on peripheral iface (not needed in DPL case because of no UL traffic) ----------------------------------------------------------------------------*/ else { LOG_MSG_INFO1("RmNet interface", 0, 0, 0); ret_val = qti_rmnet_modem_set_mtu(mtu_mru_size, modem_iface); if (ret_val != QTI_SUCCESS) { LOG_MSG_ERROR("Failed to set default MTU value on modem", 0, 0, 0); qti_rmnet_data_teardown_bridge(modem_iface, peripheral_iface, fusion_dpl_only); return QTI_FAILURE; } ret_val = qti_rmnet_ph_set_mru(mtu_mru_size, peripheral_iface); if (ret_val != QTI_SUCCESS) { LOG_MSG_ERROR("Failed to set default MTU value on peripheral", 0, 0, 0); qti_rmnet_data_teardown_bridge(modem_iface, peripheral_iface, fusion_dpl_only); return QTI_FAILURE; } } /*--------------------------------------------------------------------------- The following needs to be done in both RmNet and DPL usecases: Set MRU on modem iface Set MTU on peripheral iface ----------------------------------------------------------------------------*/ ret_val = qti_rmnet_modem_set_mru(mtu_mru_size, modem_iface); if (ret_val != QTI_SUCCESS) { LOG_MSG_ERROR("Failed to set default MRU value on modem", 0, 0, 0); qti_rmnet_data_teardown_bridge(modem_iface, peripheral_iface, fusion_dpl_only); return QTI_FAILURE; } ret_val = qti_rmnet_ph_set_mtu(mtu_mru_size, peripheral_iface); if (ret_val != QTI_SUCCESS) { LOG_MSG_ERROR("Failed to set default MTU value on peripheral", 0, 0, 0); qti_rmnet_data_teardown_bridge(modem_iface, peripheral_iface, fusion_dpl_only); return QTI_FAILURE; } /*--------------------------------------------------------------------------- Bring up MHI and USB interfaces ----------------------------------------------------------------------------*/ snprintf(command, MAX_COMMAND_STR_LEN, "ifconfig %s up", modem_iface); ds_system_call(command, strlen(command)); snprintf(command, MAX_COMMAND_STR_LEN, "ifconfig %s up", peripheral_iface); ds_system_call(command, strlen(command)); ret_val = qti_is_iface_up(modem_iface); if(ret_val) { LOG_MSG_INFO1("Modem iface is up", 0, 0, 0); } else { LOG_MSG_ERROR("Modem interface is not up", 0, 0, 0); qti_rmnet_data_teardown_bridge(modem_iface, peripheral_iface, fusion_dpl_only); return QTI_FAILURE; } ret_val = qti_is_iface_up(peripheral_iface); if(ret_val) { LOG_MSG_INFO1("Peripheral iface is up", 0, 0, 0); } else { LOG_MSG_ERROR("Peripheral_iface interface is not up", 0, 0, 0); qti_rmnet_data_teardown_bridge(modem_iface, peripheral_iface, fusion_dpl_only); return QTI_FAILURE; } if (strncmp(modem_iface, MHI_DPL_DATA_INTERFACE, strlen(MHI_DPL_DATA_INTERFACE)) == 0 && strncmp(peripheral_iface, USB_DPL_DATA_INTERFACE, strlen(USB_DPL_DATA_INTERFACE)) == 0) { ret_val = qti_rmnet_modem_get_ep_id((uint32_t*)&mhi_ep_id, MHI_DPL_DATA_INTERFACE); if (ret_val != QTI_SUCCESS) { LOG_MSG_ERROR("Failed to get MHI EP ID", 0, 0, 0); qti_rmnet_data_teardown_bridge(modem_iface, peripheral_iface, fusion_dpl_only); return QTI_FAILURE; } if (!fusion_dpl_only) { ret_val = qti_dpl_qmi_wda_set_data_format(mtu_mru_size, DATA_EP_TYPE_PCIE, mhi_ep_id); if (ret_val != QTI_SUCCESS) { LOG_MSG_ERROR("Failed to send DPL aggr info %d in set data format", mtu_mru_size, 0, 0); qti_rmnet_data_teardown_bridge(modem_iface, peripheral_iface, fusion_dpl_only); return QTI_FAILURE; } } } return QTI_SUCCESS; } /*=========================================================================== FUNCTION QTI_RMNET_DATA_TEARDOWN_BRIDGE() DESCRIPTION resets RmNet data driver DEPENDENCIES None. RETURN VALUE QTI_SUCCESS on success QTI_FAILURE on failure SIDE EFFECTS None =========================================================================*/ int qti_rmnet_data_teardown_bridge(char* modem_iface, char* peripheral_iface, boolean fusion_dpl_only) { char command[MAX_COMMAND_STR_LEN]; uint16_t status_code; struct rmnetctl_hndl_s *rmnet_cfg_lib_handle; int ret_val; int mtu_mru_size; int mhi_ep_id; /*---------------------------------------------------------------------------*/ /*--------------------------------------------------------------------------- Bring down MHI and USB interfaces ----------------------------------------------------------------------------*/ snprintf(command, MAX_COMMAND_STR_LEN, "ifconfig %s down", modem_iface); ds_system_call(command, strlen(command)); snprintf(command, MAX_COMMAND_STR_LEN, "ifconfig %s down", peripheral_iface); ds_system_call(command, strlen(command)); /*--------------------------------------------------------------------------- Get RmNet data driver handle ----------------------------------------------------------------------------*/ if ((ret_val = rmnetctl_init(&rmnet_cfg_lib_handle, &status_code)) != RMNETCTL_SUCCESS) { LOG_MSG_ERROR("Failed to initialize RmNet data driver handle." "Return value = %d. Status code =%d",ret_val, status_code, 0); return QTI_FAILURE; } /*--------------------------------------------------------------------------- Unset logical ep config for MHI and USB interfaces from RmNet data driver ----------------------------------------------------------------------------*/ if ((ret_val = rmnet_unset_logical_ep_config(rmnet_cfg_lib_handle, -1, modem_iface, &status_code))!= RMNETCTL_SUCCESS) { LOG_MSG_ERROR("Failed to unset logical ep config for MHI interface with RmNet data driver." "Return value = %d. Status code =%d",ret_val, status_code, 0); } if ((ret_val = rmnet_unset_logical_ep_config(rmnet_cfg_lib_handle, -1, peripheral_iface, &status_code))!= RMNETCTL_SUCCESS) { LOG_MSG_ERROR("Failed to unset logical ep config for USB interface with RmNet data driver." "Return value = %d. Status code =%d",ret_val, status_code, 0); } /*--------------------------------------------------------------------------- Unassociate MHI and USB interfaces from RmNet data driver ----------------------------------------------------------------------------*/ if ((ret_val = rmnet_associate_network_device(rmnet_cfg_lib_handle, modem_iface, &status_code, RMNETCTL_DEVICE_UNASSOCIATE))!= RMNETCTL_SUCCESS) { LOG_MSG_ERROR("Failed to unassociate MHI interface from RmNet data driver." "Return value = %d. Status code =%d",ret_val, status_code, 0); } if (( ret_val = rmnet_associate_network_device(rmnet_cfg_lib_handle, peripheral_iface, &status_code, RMNETCTL_DEVICE_UNASSOCIATE))!= RMNETCTL_SUCCESS) { LOG_MSG_ERROR("Failed to unassociate USB interface from RmNet data driver" "Return value = %d. Status code =%d",ret_val, status_code, 0); } /*--------------------------------------------------------------------------- Release RmNet data driver handle ----------------------------------------------------------------------------*/ rmnetctl_cleanup(rmnet_cfg_lib_handle); if (strncmp(modem_iface, MHI_DPL_DATA_INTERFACE, strlen(MHI_DPL_DATA_INTERFACE)) == 0 && strncmp(peripheral_iface, USB_DPL_DATA_INTERFACE, strlen(USB_DPL_DATA_INTERFACE)) == 0) { ret_val = qti_rmnet_modem_get_ep_id((uint32_t*)&mhi_ep_id, MHI_DPL_DATA_INTERFACE); if (ret_val != QTI_SUCCESS) { LOG_MSG_ERROR("Failed to get MHI EP ID", 0, 0, 0); return QTI_FAILURE; } if (!fusion_dpl_only) { mtu_mru_size = 0; ret_val = qti_dpl_qmi_wda_set_data_format(mtu_mru_size, DATA_EP_TYPE_PCIE, mhi_ep_id); if (ret_val != QTI_SUCCESS) { LOG_MSG_ERROR("Failed to send DPL aggr info %d in set data format", mtu_mru_size, 0, 0); } } } ret_val = qti_is_iface_up(modem_iface); if(!ret_val) { LOG_MSG_INFO1("Modem iface is down", 0, 0, 0); } else { LOG_MSG_ERROR("Modem interface is not down", 0, 0, 0); } ret_val = qti_is_iface_up(peripheral_iface); if(!ret_val) { LOG_MSG_INFO1("Peripheral iface is down", 0, 0, 0); } else { LOG_MSG_ERROR("Peripheral_iface interface is not down", 0, 0, 0); } return QTI_SUCCESS; }