aboutsummaryrefslogtreecommitdiffstats
path: root/src/js_raw.c
diff options
context:
space:
mode:
authorzheng_wenlong <wenlong_zheng@nexty-ele.com>2017-07-31 17:30:17 +0900
committerzheng_wenlong <wenlong_zheng@nexty-ele.com>2017-08-10 10:19:16 +0900
commit183e61cb341a9bb394b1e933edb66284211ef7e6 (patch)
treeb2ebaab0cece1f5f57bceb82555986b7bf541595 /src/js_raw.c
parentf9bdd961edde55b918129064578b0405d28281d0 (diff)
Add agl-service-steering-wheel
Add new binding service for steering wheel. Right now it's for logitech g29 and build on reneses m3ulcb. Had test on Daring Dab 3.99.2, 3.99.3, 4.0.0. After this commit, we want to add some code for dashboard to use this binding. [Modify 20170803] Deleted trailing whitespace in README.md Fixed typo enogh to enough Modfied .noconcurrency 0 to 1 for atomic Checked event valid by afb_event_is_valid Droped event when not enough memory by afb_event_drop [Modify 20170804] Modify json path into afb_daemon_rootdir_open_locale Delete error.h for same ERRMSG define in af-steering-wheel-binding.h Delete install code in recipes because aglwgt do autoinstall Add verbs information [Modify 20170808] Add target 'package' in CMakeLists.txt to make package [Modify 20170810] Add new folder named 'package' for jenkins job Change-Id: I975b1ce3afbeea0145ea723586b4b46288c987ab Signed-off-by: zheng_wenlong <wenlong_zheng@nexty-ele.com>
Diffstat (limited to 'src/js_raw.c')
-rw-r--r--src/js_raw.c174
1 files changed, 174 insertions, 0 deletions
diff --git a/src/js_raw.c b/src/js_raw.c
new file mode 100644
index 0000000..5541162
--- /dev/null
+++ b/src/js_raw.c
@@ -0,0 +1,174 @@
+/*
+ * Copyright (c) 2017 TOYOTA MOTOR CORPORATION
+ *
+ * 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 _GNU_SOURCE
+#include <stdio.h>
+#include <unistd.h>
+#include <fcntl.h>
+#include <net/if.h>
+#include <string.h>
+#include <sys/ioctl.h>
+#include <alloca.h>
+
+#include <linux/input.h>
+#include <linux/joystick.h>
+
+#include "af-steering-wheel-binding.h"
+#include "js_raw.h"
+#include "js_signal_event.h"
+
+#define JSNAMELEN 128
+
+static int *axis;
+static char *button;
+
+int js_signal_read(int fd)
+{
+ ssize_t size;
+ struct js_event jsEvent;
+ int rc = 0;
+
+ size = read(fd, &jsEvent, sizeof(struct js_event));
+ if(size != 0)
+ {
+ switch (jsEvent.type & ~JS_EVENT_INIT)
+ {
+ case JS_EVENT_BUTTON:
+ button[jsEvent.number] = (char)jsEvent.value;
+ //NOTICEMSG("JS_EVENT_BUTTON %d\n", button[jsEvent.number]);
+ newButtonValue(jsEvent.number, jsEvent.value);
+ break;
+ case JS_EVENT_AXIS:
+ axis[jsEvent.number] = jsEvent.value;
+ //NOTICEMSG("JS_EVENT_AXIS %d\n", axis[jsEvent.number]);
+ newAxisValue(jsEvent.number, jsEvent.value);
+ break;
+ default:
+ break;
+ }
+
+ rc = 0;
+ }
+ else
+ {
+ rc = -1;
+ }
+
+ return rc;
+}
+
+int on_event(sd_event_source *s, int fd, uint32_t revents, void *userdata)
+{
+ if ((revents & EPOLLIN) != 0)
+ {
+ //NOTICEMSG("on_event!\n");
+ int rc = 0;
+
+ rc = js_signal_read(fd);
+ if(rc == -1)
+ {
+ ERRMSG("JS Frame Read failed");
+
+ return -1;
+ }
+ }
+ if ((revents & (EPOLLERR|EPOLLRDHUP|EPOLLHUP)) != 0)
+ {
+ /* T.B.D
+ * if error or hungup */
+ ERRMSG("Error or Hunup: rvent=%08x", revents);
+ }
+
+ return 0;
+}
+
+int js_open(const char *devname)
+{
+ unsigned char numAxes = 0;
+ unsigned char numButtons = 0;
+ int version = 0;
+ int fd;
+ char name[JSNAMELEN] = "Unknown";
+
+ struct js_corr cal[6];
+ int i, j;
+ unsigned int calData[36] =
+ {
+ 1, 0, 8191, 8192, 65542, 65534,
+ 1, 0, 127, 128, 4227201, 4194176,
+ 1, 0, 127, 128, 4227201, 4194176,
+ 1, 0, 127, 128, 4227201, 4194176,
+ 1, 0, 0, 0, 536854528, 536854528,
+ 1, 0, 0, 0, 536854528, 536854528
+ };
+
+ if ((fd = open(devname, O_RDONLY)) < 0)
+ {
+ return -1;
+ }
+
+ ioctl(fd, JSIOCGVERSION, &version);
+ ioctl(fd, JSIOCGAXES, &numAxes);
+ ioctl(fd, JSIOCGBUTTONS, &numButtons);
+ ioctl(fd, JSIOCGNAME(JSNAMELEN), name);
+
+ for (i = 0; i < 6; i++)
+ {
+ int k = 0;
+ cal[i].type = (__u16)calData[(i*6)+k];
+ k++;
+ cal[i].prec = (__s16)calData[(i*6)+k];
+ k++;
+
+ for(j = 0; j < 4; j++)
+ {
+ cal[i].coef[j] = (__s32)calData[(i*6)+k];
+ k++;
+ }
+ }
+
+ if (ioctl(fd, JSIOCSCORR, &cal) < 0)
+ {
+ return -1;
+ }
+
+ axis = (int *)calloc(numAxes, sizeof(int));
+ button = (char *)calloc(numButtons, sizeof(char));
+#if 0
+ gis = g_unix_input_stream_new(fd, TRUE);
+ if(gis == NULL)
+ {
+ ERRMSG("g_unix_input_stream_new() failed!");
+ }
+ else
+ {
+ NOTICEMSG("g_unix_input_stream_new() succeed!");
+ }
+ g_input_stream_read_async(gis, &jsEvent, sizeof(struct js_event), G_PRIORITY_DEFAULT, NULL, &readCallback, NULL);
+#endif
+
+ return fd;
+}
+
+void js_close(int js)
+{
+ if (js < 0)
+ {
+ return;
+ }
+
+ close(js);
+}