229 lines
6.2 KiB
C
229 lines
6.2 KiB
C
/*
|
|
* lw12ctl.c
|
|
* Copyright (C) 2017 jpk <jpk@thor>
|
|
*
|
|
* Distributed under terms of the MIT license.
|
|
*/
|
|
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <stdint.h>
|
|
#include <unistd.h>
|
|
|
|
#include <readline/readline.h>
|
|
|
|
#include "lw12.h"
|
|
|
|
#define DebugPrintPos fprintf(stderr, "%s:%d\n", __FILE__, __LINE__)
|
|
|
|
|
|
int exit_interactive_session = 0;
|
|
int sockfd = 0;
|
|
struct sockaddr_in server_addr;
|
|
|
|
|
|
static int lw12_cmd_light(int argc, char *argv[]) {
|
|
if (argc == 0) {
|
|
printf("Not enough parameters, choices are:\n");
|
|
printf(" on\n");
|
|
printf(" off\n");
|
|
printf(" set <color> <value>\n\n");
|
|
printf("Color:\n------\nred\ngreen\nblue\nrgb\n\n"
|
|
"The colors red, green and blue require one additional\n"
|
|
"parameter as number between 0 - 255. The `rgb` value\n"
|
|
"has to be given in #RRGGBB hex format.\n");
|
|
}
|
|
if (strncasecmp(argv[0], "on", strlen(argv[0])) == 0) {
|
|
lw12_sendcmd(sockfd, &server_addr, (char *)LIGHTS_ON);
|
|
lw12_sendcmd(sockfd, &server_addr, (char *)LIGHTS_INIT);
|
|
} else if (strncasecmp(argv[0], "off", strlen(argv[0])) == 0) {
|
|
lw12_sendcmd(sockfd, &server_addr, (char *)LIGHTS_OFF);
|
|
} else if (strncasecmp(argv[0], "set", strlen(argv[0])) == 0) {
|
|
if (argc < 3) {
|
|
printf("Not enough parameters, usage:\n"
|
|
" - set <color> <value>\n\b");
|
|
return 1;
|
|
}
|
|
|
|
// todo set color
|
|
unsigned char cmd[LW12_CMD_LENGTH];
|
|
// last char gets not copied?!
|
|
strncpy((char *)cmd, LIGHT_COLOR, LW12_CMD_LENGTH);
|
|
|
|
if (strncasecmp(argv[1], "red", strlen(argv[1])) == 0) {
|
|
uint8_t colorvalue = (uint8_t)atoi(argv[2]);
|
|
cmd[4] = (char)colorvalue;
|
|
} else if (strncasecmp(argv[1], "green", strlen(argv[1])) == 0) {
|
|
uint8_t colorvalue = (uint8_t)atoi(argv[2]);
|
|
cmd[5] = (char)colorvalue;
|
|
} else if (strncasecmp(argv[1], "blue", strlen(argv[1])) == 0) {
|
|
uint8_t colorvalue = (uint8_t)atoi(argv[2]);
|
|
cmd[6] = (char)colorvalue;
|
|
} else if (strncasecmp(argv[1], "rgb", strlen(argv[1])) == 0) {
|
|
if (strlen(argv[2]) != 7) {
|
|
printf("Invalid RGB value. Example: #ff138a\n");
|
|
return 1;
|
|
}
|
|
char *pos = argv[2];
|
|
if (*pos == '#')
|
|
pos++;
|
|
int colorvalue = (int)strtol(pos, 0, 16);
|
|
// exchange byte order to match RR GG BB
|
|
colorvalue = (colorvalue & 0x000000ff) << 16
|
|
| (colorvalue & 0x00ff0000) >> 16
|
|
| (colorvalue & 0x0000ff00);
|
|
memcpy(cmd+4, &colorvalue, 4);
|
|
} else {
|
|
printf("Unknown color selected, use: red, green or blue\n");
|
|
return 1;
|
|
}
|
|
// last char gets not copied?!
|
|
for (int x = 0; x < 9; x++)
|
|
printf("%02x", cmd[x]);
|
|
printf("\n");
|
|
cmd[LW12_CMD_LENGTH-1] = '\xef';
|
|
|
|
for (int x = 0; x < 9; x++)
|
|
printf("%02x", cmd[x]);
|
|
printf("\n");
|
|
lw12_sendcmd(sockfd, &server_addr, (char *)cmd);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int lw12_cmd_exit(int argc, char *argv[]) {
|
|
exit_interactive_session = 1;
|
|
return 0;
|
|
}
|
|
|
|
static int lw12_cmd_dummy(int argc, char *argv[]) {
|
|
return 1;
|
|
}
|
|
|
|
struct lw12_command {
|
|
const char *cmd;
|
|
int (*handler)(int argc, char *argv[]);
|
|
const char *usage;
|
|
};
|
|
|
|
static struct lw12_command lw12_commands[] = {
|
|
{"light", lw12_cmd_light,
|
|
"Control the LED stripe. Turn it on/off and change the colors" },
|
|
{"foobar", lw12_cmd_dummy,
|
|
"Exit program"},
|
|
{"foobaz", lw12_cmd_dummy,
|
|
"Exit program"},
|
|
{"exit", lw12_cmd_exit,
|
|
"Exit program"},
|
|
{"quit", lw12_cmd_exit,
|
|
"Exit program"}
|
|
};
|
|
|
|
int parse_commands(int argc, char *argv[]) {
|
|
struct lw12_command *cmd, *match = NULL;
|
|
int count = 0;
|
|
int ret = 0;
|
|
|
|
cmd = lw12_commands;
|
|
while (cmd->cmd) {
|
|
if(strncasecmp(cmd->cmd, argv[0], strlen(argv[0])) == 0) {
|
|
match = cmd;
|
|
|
|
// nessecary?
|
|
if (strcasecmp(cmd->cmd, argv[0]) == 0) {
|
|
count = 1;
|
|
break;
|
|
}
|
|
count++;
|
|
}
|
|
cmd++;
|
|
}
|
|
|
|
if (count > 1) {
|
|
printf("Ambiguous commnd '%s'; possible commands:", argv[0]);
|
|
cmd = lw12_commands;
|
|
while (cmd->cmd) {
|
|
if (strncasecmp(cmd->cmd, argv[0], strlen(argv[0])) == 0) {
|
|
printf(" %s", cmd->cmd);
|
|
}
|
|
cmd++;
|
|
}
|
|
printf("\n");
|
|
ret = 1;
|
|
} else if (count == 0) {
|
|
printf("Unknown command '%s'\n", argv[0]);
|
|
ret = 1;
|
|
} else {
|
|
ret = match->handler(argc - 1, &argv[1]);
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
void cmd_loop() {
|
|
#define max_args 10
|
|
#define buf_size 256
|
|
char cmdbuf[buf_size];
|
|
char *cmd;
|
|
char *pos;
|
|
char *argv[max_args];
|
|
int argc;
|
|
|
|
do {
|
|
cmd = readline("> ");
|
|
if (cmd == NULL)
|
|
break;
|
|
|
|
pos = cmd;
|
|
while (*pos != '\0') {
|
|
// convert \n to separate argument
|
|
if (*pos == '\n') {
|
|
*pos = '\0';
|
|
break;
|
|
}
|
|
pos++;
|
|
}
|
|
argc = 0;
|
|
pos = cmd;
|
|
// count number of arguments
|
|
for (;;) {
|
|
// ignore spaces in the beginning
|
|
while (*pos == ' ')
|
|
pos++;
|
|
if (*pos == '\0')
|
|
break;
|
|
argv[argc] = pos;
|
|
argc++;
|
|
if (argc == max_args)
|
|
break;
|
|
// string arguments
|
|
if (*pos == '"') {
|
|
char *pos2 = strrchr(pos, '"');
|
|
if (pos2)
|
|
pos = pos2 + 1;
|
|
}
|
|
while (*pos != '\0' && *pos != ' ')
|
|
pos++;
|
|
if (*pos == ' ')
|
|
*pos++ = '\0';
|
|
}
|
|
|
|
parse_commands(argc, argv);
|
|
|
|
if (cmd != cmdbuf)
|
|
free(cmd);
|
|
|
|
} while (!exit_interactive_session);
|
|
}
|
|
|
|
int main() {
|
|
char serverip[] = "192.168.178.24";
|
|
uint16_t serverport = 5000;
|
|
|
|
lw12_connect(&sockfd, &server_addr, serverport, serverip);
|
|
cmd_loop();
|
|
close(sockfd);
|
|
|
|
return 0;
|
|
}
|