125 lines
2.8 KiB
C
125 lines
2.8 KiB
C
#include <stdlib.h>
|
|
#include <string.h>
|
|
|
|
#include <sys/types.h>
|
|
#include <sys/socket.h>
|
|
#include <arpa/inet.h>
|
|
|
|
#include "configdata.h"
|
|
|
|
struct cfg_patch {
|
|
int code;
|
|
int mask;
|
|
int (* patch)(void *config, struct cfg_patch *patch, int code, const char *parameter);
|
|
int offset;
|
|
int size;
|
|
int min;
|
|
int max;
|
|
};
|
|
|
|
static int patch_8bit(void *config, struct cfg_patch *patch, int code, const char *parameter)
|
|
{
|
|
int value = atoi(parameter);
|
|
if (value < patch->min || value > patch->max)
|
|
return -1;
|
|
|
|
*((uint8_t *)(config + patch->offset)) = value;
|
|
return 0;
|
|
}
|
|
|
|
static int patch_16bit(void *config, struct cfg_patch *patch, int code, const char *parameter)
|
|
{
|
|
int value = atoi(parameter);
|
|
if (value < patch->min || value > patch->max)
|
|
return -1;
|
|
|
|
*((uint16_t *)(config + patch->offset)) = htons(value);
|
|
return 0;
|
|
}
|
|
|
|
static int patch_string(void *config, struct cfg_patch *patch, int code, const char *parameter)
|
|
{
|
|
strncpy(config + patch->offset, parameter, patch->size);
|
|
return 0;
|
|
}
|
|
|
|
static int patch_ip(void *config, struct cfg_patch *patch, int code, const char *parameter)
|
|
{
|
|
return (inet_pton(AF_INET, parameter, config + patch->offset) <= 0) ? -1 : 0;
|
|
}
|
|
|
|
static int patch_defaultgw(void *config, struct cfg_patch *patch, int code, const char *parameter)
|
|
{
|
|
/* metric? */
|
|
*((uint8_t *)(config + 0x110d)) = 0x02;
|
|
return patch_ip(config, patch, code, parameter);
|
|
}
|
|
|
|
static int patch_portname(void *config, struct cfg_patch *patch, int code, const char *parameter)
|
|
{
|
|
int num = code - patch->code;
|
|
if (num < patch->min || num > patch->max)
|
|
return -1;
|
|
|
|
strncpy(config + patch->offset + (num -1) * 0x70, parameter, patch->size);
|
|
return 0;
|
|
}
|
|
|
|
static struct cfg_patch patcharr[] = {{
|
|
.code = CFG_LOCATION,
|
|
.patch = patch_string,
|
|
.offset = 0x0034,
|
|
.size = 0x1d,
|
|
}, {
|
|
.code = CFG_SYSNAME,
|
|
.patch = patch_string,
|
|
.offset = 0x0054,
|
|
.size = 0x1d,
|
|
}, {
|
|
.code = CFG_CONTACT,
|
|
.patch = patch_string,
|
|
.offset = 0x0074,
|
|
.size = 0x1d,
|
|
}, {
|
|
.code = CFG_DEFAULTGW,
|
|
.patch = patch_defaultgw,
|
|
.offset = 0x10fc,
|
|
}, {
|
|
.code = CFG_IPADDRESS,
|
|
.patch = patch_ip,
|
|
.offset = 0x2df8,
|
|
}, {
|
|
.code = CFG_NETMASK,
|
|
.patch = patch_8bit,
|
|
.offset = 0x2dfe,
|
|
.min = 0x00, .max = 0x20,
|
|
}, {
|
|
.code = CFG_NAMESERVER,
|
|
.patch = patch_ip,
|
|
.offset = 0x32dc,
|
|
}, {
|
|
.code = CFG_MACAGEING,
|
|
.patch = patch_16bit,
|
|
.offset = 0x53e8,
|
|
.min = 0, .max = 0xFFFF,
|
|
}, {
|
|
.code = CFG_PORTNAME_MASK,
|
|
.mask = 0xFFFFFFE0,
|
|
.patch = patch_portname,
|
|
.offset = 0x336c,
|
|
.size = 9,
|
|
.min = 1, .max = 26,
|
|
}};
|
|
|
|
int config_patch(void *config, int code, const char *parameter)
|
|
{
|
|
int i;
|
|
for (i = 0; i < (sizeof(patcharr) / sizeof(struct cfg_patch)); i++) {
|
|
int mask = (patcharr[i].mask != 0) ? patcharr[i].mask : ~0;
|
|
|
|
if ((code & mask) == patcharr[i].code)
|
|
return patcharr[i].patch(config, &patcharr[i], code, parameter);
|
|
}
|
|
return -1;
|
|
}
|