77 lines
2.4 KiB
C
77 lines
2.4 KiB
C
#include <asm-generic/errno-base.h>
|
|
#include <stdlib.h>
|
|
#define PLATFORM_FILE
|
|
#include "platform.h"
|
|
|
|
static const char* const platform_input_path = "/sys/devices/platform/asus-mcu.0/input/mode";
|
|
|
|
int init_platform(rc71l_platform_t *const platform) {
|
|
if (access(platform_input_path, F_OK) != 0) {
|
|
fprintf(stderr, "Unable to find the MCU platform mode file %s: modes cannot be switched.\n", platform_input_path);
|
|
return -ENOENT;
|
|
}
|
|
|
|
FILE* mode_file = fopen(platform_input_path, "r");
|
|
if (mode_file == NULL) {
|
|
fprintf(stderr, "Unable to open the MCU platform mode file %s: modes cannot be switched.\n", platform_input_path);
|
|
return -EINVAL;
|
|
}
|
|
|
|
char mode_str[12];
|
|
unsigned long read_bytes = fread((void*)&mode_str[0], 1, sizeof(mode_str), mode_file);
|
|
if (read_bytes < 1) {
|
|
fprintf(stderr, "Unable to read the MCU platform mode file %s: no bytes.\n", platform_input_path);
|
|
fclose(mode_file);
|
|
}
|
|
|
|
platform->mode = strtoul(&mode_str[0], NULL, 10);
|
|
|
|
fclose(mode_file);
|
|
|
|
printf("Asus MCU platform found: current mode %lu\n", platform->mode);
|
|
platform->modes_count = 3;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int cycle_mode(rc71l_platform_t *const platform) {
|
|
char new_mode_str[] = {
|
|
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
|
|
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
|
|
0x00, 0x00, 0x00
|
|
};
|
|
|
|
unsigned long new_mode = (platform->mode + 1) % platform->modes_count;
|
|
sprintf(new_mode_str, "%lu\n", new_mode);
|
|
|
|
FILE* mode_file = fopen(platform_input_path, "w");
|
|
if (mode_file == NULL) {
|
|
fprintf(stderr, "Unable to open the MCU platform mode file %s: modes cannot be switched.\n", platform_input_path);
|
|
return -1;
|
|
}
|
|
|
|
size_t len = strlen(new_mode_str);
|
|
const int write_bytes = fwrite((void*)&new_mode_str[0], 1, len, mode_file);
|
|
if (write_bytes < len) {
|
|
fprintf(stderr, "Error writing new mode: expected to write %d bytes, %d written.\n", (int)len, (int)write_bytes);
|
|
return -2;
|
|
}
|
|
|
|
platform->mode = new_mode;
|
|
|
|
fclose(mode_file);
|
|
|
|
return 0;
|
|
}
|
|
|
|
int is_gamepad_mode(rc71l_platform_t *const platform) {
|
|
return platform != NULL ? platform->mode == 0 : 0;
|
|
}
|
|
|
|
int is_mouse_mode(rc71l_platform_t *const platform) {
|
|
return platform != NULL ? platform->mode == 1 : 0;
|
|
}
|
|
|
|
int is_macro_mode(rc71l_platform_t *const platform) {
|
|
return platform != NULL ? platform->mode == 2 : 0;
|
|
}
|