release/src-rt/emf/igsconf/igsu_linux.c

   1 /*
   2  * IGSL Command Line Utility Linux specific code
   3  *
   4  * Copyright (C) 2010, Broadcom Corporation
   5  * All Rights Reserved.
   6  *
   7  * This is UNPUBLISHED PROPRIETARY SOURCE CODE of Broadcom Corporation;
   8  * the contents of this file may not be disclosed to third parties, copied
   9  * or duplicated in any form, in whole or in part, without the prior
  10  * written permission of Broadcom Corporation.
  11  *
  12  * $Id: igsu_linux.c 241182 2011-02-17 21:50:03Z gmo $
  13  */
  14
  15 #include <stdio.h>
  16 #include <sys/sysctl.h>
  17 #include <net/if.h>
  18 #include <netinet/in.h>
  19 #include <string.h>
  20 #include <ctype.h>
  21 #include <errno.h>
  22 #include <stdlib.h>
  23 #include <sys/socket.h>
  24 #include <linux/types.h>
  25 #include <linux/netlink.h>
  26 #include <unistd.h>
  27 #include <errno.h>
  28 #include <bcmnvram.h>
  29
  30 #include "igsu_linux.h"
  31 #include <igs_cfg.h>
  32
  33 #define MAX_DATA_SIZE sizeof(igs_cfg_request_t)
  34
  35 int
  36 igs_cfg_request_send(igs_cfg_request_t *buffer, int length)
  37 {
  38         struct sockaddr_nl src_addr, dest_addr;
  39         struct nlmsghdr *nlh = NULL;
  40         struct msghdr msg;
  41         struct iovec iov;
  42         int    sock_fd, ret;
  43
  44         if ((buffer == NULL) || (length > MAX_DATA_SIZE))
  45         {
  46                 fprintf(stderr, "Invalid parameters %p %d\n", buffer, length);
  47                 return (FAILURE);
  48         }
  49
  50         /* Create a netlink socket */
  51         sock_fd = socket(PF_NETLINK, SOCK_RAW, NETLINK_IGSC);
  52
  53         if (sock_fd < 0)
  54         {
  55                 fprintf(stderr, "Netlink socket create failed\n");
  56                 return (FAILURE);
  57         }
  58
  59         /* Associate a local address with the opened socket */
  60         memset(&src_addr, 0, sizeof(struct sockaddr_nl));
  61         src_addr.nl_family = AF_NETLINK;
  62         src_addr.nl_pid = getpid();
  63         src_addr.nl_groups = 0;
  64         bind(sock_fd, (struct sockaddr *)&src_addr, sizeof(src_addr));
  65
  66         /* Fill the destination address, pid of 0 indicates kernel */
  67         memset(&dest_addr, 0, sizeof(struct sockaddr_nl));
  68         dest_addr.nl_family = AF_NETLINK;
  69         dest_addr.nl_pid = 0;
  70         dest_addr.nl_groups = 0;
  71
  72         /* Allocate memory for sending configuration request */
  73         nlh = (struct nlmsghdr *)malloc(NLMSG_SPACE(MAX_DATA_SIZE));
  74
  75         if (nlh == NULL)
  76         {
  77                 fprintf(stderr, "Out of memory allocating cfg buffer\n");
  78                 return (FAILURE);
  79         }
  80
  81         /* Fill the netlink message header. The configuration request
  82          * contains netlink header followed by data.
  83          */
  84         nlh->nlmsg_len = NLMSG_SPACE(MAX_DATA_SIZE);
  85         nlh->nlmsg_pid = getpid();
  86         nlh->nlmsg_flags = 0;
  87
  88         /* Fill the data part */
  89         memcpy(NLMSG_DATA(nlh), buffer, length);
  90         iov.iov_base = (void *)nlh;
  91         iov.iov_len = nlh->nlmsg_len;
  92         memset(&msg, 0, sizeof(struct msghdr));
  93         msg.msg_name = (void *)&dest_addr;
  94         msg.msg_namelen = sizeof(dest_addr);
  95         msg.msg_iov = &iov;
  96         msg.msg_iovlen = 1;
  97
  98         /* Send request to kernel module */
  99         ret = sendmsg(sock_fd, &msg, 0);
 100         if (ret < 0)
 101         {
 102                 perror("sendmsg:");
 103                 free(nlh);
 104                 return (ret);
 105         }
 106
 107         /* Wait for the response */
 108         memset(nlh, 0, NLMSG_SPACE(MAX_DATA_SIZE));
 109         ret = recvmsg(sock_fd, &msg, 0);
 110         if (ret < 0)
 111         {
 112                 perror("recvmsg:");
 113                 free(nlh);
 114                 return (ret);
 115         }
 116
 117         /* Copy data to user buffer */
 118         memcpy(buffer, NLMSG_DATA(nlh), length);
 119
 120         free(nlh);
 121
 122         close(sock_fd);
 123
 124         return (ret);
 125 }