00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023
00024
00025
00026
00027
00028
00029
00030
00031
00032
00033
00034
00035
00036
00037
00038
00039
00040
00041
00042
00043
00044
00045
00046
00047
00048
00049
00050
00051
00052
00053
00054
00055
00056
00057
00058
00059
00060
00061
00062
00063
00064
00065
00066
00067
00068
00069
00070
00071
00072
00073
00074
00075
00076
00077
00078
00079
00080
00081
00082
00083
00084
00085
00086
00087
00088
00089
00090
00091
00092 #include <netlink-generic.h>
00093 #include <netlink/netlink.h>
00094 #include <netlink/genl/genl.h>
00095 #include <netlink/utils.h>
00096
00097
00098
00099
00100
00101
00102 int genl_connect(struct nl_sock *sk)
00103 {
00104 return nl_connect(sk, NETLINK_GENERIC);
00105 }
00106
00107
00108
00109
00110
00111
00112
00113
00114
00115
00116
00117
00118
00119
00120
00121
00122
00123
00124
00125
00126
00127 int genl_send_simple(struct nl_sock *sk, int family, int cmd,
00128 int version, int flags)
00129 {
00130 struct genlmsghdr hdr = {
00131 .cmd = cmd,
00132 .version = version,
00133 };
00134
00135 return nl_send_simple(sk, family, flags, &hdr, sizeof(hdr));
00136 }
00137
00138
00139
00140
00141
00142
00143
00144
00145
00146 int genlmsg_valid_hdr(struct nlmsghdr *nlh, int hdrlen)
00147 {
00148 struct genlmsghdr *ghdr;
00149
00150 if (!nlmsg_valid_hdr(nlh, GENL_HDRLEN))
00151 return 0;
00152
00153 ghdr = nlmsg_data(nlh);
00154 if (genlmsg_len(ghdr) < NLMSG_ALIGN(hdrlen))
00155 return 0;
00156
00157 return 1;
00158 }
00159
00160 int genlmsg_validate(struct nlmsghdr *nlh, int hdrlen, int maxtype,
00161 struct nla_policy *policy)
00162 {
00163 struct genlmsghdr *ghdr;
00164
00165 if (!genlmsg_valid_hdr(nlh, hdrlen))
00166 return -NLE_MSG_TOOSHORT;
00167
00168 ghdr = nlmsg_data(nlh);
00169 return nla_validate(genlmsg_attrdata(ghdr, hdrlen),
00170 genlmsg_attrlen(ghdr, hdrlen), maxtype, policy);
00171 }
00172
00173 int genlmsg_parse(struct nlmsghdr *nlh, int hdrlen, struct nlattr *tb[],
00174 int maxtype, struct nla_policy *policy)
00175 {
00176 struct genlmsghdr *ghdr;
00177
00178 if (!genlmsg_valid_hdr(nlh, hdrlen))
00179 return -NLE_MSG_TOOSHORT;
00180
00181 ghdr = nlmsg_data(nlh);
00182 return nla_parse(tb, maxtype, genlmsg_attrdata(ghdr, hdrlen),
00183 genlmsg_attrlen(ghdr, hdrlen), policy);
00184 }
00185
00186
00187
00188
00189
00190 void *genlmsg_data(const struct genlmsghdr *gnlh)
00191 {
00192 return ((unsigned char *) gnlh + GENL_HDRLEN);
00193 }
00194
00195
00196
00197
00198
00199 int genlmsg_len(const struct genlmsghdr *gnlh)
00200 {
00201 struct nlmsghdr *nlh = (struct nlmsghdr *)((unsigned char *)gnlh -
00202 NLMSG_HDRLEN);
00203 return (nlh->nlmsg_len - GENL_HDRLEN - NLMSG_HDRLEN);
00204 }
00205
00206
00207
00208
00209
00210
00211 struct nlattr *genlmsg_attrdata(const struct genlmsghdr *gnlh, int hdrlen)
00212 {
00213 return genlmsg_data(gnlh) + NLMSG_ALIGN(hdrlen);
00214 }
00215
00216
00217
00218
00219
00220
00221 int genlmsg_attrlen(const struct genlmsghdr *gnlh, int hdrlen)
00222 {
00223 return genlmsg_len(gnlh) - NLMSG_ALIGN(hdrlen);
00224 }
00225
00226
00227
00228
00229
00230
00231
00232
00233
00234
00235
00236
00237
00238
00239
00240
00241
00242
00243
00244
00245
00246 void *genlmsg_put(struct nl_msg *msg, uint32_t pid, uint32_t seq, int family,
00247 int hdrlen, int flags, uint8_t cmd, uint8_t version)
00248 {
00249 struct nlmsghdr *nlh;
00250 struct genlmsghdr hdr = {
00251 .cmd = cmd,
00252 .version = version,
00253 };
00254
00255 nlh = nlmsg_put(msg, pid, seq, family, GENL_HDRLEN + hdrlen, flags);
00256 if (nlh == NULL)
00257 return NULL;
00258
00259 memcpy(nlmsg_data(nlh), &hdr, sizeof(hdr));
00260 NL_DBG(2, "msg %p: Added generic netlink header cmd=%d version=%d\n",
00261 msg, cmd, version);
00262
00263 return nlmsg_data(nlh) + GENL_HDRLEN;
00264 }
00265
00266
00267
00268