mirror of
https://github.com/openharmony/drivers_peripheral.git
synced 2026-08-24 18:15:56 -04:00
梁鹏辉
122 lines
4.2 KiB
C++
122 lines
4.2 KiB
C++
/*
|
|
* Copyright (c) 2022 Huawei Device Co., Ltd.
|
|
* 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.
|
|
*/
|
|
|
|
#include <hdf_base.h>
|
|
#include <hdf_device_desc.h>
|
|
#include "motion_uhdf_log.h"
|
|
#include <hdf_sbuf_ipc.h>
|
|
#include "v1_1/motion_interface_stub.h"
|
|
|
|
using namespace OHOS::HDI::Motion::V1_1;
|
|
|
|
struct HdfMotionInterfaceHost {
|
|
struct IDeviceIoService ioService;
|
|
OHOS::sptr<OHOS::IRemoteObject> stub;
|
|
};
|
|
|
|
static int32_t MotionInterfaceDriverDispatch(struct HdfDeviceIoClient *client, int cmdId, struct HdfSBuf *data,
|
|
struct HdfSBuf *reply)
|
|
{
|
|
auto *hdfMotionInterfaceHost = CONTAINER_OF(client->device->service, struct HdfMotionInterfaceHost, ioService);
|
|
|
|
OHOS::MessageParcel *dataParcel = nullptr;
|
|
OHOS::MessageParcel *replyParcel = nullptr;
|
|
OHOS::MessageOption option;
|
|
|
|
if (SbufToParcel(data, &dataParcel) != HDF_SUCCESS) {
|
|
HDF_LOGE("%{public}s:invalid data sbuf object to dispatch", __func__);
|
|
return HDF_ERR_INVALID_PARAM;
|
|
}
|
|
if (SbufToParcel(reply, &replyParcel) != HDF_SUCCESS) {
|
|
HDF_LOGE("%{public}s:invalid reply sbuf object to dispatch", __func__);
|
|
return HDF_ERR_INVALID_PARAM;
|
|
}
|
|
|
|
if (hdfMotionInterfaceHost == nullptr) {
|
|
HDF_LOGE("%{public}s:hdfMotionInterfaceHost is nullptr", __func__);
|
|
return HDF_ERR_INVALID_PARAM;
|
|
}
|
|
if (hdfMotionInterfaceHost->stub == nullptr) {
|
|
HDF_LOGE("%{public}s:hdfMotionInterfaceHost->stub is nullptr", __func__);
|
|
return HDF_ERR_INVALID_PARAM;
|
|
}
|
|
|
|
return hdfMotionInterfaceHost->stub->SendRequest(cmdId, *dataParcel, *replyParcel, option);
|
|
}
|
|
|
|
static int32_t HdfMotionInterfaceDriverInit(struct HdfDeviceObject *deviceObject)
|
|
{
|
|
(void)deviceObject;
|
|
HDF_LOGI("HdfMotionInterfaceDriverInit enter");
|
|
return HDF_SUCCESS;
|
|
}
|
|
|
|
static int32_t HdfMotionInterfaceDriverBind(struct HdfDeviceObject *deviceObject)
|
|
{
|
|
HDF_LOGI("HdfMotionInterfaceDriverBind enter");
|
|
|
|
auto *hdfMotionInterfaceHost = new (std::nothrow) HdfMotionInterfaceHost;
|
|
if (hdfMotionInterfaceHost == nullptr) {
|
|
HDF_LOGE("%{public}s: failed to create create HdfMotionInterfaceHost object", __func__);
|
|
return HDF_FAILURE;
|
|
}
|
|
|
|
hdfMotionInterfaceHost->ioService.Dispatch = MotionInterfaceDriverDispatch;
|
|
hdfMotionInterfaceHost->ioService.Open = NULL;
|
|
hdfMotionInterfaceHost->ioService.Release = NULL;
|
|
|
|
auto serviceImpl = OHOS::HDI::Motion::V1_1::IMotionInterface::Get(true);
|
|
if (serviceImpl == nullptr) {
|
|
HDF_LOGE("%{public}s: failed to get of implement service", __func__);
|
|
delete hdfMotionInterfaceHost;
|
|
return HDF_FAILURE;
|
|
}
|
|
|
|
hdfMotionInterfaceHost->stub = OHOS::HDI::ObjectCollector::GetInstance().GetOrNewObject(serviceImpl,
|
|
OHOS::HDI::Motion::V1_1::IMotionInterface::GetDescriptor());
|
|
if (hdfMotionInterfaceHost->stub == nullptr) {
|
|
HDF_LOGE("%{public}s: failed to get stub object", __func__);
|
|
delete hdfMotionInterfaceHost;
|
|
return HDF_FAILURE;
|
|
}
|
|
|
|
deviceObject->service = &hdfMotionInterfaceHost->ioService;
|
|
return HDF_SUCCESS;
|
|
}
|
|
|
|
static void HdfMotionInterfaceDriverRelease(struct HdfDeviceObject *deviceObject)
|
|
{
|
|
HDF_LOGI("HdfMotionInterfaceDriverRelease enter");
|
|
auto *hdfMotionInterfaceHost = CONTAINER_OF(deviceObject->service, struct HdfMotionInterfaceHost, ioService);
|
|
delete hdfMotionInterfaceHost;
|
|
hdfMotionInterfaceHost = nullptr;
|
|
}
|
|
|
|
static struct HdfDriverEntry g_motioninterfaceDriverEntry = {
|
|
.moduleVersion = 1,
|
|
.moduleName = "motion_service",
|
|
.Bind = HdfMotionInterfaceDriverBind,
|
|
.Init = HdfMotionInterfaceDriverInit,
|
|
.Release = HdfMotionInterfaceDriverRelease,
|
|
};
|
|
|
|
#ifdef __cplusplus
|
|
extern "C" {
|
|
#endif /* __cplusplus */
|
|
HDF_INIT(g_motioninterfaceDriverEntry);
|
|
#ifdef __cplusplus
|
|
}
|
|
#endif /* __cplusplus */
|