init
This commit is contained in:
viandoxdev
commit
5d8141c2df
|
|
@ -0,0 +1,4 @@
|
|||
.ccls-cache
|
||||
build
|
||||
jsfw
|
||||
plan
|
||||
|
|
@ -0,0 +1,38 @@
|
|||
Q=@
|
||||
CC=gcc
|
||||
CFLAGS=-g -Wall
|
||||
LDFLAGS=
|
||||
BUILD_DIR=./build
|
||||
BIN=jsfw
|
||||
|
||||
RUNARGS=client /dev/input/js0 localhost 7776
|
||||
|
||||
SOURCES=main.c hid.c
|
||||
|
||||
OBJECTS:=$(patsubst %.c,$(BUILD_DIR)/%.o,$(SOURCES))
|
||||
|
||||
.PHONY: run
|
||||
run: $(BIN)
|
||||
@echo "RUN $(BIN) $(RUNARGS)"
|
||||
$(Q) chmod +x $(BIN)
|
||||
$(Q) ./$(BIN) $(RUNARGS)
|
||||
|
||||
$(BIN): $(OBJECTS)
|
||||
@echo "LD $@"
|
||||
$(Q) $(CC) $(LDFLAGS) $^ -o $@
|
||||
|
||||
$(BUILD_DIR)/%.o: %.c | $(BUILD_DIR)
|
||||
@echo "CC $<"
|
||||
$(Q) $(CC) $(CFLAGS) -c $< -o $@
|
||||
|
||||
.PRECIOUS: $(BUILD_DIR)
|
||||
$(BUILD_DIR):
|
||||
@echo "MKDIR"
|
||||
$(Q) mkdir -p $(BUILD_DIR)
|
||||
|
||||
.PHONY: clean
|
||||
clean:
|
||||
@echo "CLEAN"
|
||||
$(Q) rm -fr $(BUILD_DIR)
|
||||
$(Q) rm -fr $(BIN)
|
||||
|
||||
|
|
@ -0,0 +1,91 @@
|
|||
#include "hashmap.h"
|
||||
#include <stdlib.h>
|
||||
|
||||
int seed = 0;
|
||||
|
||||
void init_seed() {
|
||||
if(seed) return;
|
||||
seed = random();
|
||||
}
|
||||
|
||||
// All the code from here:
|
||||
// Is taken from the internet because I needed a simple hash function
|
||||
// --------------------------------------------------------
|
||||
|
||||
#define PRIME1 0x9E3779B1U /*!< 0b10011110001101110111100110110001 */
|
||||
#define PRIME2 0x85EBCA77U /*!< 0b10000101111010111100101001110111 */
|
||||
#define PRIME3 0xC2B2AE3DU /*!< 0b11000010101100101010111000111101 */
|
||||
#define PRIME4 0x27D4EB2FU /*!< 0b00100111110101001110101100101111 */
|
||||
#define PRIME5 0x165667B1U /*!< 0b00010110010101100110011110110001 */
|
||||
|
||||
uint32_t _rotl(const uint32_t value, int shift) {
|
||||
if ((shift &= sizeof(value)*8 - 1) == 0)
|
||||
return value;
|
||||
return (value << shift) | (value >> (sizeof(value)*8 - shift));
|
||||
}
|
||||
|
||||
uint32_t _rotr(const uint32_t value, int shift) {
|
||||
if ((shift &= sizeof(value)*8 - 1) == 0)
|
||||
return value;
|
||||
return (value >> shift) | (value << (sizeof(value)*8 - shift));
|
||||
}
|
||||
|
||||
uint32_t hash(uint8_t * data, int len) {
|
||||
int end = len;
|
||||
int offset = 0;
|
||||
int h32;
|
||||
if (len >= 16) {
|
||||
int limit = end - 16;
|
||||
uint32_t v1 = seed + PRIME1 + PRIME2;
|
||||
uint32_t v2 = seed + PRIME2;
|
||||
uint32_t v3 = seed;
|
||||
uint32_t v4 = seed - PRIME1;
|
||||
|
||||
do {
|
||||
v1 += (*(uint32_t*)(data + offset)) * PRIME2;
|
||||
v1 = _rotl(v1, 13);
|
||||
v1 *= PRIME1;
|
||||
offset += 4;
|
||||
v2 += (*(uint32_t*)(data + offset)) * PRIME2;
|
||||
v2 = _rotl(v2, 13);
|
||||
v2 *= PRIME1;
|
||||
offset += 4;
|
||||
v3 += (*(uint32_t*)(data + offset)) * PRIME2;
|
||||
v3 = _rotl(v3, 13);
|
||||
v3 *= PRIME1;
|
||||
offset += 4;
|
||||
v4 += (*(uint32_t*)(data + offset)) * PRIME2;
|
||||
v4 = _rotl(v4, 13);
|
||||
v4 *= PRIME1;
|
||||
offset += 4;
|
||||
} while(offset <= limit);
|
||||
// main loop ends
|
||||
// mix
|
||||
h32 = _rotl(v1, 1) + _rotl(v2, 7) + _rotl(v3, 12) + _rotl(v4, 18);
|
||||
} else {
|
||||
h32 = seed + PRIME5;
|
||||
}
|
||||
|
||||
for(h32 += len; offset <= end - 4; offset += 4) {
|
||||
h32 += (*(uint32_t*)(data + offset)) * PRIME3;
|
||||
h32 = _rotl(h32, 17) * PRIME4;
|
||||
}
|
||||
|
||||
while(offset < end) {
|
||||
h32 += (data[offset] & 255) * PRIME5;
|
||||
h32 = _rotl(h32, 11) * PRIME1;
|
||||
++offset;
|
||||
}
|
||||
|
||||
h32 ^= h32 >> 15;
|
||||
h32 *= PRIME2;
|
||||
h32 ^= h32 >> 13;
|
||||
h32 *= PRIME3;
|
||||
h32 ^= h32 >> 16;
|
||||
return h32;
|
||||
}
|
||||
|
||||
// --------------------------------------------------------
|
||||
// To here
|
||||
|
||||
|
||||
|
|
@ -0,0 +1,6 @@
|
|||
#ifndef HASHMAP_H
|
||||
#define HASHMAP_H
|
||||
#include <stdint.h>
|
||||
|
||||
|
||||
#endif
|
||||
|
|
@ -0,0 +1,17 @@
|
|||
#include <stdlib.h>
|
||||
#include <dirent.h>
|
||||
#include <stdio.h>
|
||||
|
||||
void hid_main() {
|
||||
DIR *d;
|
||||
struct dirent *dir;
|
||||
d = opendir("/sys/class/hidraw");
|
||||
if(d) {
|
||||
while ((dir = readdir(d)) != NULL) {
|
||||
if(dir->d_type != DT_LNK) continue;
|
||||
printf("%s\n", dir->d_ino);
|
||||
}
|
||||
closedir(d);
|
||||
}
|
||||
exit(0);
|
||||
}
|
||||
|
|
@ -0,0 +1,117 @@
|
|||
// vi: set shiftwidth=4 : set softtabstop=4
|
||||
#include <stdio.h>
|
||||
#include <sys/ioctl.h>
|
||||
#include <linux/joystick.h>
|
||||
#include <stdint.h>
|
||||
#include <fcntl.h>
|
||||
#include <stdlib.h>
|
||||
#include <string.h>
|
||||
#include <stdarg.h>
|
||||
#include <unistd.h>
|
||||
|
||||
#include "main.h"
|
||||
#include "hid.h"
|
||||
|
||||
const char* USAGE[] = {
|
||||
"jsfw client [input] [address] [port]\n",
|
||||
"jsfw server [port]\n",
|
||||
};
|
||||
const size_t EVENT_SIZE = sizeof(struct js_event);
|
||||
|
||||
void joystick_debug(Joystick * js) {
|
||||
printf("Joystick");
|
||||
if(js->name) printf(" (%s)", js->name);
|
||||
printf(": %u buttons, %u axes\n", js->button_count, js->axis_count);
|
||||
}
|
||||
|
||||
void panicf(const char *fmt, ...) {
|
||||
va_list args;
|
||||
va_start(args, fmt);
|
||||
vprintf(fmt, args);
|
||||
va_end(args);
|
||||
exit(1);
|
||||
}
|
||||
|
||||
uint16_t parse_port(const char * str) {
|
||||
long long n = atoll(str);
|
||||
if(n < 0 || n > UINT16_MAX)
|
||||
panicf("Invalid port: Expected a number in the range 0..%d, got %lld\n", UINT16_MAX, n);
|
||||
return n;
|
||||
}
|
||||
|
||||
void server(uint16_t port) {
|
||||
printf("Server (port: %u).\n", port);
|
||||
panicf("Uninplemented\n");
|
||||
}
|
||||
|
||||
void client(char * input, char * address, uint16_t port) {
|
||||
hid_main();
|
||||
printf("JSFW Client (%s -> %s:%d)\n", input, address, port);
|
||||
int fd = open(input, O_RDONLY);
|
||||
if(fd < 0) panicf("Couldn't open %s", input);
|
||||
|
||||
Joystick js = {};
|
||||
|
||||
char name[256];
|
||||
int name_len = ioctl(fd, JSIOCGNAME(256), name);
|
||||
if(name_len >= 0) {
|
||||
js.name = malloc(name_len);
|
||||
if(js.name) strncpy(js.name, name, name_len);
|
||||
}
|
||||
|
||||
ioctl(fd, JSIOCGBUTTONS, &js.button_count);
|
||||
ioctl(fd, JSIOCGAXES, &js.axis_count);
|
||||
|
||||
joystick_debug(&js);
|
||||
|
||||
struct js_event events[128];
|
||||
while(1) {
|
||||
int bytes = read(fd, events, EVENT_SIZE);
|
||||
if(bytes < EVENT_SIZE) {
|
||||
printf("Got %d bytes, expected at least %lu", bytes, EVENT_SIZE);
|
||||
continue;
|
||||
}
|
||||
int count = bytes / EVENT_SIZE;
|
||||
for(int i = 0; i < count; i++) {
|
||||
struct js_event event = events[i];
|
||||
printf("EV | type(%d) number(%d) value(%d) ts(%d)\n", event.type, event.number, event.value, event.time);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
int main(int argc, char* argv[]) {
|
||||
if(argc < 2) {
|
||||
printf("Usage: %s", USAGE[0]);
|
||||
printf(" %s", USAGE[1]);
|
||||
return 1;
|
||||
}
|
||||
|
||||
char* mode = argv[1];
|
||||
|
||||
if(strcmp(mode, "server") == 0) {
|
||||
|
||||
if(argc < 3)
|
||||
panicf("Usage: %s", USAGE[1]);
|
||||
|
||||
uint16_t port = parse_port(argv[2]);
|
||||
server(port);
|
||||
|
||||
} else if(strcmp(mode, "client") == 0) {
|
||||
|
||||
if(argc < 5)
|
||||
panicf("Usage: %s", USAGE[0]);
|
||||
|
||||
char * input = argv[2];
|
||||
char * address = argv[3];
|
||||
uint16_t port = parse_port(argv[4]);
|
||||
client(input, address, port);
|
||||
|
||||
} else {
|
||||
printf("Unknown mode: '%s'\n", mode);
|
||||
printf("Usage: %s", USAGE[0]);
|
||||
printf(" %s", USAGE[1]);
|
||||
return 1;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
|
@ -0,0 +1,11 @@
|
|||
#ifndef MAIN_H
|
||||
#define MAIN_H
|
||||
#include <stdint.h>
|
||||
|
||||
typedef struct {
|
||||
char * name;
|
||||
uint8_t button_count;
|
||||
uint8_t axis_count;
|
||||
} Joystick;
|
||||
|
||||
#endif
|
||||
Loading…
Reference in New Issue