-
//my_joystick.c
-
-
#include <stdio.h>
-
#include <sys/types.h>
-
#include <sys/time.h>
-
#include <sys/stat.h>
-
#include <fcntl.h>
-
#include <unistd.h>
-
#include <errno.h>
-
#include <stdlib.h>
-
#include <string.h>
-
#include <linux/joystick.h>
-
//#include <linux/list.h> /*郁闷,不能直接使用linux自带的list链表,需要单独提取出来,见前面的code*/
-
#include "listop.h"
-
-
#if 1
-
#define LOG_DBG(fmt, ...) fprintf(stdout, fmt, ##__VA_ARGS__)
-
#else
-
#define LOG_DBG(fmt, ...)
-
#endif
-
-
#define LOG_ERR(fmt, ...) fprintf(stderr, fmt, ##__VA_ARGS__)
-
-
-
typedef struct _joy_stick_ctx {
-
struct list_head list;
-
int i4_js_fd;
-
unsigned int i4_op_block;
-
} JOYSTICK_CTX_T;
-
-
LIST_HEAD(_t_js_ctx_head);
-
/*==> struct list_head _t_js_ctx_head = {&_t_js_ctx_head, &_t_js_ctx_head};*/
-
-
int joystick_open(char* cp_js_dev_name, int i4_block)
-
{
-
int i4_open_flags = O_RDONLY;
-
JOYSTICK_CTX_T* pt_joystick_ctx = NULL;
-
-
if (!cp_js_dev_name) {
-
LOG_ERR("[%s] js device name is NULL\n", __func__);
-
return -1;
-
}
-
-
pt_joystick_ctx = (JOYSTICK_CTX_T*)calloc(sizeof(JOYSTICK_CTX_T), 1);
-
if (!pt_joystick_ctx) {
-
LOG_ERR("[%s] no memory!!\n", __func__);
-
return -1;
-
}
-
-
pt_joystick_ctx->i4_op_block = i4_block ? 1 : 0;
-
-
if (pt_joystick_ctx->i4_op_block == 0) {
-
i4_open_flags |= O_NONBLOCK;
-
}
-
-
pt_joystick_ctx->i4_js_fd = open(cp_js_dev_name, i4_open_flags);
-
if (pt_joystick_ctx->i4_js_fd < 0) {
-
LOG_ERR("[%s] open device %s error\n", __func__, cp_js_dev_name);
-
free(pt_joystick_ctx);
-
return -1;
-
}
-
-
list_add_tail(&pt_joystick_ctx->list, &_t_js_ctx_head);
-
-
return pt_joystick_ctx->i4_js_fd;
-
}
-
-
int joystick_close(int i4_fd)
-
{
-
struct list_head* pt_entry;
-
struct list_head* pt_next;
-
JOYSTICK_CTX_T* pt_node;
-
-
if (list_empty(&_t_js_ctx_head)) {
-
LOG_ERR("[%s] device not opened\n", __func__);
-
return -1;
-
}
-
-
list_for_each_safe(pt_entry, pt_next, &_t_js_ctx_head) {
-
pt_node = list_entry(pt_entry, JOYSTICK_CTX_T, list);
-
if (pt_node->i4_js_fd == i4_fd) {
-
list_del_init(&pt_node->list);
-
free(pt_node);
-
return close(i4_fd);
-
}
-
}
-
-
LOG_ERR("[%s] i4_fd=%d invalid\n", __func__, i4_fd);
-
return -1;
-
}
-
-
int joystick_read_one_event(int i4_fd, struct js_event* tp_jse)
-
{
-
int i4_rd_bytes;
-
-
/*do not check i4_fd again*/
-
-
i4_rd_bytes = read(i4_fd, tp_jse, sizeof(struct js_event));
-
-
if (i4_rd_bytes == -1) {
-
if (errno == EAGAIN) { /*when no block, it is not error*/
-
return 0;
-
}
-
else {
-
return -1;
-
}
-
}
-
-
return i4_rd_bytes;
-
}
-
-
int joystick_read_ready(int i4_fd)
-
{
-
int i4_block = 2;
-
struct list_head* pt_entry;
-
JOYSTICK_CTX_T* pt_node;
-
-
if (list_empty(&_t_js_ctx_head)) {
-
LOG_ERR("[%s] device not opened\n", __func__);
-
return -1;
-
}
-
-
list_for_each(pt_entry, &_t_js_ctx_head) {
-
pt_node = list_entry(pt_entry, JOYSTICK_CTX_T, list);
-
if (pt_node->i4_js_fd == i4_fd) {
-
i4_block = pt_node->i4_op_block;
-
break;
-
}
-
}
-
-
if (i4_block == 2) {
-
LOG_ERR("[%s] i4_fd=%d invalid\n", __func__, i4_fd);
-
return 0;
-
}
-
else if (i4_block == 1) {
-
fd_set readfd;
-
int i4_ret = 0;
-
struct timeval timeout = {0, 0};
-
FD_ZERO(&readfd);
-
FD_SET(i4_fd, &readfd);
-
-
i4_ret = select(i4_fd + 1, &readfd, NULL, NULL, &timeout);
-
-
if (i4_ret > 0 && FD_ISSET(i4_fd, &readfd)) {
-
return 1;
-
}
-
else {
-
return 0;
-
}
-
-
}
-
-
return 1; /*noblock read, aways ready*/
-
}
-
-
-
void debug_list(void)
-
{
-
if (! list_empty(&_t_js_ctx_head)) {
-
struct list_head* pt_entry;
-
JOYSTICK_CTX_T* pt_node;
-
-
list_for_each(pt_entry, &_t_js_ctx_head) {
-
pt_node = list_entry(pt_entry, JOYSTICK_CTX_T, list);
-
LOG_DBG("fd:%d--block:%d\n", pt_node->i4_js_fd, pt_node->i4_op_block);
-
}
-
}
-
else {
-
LOG_DBG("-----------> EMPTY NOW\n");
-
}
-
}
-
-
#if 1
-
typedef struct _axes_t {
-
int x;
-
int y;
-
} AXES_T;
-
-
int main(int argc, char* argv[])
-
{
-
int fd, rc;
-
int op_times = 0;
-
char number_of_axes = 0;
-
char number_of_btns = 0;
-
char js_name_str[128];
-
unsigned int buttons_state = 0;
-
AXES_T* tp_axes = NULL;
-
int i, print_init_stat = 0;
-
-
struct js_event jse;
-
-
fd = joystick_open("/dev/input/js0", 1);
-
if (fd < 0) {
-
LOG_ERR("open failed.\n");
-
exit(1);
-
}
-
-
rc = ioctl(fd, JSIOCGAXES, &number_of_axes);
-
if (rc != -1) {
-
LOG_DBG("number_of_axes:%d\n", number_of_axes);
-
if (number_of_axes > 0) {
-
tp_axes = (AXES_T*)calloc(sizeof(AXES_T), 1);
-
}
-
}
-
-
rc = ioctl(fd, JSIOCGBUTTONS, &number_of_btns);
-
if (rc != -1) {
-
LOG_DBG("number_of_btns:%d\n", number_of_btns);
-
}
-
-
if (ioctl(fd, JSIOCGNAME(sizeof(js_name_str)), js_name_str) < 0) {
-
LOG_DBG(js_name_str, "Unknown", sizeof(js_name_str));
-
}
-
-
LOG_DBG("joystick Name: %s\n", js_name_str);
-
-
for (;;) {
-
if (joystick_read_ready(fd)) {
-
rc = joystick_read_one_event(fd, &jse);
-
if (rc > 0) {
-
if ((jse.type & JS_EVENT_INIT) == JS_EVENT_INIT) {
-
if ((jse.type & ~JS_EVENT_INIT) == JS_EVENT_BUTTON) {
-
if (jse.value) {
-
buttons_state |= (1 << jse.number);
-
}
-
else {
-
buttons_state &= ~(1 << jse.number);
-
}
-
}
-
else if ((jse.type & ~JS_EVENT_INIT) == JS_EVENT_AXIS) {
-
if (tp_axes) {
-
if ((jse.number & 1) == 0) {
-
tp_axes[jse.number / 2].x = jse.value;
-
}
-
else {
-
tp_axes[jse.number / 2].y = jse.value;
-
}
-
}
-
-
}
-
}
-
else {
-
op_times++;
-
if (print_init_stat == 0) {
-
for (i = 0; i < number_of_btns; i++) {
-
LOG_DBG("joystick init state: button %d is %s.\n", i, ((buttons_state & (1 << i)) == (1 << i)) ? "DOWN" : "UP");
-
}
-
-
if (tp_axes)
-
for (i = 0; i < number_of_axes; i++) {
-
LOG_DBG("joystick init state: axes %d is x=%d y=%d.\n", i, tp_axes[i].x, tp_axes[i].y);
-
}
-
print_init_stat = 1;
-
}
-
-
if (jse.type == JS_EVENT_BUTTON) {
-
if (jse.value) {
-
buttons_state |= (1 << jse.number);
-
}
-
else {
-
buttons_state &= ~(1 << jse.number);
-
}
-
-
LOG_DBG("joystick state: button %d is %s.\n", jse.number, ((buttons_state & (1 << jse.number)) == (1 << jse.number)) ? "DOWN" : "UP");
-
}
-
else if (jse.type == JS_EVENT_AXIS) {
-
if (tp_axes) {
-
if ((jse.number & 1) == 0) {
-
tp_axes[jse.number / 2].x = jse.value;
-
}
-
else {
-
tp_axes[jse.number / 2].y = jse.value;
-
}
-
LOG_DBG("joystick state: axes %d is x=%d y=%d.\n", jse.number / 2, tp_axes[jse.number / 2].x, tp_axes[jse.number / 2].y);
-
}
-
else {
-
LOG_DBG("joystick state: axes %d is %s=%d.\n", jse.number / 2, ((jse.number & 1) == 0) ? "x" : "y", jse.value);
-
}
-
}
-
}
-
-
if (op_times >= 18) {
-
break;
-
}
-
}
-
}
-
-
usleep(1000);
-
}
-
-
joystick_close(fd);
-
-
if (tp_axes) {
-
free(tp_axes);
-
}
-
-
return 0;
-
}
-
#endif
mayer@mayer-:hid$ ./my_joystick
number_of_axes:2
number_of_btns:10
joystick Name: BETOP GAMEPAD
joystick init state: button 0 is UP.
joystick init state: button 1 is UP.
joystick init state: button 2 is UP.
joystick init state: button 3 is UP.
joystick init state: button 4 is UP.
joystick init state: button 5 is UP.
joystick init state: button 6 is UP.
joystick init state: button 7 is UP.
joystick init state: button 8 is UP.
joystick init state: button 9 is UP.
joystick init state: axes 0 is x=0 y=0.
joystick init state: axes 1 is x=0 y=135129.
joystick state: button 0 is DOWN.
joystick state: button 0 is UP.
joystick state: button 1 is DOWN.
joystick state: button 1 is UP.
joystick state: button 3 is DOWN.
joystick state: button 3 is UP.
joystick state: button 2 is DOWN.
joystick state: button 2 is UP.
joystick state: button 7 is DOWN.
joystick state: button 7 is UP.
joystick state: button 5 is DOWN.
joystick state: button 5 is UP.
joystick state: button 6 is DOWN.
joystick state: button 6 is UP.
joystick state: button 4 is DOWN.
joystick state: button 4 is UP.
joystick state: button 5 is DOWN.
joystick state: button 5 is UP.
不明白的地方可以参考linux kernel中的说明文件:Documentation/input/joystick-api.txt
阅读(15400) | 评论(2) | 转发(0) |