android13/frameworks/base/libs/usb/tests/accessorytest/hid.c

/*
 * Copyright (C) 2012 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.
 */

#include <unistd.h>
#include <stdio.h>
#include <string.h>
#include <stdlib.h>

#include <sys/types.h>
#include <sys/stat.h>
#include <sys/ioctl.h>
#include <fcntl.h>
#include <errno.h>
#include <pthread.h>
#include <time.h>

#include <sys/inotify.h>
#include <linux/hidraw.h>
#include <usbhost/usbhost.h>

#include "f_accessory.h"
#include "accessory.h"

static pthread_mutex_t mutex = PTHREAD_MUTEX_INITIALIZER;

static int next_id = 1;

static void milli_sleep(int millis) {
    struct timespec tm;

    tm.tv_sec = 0;
    tm.tv_nsec = millis * 1000000;
    nanosleep(&tm, NULL);
}

static void* hid_thread(void* arg) {
    int fd = (int)arg;
    char buffer[4096];
    int id, ret, offset;
    struct usb_device *device;
    struct usb_device_descriptor *device_desc;
    int max_packet;
    struct hidraw_report_descriptor desc;
    int desc_length;

    fprintf(stderr, "hid_thread start fd: %d\n", fd);

    if (ioctl(fd, HIDIOCGRDESCSIZE, &desc_length)) {
        fprintf(stderr, "HIDIOCGRDESCSIZE failed\n");
        close(fd);
        goto err;
    }

    desc.size = HID_MAX_DESCRIPTOR_SIZE - 1;
    if (ioctl(fd, HIDIOCGRDESC, &desc)) {
        fprintf(stderr, "HIDIOCGRDESC failed\n");
        close(fd);
        goto err;
    }

wait_for_device:
    fprintf(stderr, "waiting for device fd: %d\n", fd);
    device = usb_wait_for_device();
    max_packet = usb_device_get_device_descriptor(device)->bMaxPacketSize0;
    // FIXME
    max_packet--;

    // FIXME
    milli_sleep(500);

    pthread_mutex_lock(&mutex);
    id = next_id++;

    ret = usb_device_control_transfer(device, USB_DIR_OUT | USB_TYPE_VENDOR,
            ACCESSORY_REGISTER_HID, id, desc_length, NULL, 0, 1000);
    fprintf(stderr, "ACCESSORY_REGISTER_HID returned %d\n", ret);

    // FIXME
    milli_sleep(500);

    for (offset = 0; offset < desc_length; ) {
        int count = desc_length - offset;
        if (count > max_packet) count = max_packet;

    fprintf(stderr, "sending ACCESSORY_SET_HID_REPORT_DESC offset: %d count: %d desc_length: %d\n",
            offset, count, desc_length);
        ret = usb_device_control_transfer(device, USB_DIR_OUT | USB_TYPE_VENDOR,
                ACCESSORY_SET_HID_REPORT_DESC, id, offset, &desc.value[offset], count, 1000);
    fprintf(stderr, "ACCESSORY_SET_HID_REPORT_DESC returned %d errno %d\n", ret, errno);
        offset += count;
    }

    pthread_mutex_unlock(&mutex);

    while (1) {
        ret = read(fd, buffer, sizeof(buffer));
        if (ret < 0) {
fprintf(stderr, "read failed, errno: %d, fd: %d\n", errno, fd);
            break;
        }

        ret = usb_device_control_transfer(device, USB_DIR_OUT | USB_TYPE_VENDOR,
                    ACCESSORY_SEND_HID_EVENT, id, 0, buffer, ret, 1000);
        if (ret < 0 && errno != EPIPE) {
fprintf(stderr, "ACCESSORY_SEND_HID_EVENT returned %d errno: %d\n", ret, errno);
            goto wait_for_device;
        }
    }

fprintf(stderr, "ACCESSORY_UNREGISTER_HID\n");
    ret = usb_device_control_transfer(device, USB_DIR_OUT | USB_TYPE_VENDOR,
            ACCESSORY_UNREGISTER_HID, id, 0, NULL, 0, 1000);

fprintf(stderr, "hid thread exiting\n");
err:
    return NULL;
}

static void open_hid(const char* name)
{
    char path[100];

    snprintf(path, sizeof(path), "/dev/%s", name);
    int fd = open(path, O_RDWR);
    if (fd < 0) return;

    fprintf(stderr, "opened /dev/%s\n", name);
    pthread_t th;
    pthread_create(&th, NULL, hid_thread, (void *)(uintptr_t)fd);
}

static void* inotify_thread(void* arg)
{
    open_hid("hidraw0");
    open_hid("hidraw1");
    open_hid("hidraw2");
    open_hid("hidraw3");
    open_hid("hidraw4");
    open_hid("hidraw5");
    open_hid("hidraw6");
    open_hid("hidraw7");
    open_hid("hidraw8");
    open_hid("hidraw9");

    int inotify_fd = inotify_init();
    inotify_add_watch(inotify_fd, "/dev", IN_DELETE | IN_CREATE);

    while (1) {
        char event_buf[512];
        struct inotify_event *event;
        int event_pos = 0;
        int event_size;

        int count = read(inotify_fd, event_buf, sizeof(event_buf));
        if (count < (int)sizeof(*event)) {
            if(errno == EINTR)
                continue;
            fprintf(stderr, "could not get event, %s\n", strerror(errno));
            break;
        }
        while (count >= (int)sizeof(*event)) {
            event = (struct inotify_event *)(event_buf + event_pos);
            //fprintf(stderr, "%d: %08x \"%s\"\n", event->wd, event->mask,
            //        event->len ? event->name : "");
            if (event->len) {
                if(event->mask & IN_CREATE) {
                    fprintf(stderr, "created %s\n", event->name);
                    // FIXME
                    milli_sleep(50);
                    open_hid(event->name);
                } else {
                    fprintf(stderr, "lost %s\n", event->name);
                }
            }
            event_size = sizeof(*event) + event->len;
            count -= event_size;
            event_pos += event_size;
        }
    }

    close(inotify_fd);
    return NULL;
}

void init_hid()
{
    pthread_t th;
    pthread_create(&th, NULL, inotify_thread, NULL);
}