#include #include #include #include #include #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; }