raw_usrreq.c
上传用户:baixin
上传日期:2008-03-13
资源大小:4795k
文件大小:10k
开发平台:

MultiPlatform

  1. /* raw_usrreq.c - raw protocol interface */
  2. /* Copyright 1984 - 2001 Wind River Systems, Inc. */
  3. #include "copyright_wrs.h"
  4. /*
  5.  * Copyright (c) 1980, 1986, 1993
  6.  * The Regents of the University of California.  All rights reserved.
  7.  *
  8.  * Redistribution and use in source and binary forms, with or without
  9.  * modification, are permitted provided that the following conditions
  10.  * are met:
  11.  * 1. Redistributions of source code must retain the above copyright
  12.  *    notice, this list of conditions and the following disclaimer.
  13.  * 2. Redistributions in binary form must reproduce the above copyright
  14.  *    notice, this list of conditions and the following disclaimer in the
  15.  *    documentation and/or other materials provided with the distribution.
  16.  * 3. All advertising materials mentioning features or use of this software
  17.  *    must display the following acknowledgement:
  18.  * This product includes software developed by the University of
  19.  * California, Berkeley and its contributors.
  20.  * 4. Neither the name of the University nor the names of its contributors
  21.  *    may be used to endorse or promote products derived from this software
  22.  *    without specific prior written permission.
  23.  *
  24.  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
  25.  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  26.  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  27.  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
  28.  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  29.  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  30.  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  31.  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  32.  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  33.  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  34.  * SUCH DAMAGE.
  35.  *
  36.  * @(#)raw_usrreq.c 8.1 (Berkeley) 6/10/93
  37.  */
  38. /*
  39. modification history
  40. --------------------
  41. 02d,12oct01,rae  merge from truestack ver 02e, base 02c
  42. 02c,03jul97,vin  SPR 8885. fixed warnings. 
  43. 02b,31jan97,vin  changed declaration according to prototype decl in protosw.h
  44. 01a,03mar96,vin  created from BSD4.4lite2.
  45. */
  46. /*
  47. DESCRIPTION
  48. */
  49. #include "vxWorks.h"
  50. #include "netLib.h"
  51. #include "net/mbuf.h"
  52. #include "net/domain.h"
  53. #include "net/protosw.h"
  54. #include "sys/socket.h"
  55. #include "net/socketvar.h"
  56. #include "errno.h"
  57. #include "net/if.h"
  58. #include "net/route.h"
  59. #include "net/raw_cb.h"
  60. #include "net/systm.h"
  61. #ifdef WV_INSTRUMENTATION
  62. #ifdef INCLUDE_WVNET
  63. #include "wvNetLib.h"
  64. #endif
  65. #endif
  66. #ifdef WV_INSTRUMENTATION
  67. #ifdef INCLUDE_WVNET
  68.     /* Set common fields of event identifiers for this module. */
  69. LOCAL UCHAR wvNetModuleId = WV_NET_RAWREQ_MODULE; /* Value for raw_usrreq.c */
  70. LOCAL UCHAR wvNetLocalFilter = WV_NET_NONE;     /* Available event filter */
  71. LOCAL ULONG wvNetEventId;       /* Event identifier: see wvNetLib.h */
  72. #endif    /* INCLUDE_WVNET */
  73. #endif
  74. #ifdef VIRTUAL_STACK
  75. #include "netinet/vsLib.h"
  76. #endif    /* VIRTUAL_STACK */
  77. /*
  78.  * Initialize raw connection block q.
  79.  */
  80. void
  81. raw_init()
  82. {
  83. #ifdef WV_INSTRUMENTATION
  84. #ifdef INCLUDE_WVNET    /* WV_NET_VERBOSE event */
  85.     WV_NET_MARKER_0 (NET_AUX_EVENT, WV_NET_VERBOSE, 32, 7,
  86.                      WV_NETEVENT_RAWINIT_START)
  87. #endif  /* INCLUDE_WVNET */
  88. #endif
  89. #ifdef VIRTUAL_STACK
  90. _rawcb.rcb_next = _rawcb.rcb_prev = &_rawcb;
  91. #else    /* VIRTUAL_STACK */
  92. rawcb.rcb_next = rawcb.rcb_prev = &rawcb;
  93. #endif   /* VIRTUAL_STACK */
  94. return;
  95. }
  96. /*
  97.  * Raw protocol input routine.  Find the socket
  98.  * associated with the packet(s) and move them over.  If
  99.  * nothing exists for this packet, drop it.
  100.  */
  101. /*
  102.  * Raw protocol interface.
  103.  */
  104. void
  105. raw_input(m0, proto, src, dst)
  106. struct mbuf *m0;
  107. register struct sockproto *proto;
  108. struct sockaddr *src, *dst;
  109. {
  110. register struct rawcb *rp;
  111. register struct mbuf *m = m0;
  112. register int sockets = 0;
  113. struct socket *last;
  114. #ifdef WV_INSTRUMENTATION
  115. #ifdef INCLUDE_WVNET    /* WV_NET_NOTICE event */
  116.     WV_NET_EVENT_2 (NET_CORE_EVENT, WV_NET_NOTICE, 16, 4,
  117.                      WV_NETEVENT_RAWIN_START, WV_NET_RECV,
  118.                      proto->sp_family, proto->sp_protocol)
  119. #endif  /* INCLUDE_WVNET */
  120. #endif
  121. last = 0;
  122. #ifdef VIRTUAL_STACK
  123. for (rp = _rawcb.rcb_next; rp != &_rawcb; rp = rp->rcb_next) {
  124. #else
  125. for (rp = rawcb.rcb_next; rp != &rawcb; rp = rp->rcb_next) {
  126. #endif
  127. if (rp->rcb_proto.sp_family != proto->sp_family)
  128. continue;
  129. if (rp->rcb_proto.sp_protocol  &&
  130.     rp->rcb_proto.sp_protocol != proto->sp_protocol)
  131. continue;
  132. /*
  133.  * We assume the lower level routines have
  134.  * placed the address in a canonical format
  135.  * suitable for a structure comparison.
  136.  *
  137.  * Note that if the lengths are not the same
  138.  * the comparison will fail at the first byte.
  139.  */
  140. #define equal(a1, a2) 
  141.   (bcmp((caddr_t)(a1), (caddr_t)(a2), a1->sa_len) == 0)
  142. if (rp->rcb_laddr && !equal(rp->rcb_laddr, dst))
  143. continue;
  144. if (rp->rcb_faddr && !equal(rp->rcb_faddr, src))
  145. continue;
  146. if (last) {
  147. struct mbuf *n;
  148. if ((n = m_copy(m, 0, (int)M_COPYALL))) {
  149. if (sbappendaddr(&last->so_rcv, src,
  150.     n, (struct mbuf *)0) == 0)
  151.                                     {
  152. #ifdef WV_INSTRUMENTATION
  153. #ifdef INCLUDE_WVNET    /* WV_NET_WARNING event */
  154.                     WV_NET_EVENT_1 (NET_CORE_EVENT, WV_NET_WARNING, 10, 3,
  155.                                     WV_NETEVENT_RAWIN_LOST, WV_NET_RECV,
  156.                                     last->so_fd)
  157. #endif  /* INCLUDE_WVNET */
  158. #endif
  159. /* should notify about lost packet */
  160. m_freem(n);
  161.                                     }
  162. else {
  163. sorwakeup(last);
  164. sockets++;
  165. }
  166. }
  167. }
  168. last = rp->rcb_socket;
  169. }
  170. if (last) {
  171. if (sbappendaddr(&last->so_rcv, src,
  172.     m, (struct mbuf *)0) == 0)
  173.                     {
  174. #ifdef WV_INSTRUMENTATION
  175. #ifdef INCLUDE_WVNET    /* WV_NET_WARNING event */
  176.                     WV_NET_EVENT_1 (NET_CORE_EVENT, WV_NET_WARNING, 10, 3,
  177.                                     WV_NETEVENT_RAWIN_LOST, WV_NET_RECV,
  178.                                     last->so_fd)
  179. #endif  /* INCLUDE_WVNET */
  180. #endif
  181. m_freem(m);
  182.                      }
  183. else {
  184. sorwakeup(last);
  185. sockets++;
  186. }
  187. } else
  188. m_freem(m);
  189. return;
  190. }
  191. /*ARGSUSED*/
  192. void
  193. raw_ctlinput(cmd, arg)
  194. int cmd;
  195. struct sockaddr *arg;
  196. {
  197. /*
  198.  * XXX - This event is not reported because the routine currently does
  199.  *       nothing when called.
  200. #ifdef WV_INSTRUMENTATION
  201. #ifdef INCLUDE_WVNET    /@ WV_NET_INFO event @/
  202.     WV_NET_MARKER_1 (NET_AUX_EVENT, WV_NET_INFO, 15, 5,
  203.                      WV_NETEVENT_RAWCTLIN_START, cmd)
  204. #endif  /@ INCLUDE_WVNET @/
  205. #endif
  206.  * XXX - end of unused event
  207.  */
  208. if (cmd < 0 || cmd > PRC_NCMDS)
  209. return;
  210. /* INCOMPLETE */
  211. }
  212. /*ARGSUSED*/
  213. int
  214. raw_usrreq(so, req, m, nam, control)
  215. struct socket *so;
  216. int req;
  217. struct mbuf *m, *nam, *control;
  218. {
  219. register struct rawcb *rp = sotorawcb(so);
  220. register int error = 0;
  221. int len;
  222. #ifdef WV_INSTRUMENTATION
  223. #ifdef INCLUDE_WVNET    /* WV_NET_INFO event */
  224.     WV_NET_MARKER_2 (NET_CORE_EVENT, WV_NET_INFO, 16, 6,
  225.                      WV_NETEVENT_RAWREQ_START, so->so_fd, req)
  226. #endif  /* INCLUDE_WVNET */
  227. #endif
  228. if (req == PRU_CONTROL)
  229. return (EOPNOTSUPP);
  230. if (control && control->m_len) {
  231. error = EOPNOTSUPP;
  232. goto release;
  233. }
  234. if (rp == 0) {
  235. error = EINVAL;
  236. goto release;
  237. }
  238. switch (req) {
  239. /*
  240.  * Allocate a raw control block and fill in the
  241.  * necessary info to allow packets to be routed to
  242.  * the appropriate raw interface routine.
  243.  */
  244. case PRU_ATTACH:
  245. if ((so->so_state & SS_PRIV) == 0) {
  246. error = EACCES;
  247. break;
  248. }
  249. error = raw_attach(so, (int)nam);
  250. break;
  251. /*
  252.  * Destroy state just before socket deallocation.
  253.  * Flush data or not depending on the options.
  254.  */
  255. case PRU_DETACH:
  256. if (rp == 0) {
  257. error = ENOTCONN;
  258. break;
  259. }
  260. raw_detach(rp);
  261. break;
  262. #ifdef notdef
  263. /*
  264.  * If a socket isn't bound to a single address,
  265.  * the raw input routine will hand it anything
  266.  * within that protocol family (assuming there's
  267.  * nothing else around it should go to). 
  268.  */
  269. case PRU_CONNECT:
  270. if (rp->rcb_faddr) {
  271. error = EISCONN;
  272. break;
  273. }
  274. nam = m_copym(nam, 0, M_COPYALL, M_WAIT);
  275. rp->rcb_faddr = mtod(nam, struct sockaddr *);
  276. soisconnected(so);
  277. break;
  278. case PRU_BIND:
  279. if (rp->rcb_laddr) {
  280. error = EINVAL; /* XXX */
  281. break;
  282. }
  283. error = raw_bind(so, nam);
  284. break;
  285. #endif
  286. case PRU_CONNECT2:
  287. error = EOPNOTSUPP;
  288. goto release;
  289. case PRU_DISCONNECT:
  290. if (rp->rcb_faddr == 0) {
  291. error = ENOTCONN;
  292. break;
  293. }
  294. raw_disconnect(rp);
  295. soisdisconnected(so);
  296. break;
  297. /*
  298.  * Mark the connection as being incapable of further input.
  299.  */
  300. case PRU_SHUTDOWN:
  301. socantsendmore(so);
  302. break;
  303. /*
  304.  * Ship a packet out.  The appropriate raw output
  305.  * routine handles any massaging necessary.
  306.  */
  307. case PRU_SEND:
  308. if (nam) {
  309. if (rp->rcb_faddr) {
  310. error = EISCONN;
  311. break;
  312. }
  313. rp->rcb_faddr = mtod(nam, struct sockaddr *);
  314. } else if (rp->rcb_faddr == 0) {
  315. error = ENOTCONN;
  316. break;
  317. }
  318. error = (*so->so_proto->pr_output)(m, so);
  319. m = NULL;
  320. if (nam)
  321. rp->rcb_faddr = 0;
  322. break;
  323. case PRU_ABORT:
  324. soisdisconnected(so);
  325. raw_disconnect(rp);
  326. break;
  327. case PRU_SENSE:
  328. /*
  329.  * stat: don't bother with a blocksize.
  330.  */
  331. return (0);
  332. /*
  333.  * Not supported.
  334.  */
  335. case PRU_RCVOOB:
  336. case PRU_RCVD:
  337. return(EOPNOTSUPP);
  338. case PRU_LISTEN:
  339. case PRU_ACCEPT:
  340. case PRU_SENDOOB:
  341. error = EOPNOTSUPP;
  342. break;
  343. case PRU_SOCKADDR:
  344. if (rp->rcb_laddr == 0) {
  345. error = EINVAL;
  346. break;
  347. }
  348. len = rp->rcb_laddr->sa_len;
  349. bcopy((caddr_t)rp->rcb_laddr, mtod(nam, caddr_t), (unsigned)len);
  350. nam->m_len = len;
  351. break;
  352. case PRU_PEERADDR:
  353. if (rp->rcb_faddr == 0) {
  354. error = ENOTCONN;
  355. break;
  356. }
  357. len = rp->rcb_faddr->sa_len;
  358. bcopy((caddr_t)rp->rcb_faddr, mtod(nam, caddr_t), (unsigned)len);
  359. nam->m_len = len;
  360. break;
  361. default:
  362. #ifdef WV_INSTRUMENTATION
  363. #ifdef INCLUDE_WVNET    /* WV_NET_EMERGENCY event */
  364.             WV_NET_MARKER_2 (NET_CORE_EVENT, WV_NET_EMERGENCY, 20, 1,
  365.                              WV_NETEVENT_RAWREQ_PANIC, so->so_fd, req)
  366. #endif  /* INCLUDE_WVNET */
  367. #endif
  368. panic("raw_usrreq");
  369. }
  370. release:
  371. if (m != NULL)
  372. m_freem(m);
  373. #ifdef WV_INSTRUMENTATION
  374. #ifdef INCLUDE_WVNET    /* WV_NET_ERROR event */
  375.     if (error)
  376.         {
  377.         WV_NET_MARKER_3 (NET_CORE_EVENT, WV_NET_ERROR, 36, 2,
  378.                          WV_NETEVENT_RAWREQ_FAIL, so->so_fd, req, error)
  379.         }
  380. #endif  /* INCLUDE_WVNET */
  381. #endif
  382. return (error);
  383. }