/* * (C) 2012 by Pablo Neira Ayuso * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published * by the Free Software Foundation; either version 2 of the License, or * (at your option) any later version. * * This code has been sponsored by Sophos Astaro */ #include #include #include #include #include #include #include #include #include #include #include #include #include "internal.h" static int nftnl_data_reg_value_snprintf_default(char *buf, size_t size, const union nftnl_data_reg *reg, uint32_t flags) { int remain = size, offset = 0, ret, i; for (i = 0; i < div_round_up(reg->len, sizeof(uint32_t)); i++) { ret = snprintf(buf + offset, remain, "0x%.8x ", reg->val[i]); SNPRINTF_BUFFER_SIZE(ret, remain, offset); } return offset; } static int nftnl_data_reg_verdict_snprintf_def(char *buf, size_t size, const union nftnl_data_reg *reg, uint32_t flags) { int remain = size, offset = 0, ret = 0; ret = snprintf(buf, size, "%s ", nftnl_verdict2str(reg->verdict)); SNPRINTF_BUFFER_SIZE(ret, remain, offset); if (reg->chain != NULL) { ret = snprintf(buf + offset, remain, "-> %s ", reg->chain); SNPRINTF_BUFFER_SIZE(ret, remain, offset); } return offset; } int nftnl_data_reg_snprintf(char *buf, size_t size, const union nftnl_data_reg *reg, uint32_t output_format, uint32_t flags, int reg_type) { switch(reg_type) { case DATA_VALUE: switch(output_format) { case NFTNL_OUTPUT_DEFAULT: return nftnl_data_reg_value_snprintf_default(buf, size, reg, flags); case NFTNL_OUTPUT_JSON: case NFTNL_OUTPUT_XML: default: break; } break; case DATA_VERDICT: case DATA_CHAIN: switch(output_format) { case NFTNL_OUTPUT_DEFAULT: return nftnl_data_reg_verdict_snprintf_def(buf, size, reg, flags); case NFTNL_OUTPUT_JSON: case NFTNL_OUTPUT_XML: default: break; } break; default: break; } return -1; } static int nftnl_data_parse_cb(const struct nlattr *attr, void *data) { const struct nlattr **tb = data; int type = mnl_attr_get_type(attr); if (mnl_attr_type_valid(attr, NFTA_DATA_MAX) < 0) return MNL_CB_OK; switch(type) { case NFTA_DATA_VALUE: if (mnl_attr_validate(attr, MNL_TYPE_BINARY) < 0) abi_breakage(); break; case NFTA_DATA_VERDICT: if (mnl_attr_validate(attr, MNL_TYPE_NESTED) < 0) abi_breakage(); break; } tb[type] = attr; return MNL_CB_OK; } static int nftnl_verdict_parse_cb(const struct nlattr *attr, void *data) { const struct nlattr **tb = data; int type = mnl_attr_get_type(attr); if (mnl_attr_type_valid(attr, NFTA_VERDICT_MAX) < 0) return MNL_CB_OK; switch(type) { case NFTA_VERDICT_CODE: if (mnl_attr_validate(attr, MNL_TYPE_U32) < 0) abi_breakage(); break; case NFTA_VERDICT_CHAIN: if (mnl_attr_validate(attr, MNL_TYPE_STRING) < 0) abi_breakage(); break; } tb[type] = attr; return MNL_CB_OK; } static int nftnl_parse_verdict(union nftnl_data_reg *data, const struct nlattr *attr, int *type) { struct nlattr *tb[NFTA_VERDICT_MAX+1]; if (mnl_attr_parse_nested(attr, nftnl_verdict_parse_cb, tb) < 0) return -1; if (!tb[NFTA_VERDICT_CODE]) return -1; data->verdict = ntohl(mnl_attr_get_u32(tb[NFTA_VERDICT_CODE])); switch(data->verdict) { case NF_ACCEPT: case NF_DROP: case NF_QUEUE: case NFT_CONTINUE: case NFT_BREAK: case NFT_RETURN: if (type) *type = DATA_VERDICT; data->len = sizeof(data->verdict); break; case NFT_JUMP: case NFT_GOTO: if (!tb[NFTA_VERDICT_CHAIN]) return -1; data->chain = strdup(mnl_attr_get_str(tb[NFTA_VERDICT_CHAIN])); if (!data->chain) return -1; if (type) *type = DATA_CHAIN; break; default: return -1; } return 0; } static int __nftnl_parse_data(union nftnl_data_reg *data, const struct nlattr *attr) { void *orig = mnl_attr_get_payload(attr); uint32_t data_len = mnl_attr_get_payload_len(attr); if (data_len == 0) return -1; if (data_len > sizeof(data->val)) return -1; memcpy(data->val, orig, data_len); data->len = data_len; return 0; } int nftnl_parse_data(union nftnl_data_reg *data, struct nlattr *attr, int *type) { struct nlattr *tb[NFTA_DATA_MAX+1] = {}; int ret = 0; if (mnl_attr_parse_nested(attr, nftnl_data_parse_cb, tb) < 0) return -1; if (tb[NFTA_DATA_VALUE]) { if (type) *type = DATA_VALUE; ret = __nftnl_parse_data(data, tb[NFTA_DATA_VALUE]); if (ret < 0) return ret; } if (tb[NFTA_DATA_VERDICT]) ret = nftnl_parse_verdict(data, tb[NFTA_DATA_VERDICT], type); return ret; } void nftnl_free_verdict(const union nftnl_data_reg *data) { switch(data->verdict) { case NFT_JUMP: case NFT_GOTO: xfree(data->chain); break; default: break; } }