udp.c 4.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130
  1. /*
  2. * Copyright (c) 1983, 1993 by The Regents of the University of California
  3. * Copyright (C) 2001-2007 by egnite Software GmbH
  4. *
  5. * All rights reserved.
  6. *
  7. * Redistribution and use in source and binary forms, with or without
  8. * modification, are permitted provided that the following conditions
  9. * are met:
  10. *
  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. Neither the name of the copyright holders nor the names of
  17. * contributors may be used to endorse or promote products derived
  18. * from this software without specific prior written permission.
  19. *
  20. * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
  21. * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  22. * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
  23. * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
  24. * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
  25. * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
  26. * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
  27. * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
  28. * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
  29. * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF
  30. * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  31. * SUCH DAMAGE.
  32. *
  33. * For additional information see http://www.ethernut.de/
  34. *
  35. * -
  36. * Portions Copyright (c) 1993 by Digital Equipment Corporation.
  37. *
  38. * Permission to use, copy, modify, and distribute this software for any
  39. * purpose with or without fee is hereby granted, provided that the above
  40. * copyright notice and this permission notice appear in all copies, and that
  41. * the name of Digital Equipment Corporation not be used in advertising or
  42. * publicity pertaining to distribution of the document or software without
  43. * specific, written prior permission.
  44. *
  45. * THE SOFTWARE IS PROVIDED "AS IS" AND DIGITAL EQUIPMENT CORP. DISCLAIMS ALL
  46. * WARRANTIES WITH REGARD TO THIS SOFTWARE, INCLUDING ALL IMPLIED WARRANTIES
  47. * OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL DIGITAL EQUIPMENT
  48. * CORPORATION BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
  49. * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
  50. * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS
  51. * ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS
  52. * SOFTWARE.
  53. */
  54. /*
  55. * $Id: udp.c 4115 2012-04-12 21:06:13Z olereinhardt $
  56. */
  57. #include "udp.h"
  58. #include "bootmon.h"
  59. #include "dialog.h"
  60. /*!
  61. * \addtogroup xgStack
  62. */
  63. /*@{*/
  64. /*!
  65. * \brief Receive a UDP datagram on a specified port.
  66. *
  67. * This function calls IpInput(). Any incoming Ethernet frame, which is
  68. * not a UDP datagram to the specified port will be discarded.
  69. *
  70. * \param port UDP port to listen to.
  71. * \param tms Return with timeout after the specified number of
  72. * waiting loops. On a 14 Mhz ATmega this value represents
  73. * approximately the number of milliseconds to wait.
  74. *
  75. * \return The number of data bytes received, 0 on timeout or -1 in
  76. * case of a failure.
  77. */
  78. int UdpInput(unsigned short port, unsigned int tms)
  79. {
  80. int rc;
  81. UDPHDR *uh = &rframe.eth.udp.udp_hdr;
  82. for (;;) {
  83. if ((rc = IpInput(IPPROTO_UDP, tms)) <= 0)
  84. break;
  85. /*
  86. * If the datagram matches the requested port, then return
  87. * the number of data bytes.
  88. */
  89. if (port == uh->uh_dport) {
  90. rc = ntohs(uh->uh_ulen) - sizeof(UDPHDR);
  91. break;
  92. }
  93. }
  94. return rc;
  95. }
  96. /*!
  97. * \brief Send a UDP datagram.
  98. *
  99. * This function fills the UDP header of the global send frame and calls
  100. * IpOutput().
  101. *
  102. * \param dip Destination IP address in network byte order.
  103. * \param dport Destination port.
  104. * \param sport Source port.
  105. * \param len Number of data bytes to transmit.
  106. *
  107. * \return 0 on success or -1 to indicate an error.
  108. */
  109. int UdpOutput(unsigned long dip, unsigned short dport, unsigned short sport, unsigned short len)
  110. {
  111. UDPHDR *up = &sframe.eth.udp.udp_hdr;
  112. /*
  113. * Setup the UDP header.
  114. */
  115. up->uh_sport = sport;
  116. up->uh_dport = dport;
  117. up->uh_ulen = htons(sizeof(UDPHDR) + len);
  118. return IpOutput(dip, IPPROTO_UDP, sizeof(UDPHDR) + len);
  119. }
  120. /*@}*/