354 lines
14 KiB
C++
354 lines
14 KiB
C++
|
/*
|
||
|
|
* Copyright (C) 2018 The Android Open Source Project
|
||
|
|
*
|
||
|
|
* Licensed under the Apache License, Version 2.0 (the "License");
|
||
|
|
* you may not use this file except in compliance with the License.
|
||
|
|
* You may obtain a copy of the License at
|
||
|
|
*
|
||
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
||
|
|
*
|
||
|
|
* Unless required by applicable law or agreed to in writing, software
|
||
|
|
* distributed under the License is distributed on an "AS IS" BASIS,
|
||
|
|
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
||
|
|
* See the License for the specific language governing permissions and
|
||
|
|
* limitations under the License.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#define LOG_TAG "android.hardware.usb.gadget@1.1-service.coral"
|
||
|
|
|
||
|
|
#include "UsbGadget.h"
|
||
|
|
#include <dirent.h>
|
||
|
|
#include <fcntl.h>
|
||
|
|
#include <stdio.h>
|
||
|
|
#include <sys/inotify.h>
|
||
|
|
#include <sys/mount.h>
|
||
|
|
#include <sys/stat.h>
|
||
|
|
#include <sys/types.h>
|
||
|
|
#include <unistd.h>
|
||
|
|
|
||
|
|
namespace android {
|
||
|
|
namespace hardware {
|
||
|
|
namespace usb {
|
||
|
|
namespace gadget {
|
||
|
|
namespace V1_1 {
|
||
|
|
namespace implementation {
|
||
|
|
|
||
|
|
UsbGadget::UsbGadget() {
|
||
|
|
if (access(OS_DESC_PATH, R_OK) != 0) {
|
||
|
|
ALOGE("configfs setup not done yet");
|
||
|
|
abort();
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void currentFunctionsAppliedCallback(bool functionsApplied, void *payload) {
|
||
|
|
UsbGadget *gadget = (UsbGadget *)payload;
|
||
|
|
gadget->mCurrentUsbFunctionsApplied = functionsApplied;
|
||
|
|
}
|
||
|
|
|
||
|
|
Return<void> UsbGadget::getCurrentUsbFunctions(const sp<V1_0::IUsbGadgetCallback> &callback) {
|
||
|
|
Return<void> ret = callback->getCurrentUsbFunctionsCb(
|
||
|
|
mCurrentUsbFunctions,
|
||
|
|
mCurrentUsbFunctionsApplied ? Status::FUNCTIONS_APPLIED : Status::FUNCTIONS_NOT_APPLIED);
|
||
|
|
if (!ret.isOk())
|
||
|
|
ALOGE("Call to getCurrentUsbFunctionsCb failed %s", ret.description().c_str());
|
||
|
|
|
||
|
|
return Void();
|
||
|
|
}
|
||
|
|
|
||
|
|
V1_0::Status UsbGadget::tearDownGadget() {
|
||
|
|
if (resetGadget() != Status::SUCCESS)
|
||
|
|
return Status::ERROR;
|
||
|
|
|
||
|
|
if (monitorFfs.isMonitorRunning()) {
|
||
|
|
monitorFfs.reset();
|
||
|
|
} else {
|
||
|
|
ALOGI("mMonitor not running");
|
||
|
|
}
|
||
|
|
return Status::SUCCESS;
|
||
|
|
}
|
||
|
|
|
||
|
|
static V1_0::Status validateAndSetVidPid(uint64_t functions) {
|
||
|
|
V1_0::Status ret = Status::SUCCESS;
|
||
|
|
std::string vendorFunctions = getVendorFunctions();
|
||
|
|
|
||
|
|
switch (functions) {
|
||
|
|
case static_cast<uint64_t>(GadgetFunction::MTP):
|
||
|
|
if (vendorFunctions == "diag") {
|
||
|
|
ret = setVidPid("0x05C6", "0x901B");
|
||
|
|
} else {
|
||
|
|
if (!(vendorFunctions == "user" || vendorFunctions == "")) {
|
||
|
|
ALOGE("Invalid vendorFunctions set: %s", vendorFunctions.c_str());
|
||
|
|
ret = Status::CONFIGURATION_NOT_SUPPORTED;
|
||
|
|
} else {
|
||
|
|
ret = setVidPid("0x18d1", "0x4ee1");
|
||
|
|
}
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
case GadgetFunction::ADB | GadgetFunction::MTP:
|
||
|
|
if (vendorFunctions == "diag") {
|
||
|
|
ret = setVidPid("0x05C6", "0x903A");
|
||
|
|
} else {
|
||
|
|
if (!(vendorFunctions == "user" || vendorFunctions == "")) {
|
||
|
|
ALOGE("Invalid vendorFunctions set: %s", vendorFunctions.c_str());
|
||
|
|
ret = Status::CONFIGURATION_NOT_SUPPORTED;
|
||
|
|
} else {
|
||
|
|
ret = setVidPid("0x18d1", "0x4ee2");
|
||
|
|
}
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
case static_cast<uint64_t>(GadgetFunction::RNDIS):
|
||
|
|
if (vendorFunctions == "diag") {
|
||
|
|
ret = setVidPid("0x05C6", "0x902C");
|
||
|
|
} else if (vendorFunctions == "serial_cdev,diag") {
|
||
|
|
ret = setVidPid("0x05C6", "0x90B5");
|
||
|
|
} else if (vendorFunctions == "diag,diag_mdm,qdss,qdss_mdm,serial_cdev,dpl_gsi") {
|
||
|
|
ret = setVidPid("0x05C6", "0x90E6");
|
||
|
|
} else {
|
||
|
|
if (!(vendorFunctions == "user" || vendorFunctions == "")) {
|
||
|
|
ALOGE("Invalid vendorFunctions set: %s", vendorFunctions.c_str());
|
||
|
|
ret = Status::CONFIGURATION_NOT_SUPPORTED;
|
||
|
|
} else {
|
||
|
|
ret = setVidPid("0x18d1", "0x4ee3");
|
||
|
|
}
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
case GadgetFunction::ADB | GadgetFunction::RNDIS:
|
||
|
|
if (vendorFunctions == "diag") {
|
||
|
|
ret = setVidPid("0x05C6", "0x902D");
|
||
|
|
} else if (vendorFunctions == "serial_cdev,diag") {
|
||
|
|
ret = setVidPid("0x05C6", "0x90B6");
|
||
|
|
} else if (vendorFunctions == "diag,diag_mdm,qdss,qdss_mdm,serial_cdev,dpl_gsi") {
|
||
|
|
ret = setVidPid("0x05C6", "0x90E7");
|
||
|
|
} else {
|
||
|
|
if (!(vendorFunctions == "user" || vendorFunctions == "")) {
|
||
|
|
ALOGE("Invalid vendorFunctions set: %s", vendorFunctions.c_str());
|
||
|
|
ret = Status::CONFIGURATION_NOT_SUPPORTED;
|
||
|
|
} else {
|
||
|
|
ret = setVidPid("0x18d1", "0x4ee4");
|
||
|
|
}
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
case static_cast<uint64_t>(GadgetFunction::PTP):
|
||
|
|
if (!(vendorFunctions == "user" || vendorFunctions == "")) {
|
||
|
|
ALOGE("Invalid vendorFunctions set: %s", vendorFunctions.c_str());
|
||
|
|
ret = Status::CONFIGURATION_NOT_SUPPORTED;
|
||
|
|
} else {
|
||
|
|
ret = setVidPid("0x18d1", "0x4ee5");
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
case GadgetFunction::ADB | GadgetFunction::PTP:
|
||
|
|
if (!(vendorFunctions == "user" || vendorFunctions == "")) {
|
||
|
|
ALOGE("Invalid vendorFunctions set: %s", vendorFunctions.c_str());
|
||
|
|
ret = Status::CONFIGURATION_NOT_SUPPORTED;
|
||
|
|
} else {
|
||
|
|
ret = setVidPid("0x18d1", "0x4ee6");
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
case static_cast<uint64_t>(GadgetFunction::ADB):
|
||
|
|
if (vendorFunctions == "diag") {
|
||
|
|
ret = setVidPid("0x05C6", "0x901D");
|
||
|
|
} else if (vendorFunctions == "diag,serial_cdev,rmnet_gsi") {
|
||
|
|
ret = setVidPid("0x05C6", "0x9091");
|
||
|
|
} else if (vendorFunctions == "diag,serial_cdev") {
|
||
|
|
ret = setVidPid("0x05C6", "0x901F");
|
||
|
|
} else if (vendorFunctions ==
|
||
|
|
"diag,diag_mdm,qdss,qdss_mdm,serial_cdev,dpl_gsi,rmnet_gsi") {
|
||
|
|
ret = setVidPid("0x05C6", "0x90E5");
|
||
|
|
} else {
|
||
|
|
if (!(vendorFunctions == "user" || vendorFunctions == "")) {
|
||
|
|
ALOGE("Invalid vendorFunctions set: %s", vendorFunctions.c_str());
|
||
|
|
ret = Status::CONFIGURATION_NOT_SUPPORTED;
|
||
|
|
} else {
|
||
|
|
ret = setVidPid("0x18d1", "0x4ee7");
|
||
|
|
}
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
case static_cast<uint64_t>(GadgetFunction::MIDI):
|
||
|
|
if (!(vendorFunctions == "user" || vendorFunctions == "")) {
|
||
|
|
ALOGE("Invalid vendorFunctions set: %s", vendorFunctions.c_str());
|
||
|
|
ret = Status::CONFIGURATION_NOT_SUPPORTED;
|
||
|
|
} else {
|
||
|
|
ret = setVidPid("0x18d1", "0x4ee8");
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
case GadgetFunction::ADB | GadgetFunction::MIDI:
|
||
|
|
if (!(vendorFunctions == "user" || vendorFunctions == "")) {
|
||
|
|
ALOGE("Invalid vendorFunctions set: %s", vendorFunctions.c_str());
|
||
|
|
ret = Status::CONFIGURATION_NOT_SUPPORTED;
|
||
|
|
} else {
|
||
|
|
ret = setVidPid("0x18d1", "0x4ee9");
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
case static_cast<uint64_t>(GadgetFunction::ACCESSORY):
|
||
|
|
if (!(vendorFunctions == "user" || vendorFunctions == ""))
|
||
|
|
ALOGE("Invalid vendorFunctions set: %s", vendorFunctions.c_str());
|
||
|
|
ret = setVidPid("0x18d1", "0x2d00");
|
||
|
|
break;
|
||
|
|
case GadgetFunction::ADB | GadgetFunction::ACCESSORY:
|
||
|
|
if (!(vendorFunctions == "user" || vendorFunctions == ""))
|
||
|
|
ALOGE("Invalid vendorFunctions set: %s", vendorFunctions.c_str());
|
||
|
|
ret = setVidPid("0x18d1", "0x2d01");
|
||
|
|
break;
|
||
|
|
case static_cast<uint64_t>(GadgetFunction::AUDIO_SOURCE):
|
||
|
|
if (!(vendorFunctions == "user" || vendorFunctions == ""))
|
||
|
|
ALOGE("Invalid vendorFunctions set: %s", vendorFunctions.c_str());
|
||
|
|
ret = setVidPid("0x18d1", "0x2d02");
|
||
|
|
break;
|
||
|
|
case GadgetFunction::ADB | GadgetFunction::AUDIO_SOURCE:
|
||
|
|
if (!(vendorFunctions == "user" || vendorFunctions == ""))
|
||
|
|
ALOGE("Invalid vendorFunctions set: %s", vendorFunctions.c_str());
|
||
|
|
ret = setVidPid("0x18d1", "0x2d03");
|
||
|
|
break;
|
||
|
|
case GadgetFunction::ACCESSORY | GadgetFunction::AUDIO_SOURCE:
|
||
|
|
if (!(vendorFunctions == "user" || vendorFunctions == ""))
|
||
|
|
ALOGE("Invalid vendorFunctions set: %s", vendorFunctions.c_str());
|
||
|
|
ret = setVidPid("0x18d1", "0x2d04");
|
||
|
|
break;
|
||
|
|
case GadgetFunction::ADB | GadgetFunction::ACCESSORY | GadgetFunction::AUDIO_SOURCE:
|
||
|
|
if (!(vendorFunctions == "user" || vendorFunctions == ""))
|
||
|
|
ALOGE("Invalid vendorFunctions set: %s", vendorFunctions.c_str());
|
||
|
|
ret = setVidPid("0x18d1", "0x2d05");
|
||
|
|
break;
|
||
|
|
default:
|
||
|
|
ALOGE("Combination not supported");
|
||
|
|
ret = Status::CONFIGURATION_NOT_SUPPORTED;
|
||
|
|
}
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
|
||
|
|
Return<Status> UsbGadget::reset() {
|
||
|
|
if (!WriteStringToFile("none", PULLUP_PATH)) {
|
||
|
|
ALOGI("Gadget cannot be pulled down");
|
||
|
|
return Status::ERROR;
|
||
|
|
}
|
||
|
|
|
||
|
|
return Status::SUCCESS;
|
||
|
|
}
|
||
|
|
|
||
|
|
V1_0::Status UsbGadget::setupFunctions(uint64_t functions,
|
||
|
|
const sp<V1_0::IUsbGadgetCallback> &callback,
|
||
|
|
uint64_t timeout) {
|
||
|
|
bool ffsEnabled = false;
|
||
|
|
int i = 0;
|
||
|
|
|
||
|
|
if (addGenericAndroidFunctions(&monitorFfs, functions, &ffsEnabled, &i) != Status::SUCCESS)
|
||
|
|
return Status::ERROR;
|
||
|
|
|
||
|
|
std::string vendorFunctions = getVendorFunctions();
|
||
|
|
|
||
|
|
if (vendorFunctions != "") {
|
||
|
|
ALOGI("enable usbradio debug functions");
|
||
|
|
char *function = strtok(const_cast<char *>(vendorFunctions.c_str()), ",");
|
||
|
|
while (function != NULL) {
|
||
|
|
if (string(function) == "diag" && linkFunction("diag.diag", i++))
|
||
|
|
return Status::ERROR;
|
||
|
|
if (string(function) == "diag_mdm" && linkFunction("diag.diag_mdm", i++))
|
||
|
|
return Status::ERROR;
|
||
|
|
if (string(function) == "qdss" && linkFunction("qdss.qdss", i++))
|
||
|
|
return Status::ERROR;
|
||
|
|
if (string(function) == "qdss_mdm" && linkFunction("qdss.qdss_mdm", i++))
|
||
|
|
return Status::ERROR;
|
||
|
|
if (string(function) == "serial_cdev" && linkFunction("cser.dun.0", i++))
|
||
|
|
return Status::ERROR;
|
||
|
|
if (string(function) == "dpl_gsi" && linkFunction("gsi.dpl", i++))
|
||
|
|
return Status::ERROR;
|
||
|
|
if (string(function) == "rmnet_gsi" && linkFunction("gsi.rmnet", i++))
|
||
|
|
return Status::ERROR;
|
||
|
|
function = strtok(NULL, ",");
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
if ((functions & GadgetFunction::ADB) != 0) {
|
||
|
|
ffsEnabled = true;
|
||
|
|
if (addAdb(&monitorFfs, &i) != Status::SUCCESS)
|
||
|
|
return Status::ERROR;
|
||
|
|
}
|
||
|
|
|
||
|
|
// Pull up the gadget right away when there are no ffs functions.
|
||
|
|
if (!ffsEnabled) {
|
||
|
|
if (!WriteStringToFile(kGadgetName, PULLUP_PATH))
|
||
|
|
return Status::ERROR;
|
||
|
|
mCurrentUsbFunctionsApplied = true;
|
||
|
|
if (callback)
|
||
|
|
callback->setCurrentUsbFunctionsCb(functions, Status::SUCCESS);
|
||
|
|
return Status::SUCCESS;
|
||
|
|
}
|
||
|
|
|
||
|
|
monitorFfs.registerFunctionsAppliedCallback(¤tFunctionsAppliedCallback, this);
|
||
|
|
// Monitors the ffs paths to pull up the gadget when descriptors are written.
|
||
|
|
// Also takes of the pulling up the gadget again if the userspace process
|
||
|
|
// dies and restarts.
|
||
|
|
monitorFfs.startMonitor();
|
||
|
|
|
||
|
|
if (kDebug)
|
||
|
|
ALOGI("Mainthread in Cv");
|
||
|
|
|
||
|
|
if (callback) {
|
||
|
|
bool pullup = monitorFfs.waitForPullUp(timeout);
|
||
|
|
Return<void> ret = callback->setCurrentUsbFunctionsCb(
|
||
|
|
functions, pullup ? Status::SUCCESS : Status::ERROR);
|
||
|
|
if (!ret.isOk())
|
||
|
|
ALOGE("setCurrentUsbFunctionsCb error %s", ret.description().c_str());
|
||
|
|
}
|
||
|
|
|
||
|
|
return Status::SUCCESS;
|
||
|
|
}
|
||
|
|
|
||
|
|
Return<void> UsbGadget::setCurrentUsbFunctions(uint64_t functions,
|
||
|
|
const sp<V1_0::IUsbGadgetCallback> &callback,
|
||
|
|
uint64_t timeout) {
|
||
|
|
std::unique_lock<std::mutex> lk(mLockSetCurrentFunction);
|
||
|
|
|
||
|
|
mCurrentUsbFunctions = functions;
|
||
|
|
mCurrentUsbFunctionsApplied = false;
|
||
|
|
|
||
|
|
// Unlink the gadget and stop the monitor if running.
|
||
|
|
V1_0::Status status = tearDownGadget();
|
||
|
|
if (status != Status::SUCCESS) {
|
||
|
|
goto error;
|
||
|
|
}
|
||
|
|
|
||
|
|
ALOGI("Returned from tearDown gadget");
|
||
|
|
|
||
|
|
// Leave the gadget pulled down to give time for the host to sense disconnect.
|
||
|
|
usleep(kDisconnectWaitUs);
|
||
|
|
|
||
|
|
if (functions == static_cast<uint64_t>(GadgetFunction::NONE)) {
|
||
|
|
if (callback == NULL)
|
||
|
|
return Void();
|
||
|
|
Return<void> ret = callback->setCurrentUsbFunctionsCb(functions, Status::SUCCESS);
|
||
|
|
if (!ret.isOk())
|
||
|
|
ALOGE("Error while calling setCurrentUsbFunctionsCb %s", ret.description().c_str());
|
||
|
|
return Void();
|
||
|
|
}
|
||
|
|
|
||
|
|
status = validateAndSetVidPid(functions);
|
||
|
|
|
||
|
|
if (status != Status::SUCCESS) {
|
||
|
|
goto error;
|
||
|
|
}
|
||
|
|
|
||
|
|
status = setupFunctions(functions, callback, timeout);
|
||
|
|
if (status != Status::SUCCESS) {
|
||
|
|
goto error;
|
||
|
|
}
|
||
|
|
|
||
|
|
ALOGI("Usb Gadget setcurrent functions called successfully");
|
||
|
|
return Void();
|
||
|
|
|
||
|
|
error:
|
||
|
|
ALOGI("Usb Gadget setcurrent functions failed");
|
||
|
|
if (callback == NULL)
|
||
|
|
return Void();
|
||
|
|
Return<void> ret = callback->setCurrentUsbFunctionsCb(functions, status);
|
||
|
|
if (!ret.isOk())
|
||
|
|
ALOGE("Error while calling setCurrentUsbFunctionsCb %s", ret.description().c_str());
|
||
|
|
return Void();
|
||
|
|
}
|
||
|
|
} // namespace implementation
|
||
|
|
} // namespace V1_1
|
||
|
|
} // namespace gadget
|
||
|
|
} // namespace usb
|
||
|
|
} // namespace hardware
|
||
|
|
} // namespace android
|