1 files changed, 116 insertions, 0 deletions
diff --git a/vibrator/tspdrv.c b/vibrator/tspdrv.c
new file mode 100755
index 0000000..0928240
--- /dev/null
+++ b/vibrator/tspdrv.c
@@ -0,0 +1,116 @@
+/*
+ * Copyright (C) 2011 CyanogenMod Project
+ * Copyright (C) 2011 Daniel Hillenbrand
+ *
+ * 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 <unistd.h>
+#include <fcntl.h>
+#include <errno.h>
+#include <sys/ioctl.h>
+
+#define LOG_NDEBUG 0
+#define LOG_TAG "tspdrv"
+#include <utils/Log.h>
+
+#include "tspdrv.h"
+
+int vibrator_exists()
+{
+    int fd;
+
+#ifdef QEMU_HARDWARE
+    if (qemu_check()) {
+        return 1;
+    }
+#endif
+
+    fd = open(THE_DEVICE, O_RDWR);
+    if(fd < 0)
+        return 0;
+    close(fd);
+    return 1;
+}
+
+int sendit(int timeout_ms)
+{
+    int nwr, ret, fd, tspd, tspret, actuators;
+    char value[20];
+
+    tspd = open(TSPDRV_DEVICE, O_RDWR);
+    if(tspd < 0) {
+        LOGE("failed on opening /dev/tspdrv\n");
+    } else {
+        LOGV("opened device /dev/tspdrv\n");
+    }
+
+    /* send tspdrv magic number */
+    tspret = ioctl(tspd, TSPDRV_MAGIC_NUMBER);
+    if(tspret != 0) {
+        LOGE("TSPDRV_MAGIC_NUMBER error\n");
+    } else {
+        LOGV("TSPDRV_MAGIC_NUMBER success\n");
+    }
+
+    /* get number of actuators */
+    actuators = ioctl(tspd, TSPDRV_GET_NUM_ACTUATORS);
+    if(actuators < 1) {
+        LOGE("TSPDRV_GET_NUM_ACTUATORS error, no actuators available\n");
+    } else {
+        LOGV("TSPDRV_GET_NUM_ACTUATORS success, actuators = %d\n", actuators);
+
+        if(timeout_ms > 0) {
+            /* enable tspdrv amp */
+            tspret = ioctl(tspd, TSPDRV_ENABLE_AMP, actuators);
+            if(tspret != 0) {
+                LOGE("TSPDRV_ENABLE_AMP error\n");
+            } else {
+                LOGV("TSPDRV_ENABLE_AMP success\n");
+            }
+        }
+    }
+
+    fd = open(THE_DEVICE, O_RDWR);
+    if(fd < 0)
+        return errno;
+
+    LOGV("timeout_ms: %d\n", timeout_ms);
+    nwr = sprintf(value, "%d\n", timeout_ms);
+    ret = write(fd, value, nwr);
+
+    if(timeout_ms == 0) {
+        /* stop tspdrv kernel timer */
+        tspret = ioctl(tspd, TSPDRV_STOP_KERNEL_TIMER);
+        if(tspret != 0) {
+            LOGE("TSPDRV_STOP_KERNEL_TIMER error\n");
+        } else {
+            LOGV("TSPDRV_STOP_KERNEL_TIMER success\n");
+        }
+
+        /* disable tspdrv amp */
+        if(actuators >= 1) {
+            tspret = ioctl(tspd, TSPDRV_DISABLE_AMP, actuators);
+            if(tspret != 0) {
+                LOGE("TSPDRV_DISABLE_AMP error\n");
+            } else {
+                LOGV("TSPDRV_DISABLE_AMP success\n");
+            }
+        }
+    }
+
+    close(tspd);
+    close(fd);
+
+    return (ret == nwr) ? 0 : -1;
+}