android_device_samsung_c1-common/vibrator/tspdrv.c

/*
 * 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 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;
}