1 /* Copyright (c) 2012, The Linux Foundation. All rights reserved.
2 *
3 * Redistribution and use in source and binary forms, with or without
4 * modification, are permitted provided that the following conditions are
5 * met:
6 * * Redistributions of source code must retain the above copyright
7 * notice, this list of conditions and the following disclaimer.
8 * * Redistributions in binary form must reproduce the above
9 * copyright notice, this list of conditions and the following
10 * disclaimer in the documentation and/or other materials provided
11 * with the distribution.
12 * * Neither the name of The Linux Foundation nor the names of its
13 * contributors may be used to endorse or promote products derived
14 * from this software without specific prior written permission.
15 *
16 * THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED
17 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
18 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT
19 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS
20 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
21 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
22 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
23 * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
24 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
25 * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
26 * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 *
28 */
29
30 #include <stdio.h>
31 #include <unistd.h>
32 #include <stdlib.h>
33 #include <errno.h>
34 #include <string.h>
35 #include <sys/socket.h>
36 #include <sys/uio.h>
37 #include <sys/un.h>
38
39 #include "mm_camera_dbg.h"
40 #include "mm_camera_sock.h"
41
42 /*===========================================================================
43 * FUNCTION : mm_camera_socket_create
44 *
45 * DESCRIPTION: opens a domain socket tied to camera ID and socket type
46 * @cam_id : camera ID
47 * @sock_type: socket type, TCP/UDP
48 *
49 * RETURN : fd related to the domain socket
50 *==========================================================================*/
mm_camera_socket_create(int cam_id,mm_camera_sock_type_t sock_type)51 int mm_camera_socket_create(int cam_id, mm_camera_sock_type_t sock_type)
52 {
53 int socket_fd;
54 struct sockaddr_un sock_addr;
55 int sktype;
56 int rc;
57
58 switch (sock_type)
59 {
60 case MM_CAMERA_SOCK_TYPE_UDP:
61 sktype = SOCK_DGRAM;
62 break;
63 case MM_CAMERA_SOCK_TYPE_TCP:
64 sktype = SOCK_STREAM;
65 break;
66 default:
67 CDBG_ERROR("%s: unknown socket type =%d", __func__, sock_type);
68 return -1;
69 }
70 socket_fd = socket(AF_UNIX, sktype, 0);
71 if (socket_fd < 0) {
72 CDBG_ERROR("%s: error create socket fd =%d", __func__, socket_fd);
73 return socket_fd;
74 }
75
76 memset(&sock_addr, 0, sizeof(sock_addr));
77 sock_addr.sun_family = AF_UNIX;
78 snprintf(sock_addr.sun_path, UNIX_PATH_MAX, "/data/cam_socket%d", cam_id);
79 if((rc = connect(socket_fd, (struct sockaddr *) &sock_addr,
80 sizeof(sock_addr))) != 0) {
81 close(socket_fd);
82 socket_fd = -1;
83 CDBG_ERROR("%s: socket_fd=%d %s ", __func__, socket_fd, strerror(errno));
84 }
85
86 CDBG("%s: socket_fd=%d %s", __func__, socket_fd, sock_addr.sun_path);
87 return socket_fd;
88 }
89
90 /*===========================================================================
91 * FUNCTION : mm_camera_socket_close
92 *
93 * DESCRIPTION: close domain socket by its fd
94 * @fd : file descriptor for the domain socket to be closed
95 *
96 * RETURN : none
97 *==========================================================================*/
mm_camera_socket_close(int fd)98 void mm_camera_socket_close(int fd)
99 {
100 if (fd > 0) {
101 close(fd);
102 }
103 }
104
105 /*===========================================================================
106 * FUNCTION : mm_camera_socket_sendmsg
107 *
108 * DESCRIPTION: send msg through domain socket
109 * @fd : socket fd
110 * @msg : pointer to msg to be sent over domain socket
111 * @sendfd : file descriptors to be sent
112 *
113 * RETURN : the total bytes of sent msg
114 *==========================================================================*/
mm_camera_socket_sendmsg(int fd,void * msg,uint32_t buf_size,int sendfd)115 int mm_camera_socket_sendmsg(
116 int fd,
117 void *msg,
118 uint32_t buf_size,
119 int sendfd)
120 {
121 struct msghdr msgh;
122 struct iovec iov[1];
123 struct cmsghdr * cmsghp = NULL;
124 char control[CMSG_SPACE(sizeof(int))];
125 uint32_t len = 0;
126
127 if (msg == NULL) {
128 CDBG("%s: msg is NULL", __func__);
129 return -1;
130 }
131 memset(&msgh, 0, sizeof(msgh));
132 msgh.msg_name = NULL;
133 msgh.msg_namelen = 0;
134
135 iov[0].iov_base = msg;
136 iov[0].iov_len = buf_size;
137 msgh.msg_iov = iov;
138 msgh.msg_iovlen = 1;
139 len = iov[0].iov_len;
140 CDBG("%s: iov_len=%d", __func__, len);
141
142 msgh.msg_control = NULL;
143 msgh.msg_controllen = 0;
144
145 /* if sendfd is valid, we need to pass it through control msg */
146 if( sendfd > 0) {
147 msgh.msg_control = control;
148 msgh.msg_controllen = sizeof(control);
149 cmsghp = CMSG_FIRSTHDR(&msgh);
150 if (cmsghp != NULL) {
151 CDBG("%s: Got ctrl msg pointer", __func__);
152 cmsghp->cmsg_level = SOL_SOCKET;
153 cmsghp->cmsg_type = SCM_RIGHTS;
154 cmsghp->cmsg_len = CMSG_LEN(sizeof(int));
155 *((int *)CMSG_DATA(cmsghp)) = sendfd;
156 CDBG("%s: cmsg data=%d", __func__, *((int *) CMSG_DATA(cmsghp)));
157 } else {
158 CDBG("%s: ctrl msg NULL", __func__);
159 return -1;
160 }
161 }
162
163 return sendmsg(fd, &(msgh), 0);
164 }
165
166 /*===========================================================================
167 * FUNCTION : mm_camera_socket_recvmsg
168 *
169 * DESCRIPTION: receive msg from domain socket.
170 * @fd : socket fd
171 * @msg : pointer to mm_camera_sock_msg_packet_t to hold incoming msg,
172 * need be allocated by the caller
173 * @buf_size: the size of the buf that holds incoming msg
174 * @rcvdfd : pointer to hold recvd file descriptor if not NULL.
175 *
176 * RETURN : the total bytes of received msg
177 *==========================================================================*/
mm_camera_socket_recvmsg(int fd,void * msg,uint32_t buf_size,int * rcvdfd)178 int mm_camera_socket_recvmsg(
179 int fd,
180 void *msg,
181 uint32_t buf_size,
182 int *rcvdfd)
183 {
184 struct msghdr msgh;
185 struct iovec iov[1];
186 struct cmsghdr *cmsghp = NULL;
187 char control[CMSG_SPACE(sizeof(int))];
188 int rcvd_fd = -1;
189 int rcvd_len = 0;
190
191 if ( (msg == NULL) || (buf_size <= 0) ) {
192 CDBG_ERROR(" %s: msg buf is NULL", __func__);
193 return -1;
194 }
195
196 memset(&msgh, 0, sizeof(msgh));
197 msgh.msg_name = NULL;
198 msgh.msg_namelen = 0;
199 msgh.msg_control = control;
200 msgh.msg_controllen = sizeof(control);
201
202 iov[0].iov_base = msg;
203 iov[0].iov_len = buf_size;
204 msgh.msg_iov = iov;
205 msgh.msg_iovlen = 1;
206
207 if ( (rcvd_len = recvmsg(fd, &(msgh), 0)) <= 0) {
208 CDBG_ERROR(" %s: recvmsg failed", __func__);
209 return rcvd_len;
210 }
211
212 CDBG("%s: msg_ctrl %p len %d", __func__, msgh.msg_control, msgh.msg_controllen);
213
214 if( ((cmsghp = CMSG_FIRSTHDR(&msgh)) != NULL) &&
215 (cmsghp->cmsg_len == CMSG_LEN(sizeof(int))) ) {
216 if (cmsghp->cmsg_level == SOL_SOCKET &&
217 cmsghp->cmsg_type == SCM_RIGHTS) {
218 CDBG("%s: CtrlMsg is valid", __func__);
219 rcvd_fd = *((int *) CMSG_DATA(cmsghp));
220 CDBG("%s: Receieved fd=%d", __func__, rcvd_fd);
221 } else {
222 CDBG_ERROR("%s: Unexpected Control Msg. Line=%d", __func__, __LINE__);
223 }
224 }
225
226 if (rcvdfd) {
227 *rcvdfd = rcvd_fd;
228 }
229
230 return rcvd_len;
231 }
232