vibrator hal: add support for drv2624 haptics driver on wahoo

This adds the vibrator HAL that implements the new setAmplitude and perform(Effect) API. Test done: vibrator_hidl_hal_test Bug: 36782452 Change-Id: If9988434277790becb469d4dd928e75f7e6af41a Signed-off-by: David Lin <dtwlin@google.com>
2026-02-01 07:50:47 +00:00 · 2017-03-27 19:13:31 -07:00
parent df8b9af4a5
commit 971ea5d074
9 changed files with 387 additions and 1 deletions
--- a/vibrator/service.cpp
+++ b/vibrator/service.cpp
@@ -0,0 +1,115 @@
+/*
+ * Copyright (C) 2017 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.vibrator@1.0-service.wahoo"
+
+#include <android/hardware/vibrator/1.0/IVibrator.h>
+#include <hidl/HidlSupport.h>
+#include <hidl/HidlTransportSupport.h>
+#include <utils/Errors.h>
+#include <utils/StrongPointer.h>
+
+#include "Vibrator.h"
+
+using android::hardware::configureRpcThreadpool;
+using android::hardware::joinRpcThreadpool;
+using android::hardware::vibrator::V1_0::IVibrator;
+using android::hardware::vibrator::V1_0::implementation::Vibrator;
+using namespace android;
+
+// Refer to Documentation/ABI/testing/sysfs-class-led-driver-drv2624
+// kernel documentation on the detail usages for ABIs below
+static const char *ACTIVATE_PATH = "/sys/class/leds/vibrator/activate";
+static const char *DURATION_PATH = "/sys/class/leds/vibrator/duration";
+static const char *STATE_PATH = "/sys/class/leds/vibrator/state";
+static const char *RTP_INPUT_PATH = "/sys/class/leds/vibrator/device/rtp_input";
+static const char *MODE_PATH = "/sys/class/leds/vibrator/device/mode";
+static const char *SEQUENCER_PATH = "/sys/class/leds/vibrator/device/set_sequencer";
+static const char *SCALE_PATH = "/sys/class/leds/vibrator/device/scale";
+
+status_t registerVibratorService() {
+    // ostreams below are required
+    std::ofstream activate{ACTIVATE_PATH};
+    if (!activate) {
+        int error = errno;
+        ALOGE("Failed to open %s (%d): %s", ACTIVATE_PATH, error, strerror(error));
+        return -error;
+    }
+
+    std::ofstream duration{DURATION_PATH};
+    if (!duration) {
+        int error = errno;
+        ALOGE("Failed to open %s (%d): %s", DURATION_PATH, error, strerror(error));
+        return -error;
+    }
+
+    std::ofstream state{STATE_PATH};
+    if (!state) {
+        int error = errno;
+        ALOGE("Failed to open %s (%d): %s", STATE_PATH, error, strerror(error));
+        return -error;
+    }
+
+    state << 1 << std::endl;
+    if (!state) {
+        int error = errno;
+        ALOGE("Failed to set state (%d): %s", errno, strerror(errno));
+        return -error;
+    }
+
+    // ostreams below are optional
+    std::ofstream rtpinput{RTP_INPUT_PATH};
+    if (!state) {
+        int error = errno;
+        ALOGW("Failed to open %s (%d): %s", RTP_INPUT_PATH, error, strerror(error));
+    }
+
+    std::ofstream mode{MODE_PATH};
+    if (!state) {
+        int error = errno;
+        ALOGW("Failed to open %s (%d): %s", MODE_PATH, error, strerror(error));
+    }
+
+    std::ofstream sequencer{SEQUENCER_PATH};
+    if (!state) {
+        int error = errno;
+        ALOGW("Failed to open %s (%d): %s", SEQUENCER_PATH, error, strerror(error));
+    }
+
+    std::ofstream scale{SCALE_PATH};
+    if (!state) {
+        int error = errno;
+        ALOGW("Failed to open %s (%d): %s", SCALE_PATH, error, strerror(error));
+    }
+
+    sp<IVibrator> vibrator = new Vibrator(std::move(activate), std::move(duration),
+            std::move(state), std::move(rtpinput), std::move(mode),
+            std::move(sequencer), std::move(scale));
+
+    vibrator->registerAsService();
+
+    return OK;
+}
+
+int main() {
+    configureRpcThreadpool(1, true);
+    status_t status = registerVibratorService();
+
+    if (status != OK) {
+        return status;
+    }
+
+    joinRpcThreadpool();
+}