| 1 | /* $NetBSD: if_hippisubr.c,v 1.47 2016/04/28 00:16:56 ozaki-r Exp $ */ |
| 2 | |
| 3 | /* |
| 4 | * Copyright (c) 1982, 1989, 1993 |
| 5 | * The Regents of the University of California. 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 | * 1. Redistributions of source code must retain the above copyright |
| 11 | * notice, this list of conditions and the following disclaimer. |
| 12 | * 2. Redistributions in binary form must reproduce the above copyright |
| 13 | * notice, this list of conditions and the following disclaimer in the |
| 14 | * documentation and/or other materials provided with the distribution. |
| 15 | * 3. Neither the name of the University nor the names of its contributors |
| 16 | * may be used to endorse or promote products derived from this software |
| 17 | * without specific prior written permission. |
| 18 | * |
| 19 | * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND |
| 20 | * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
| 21 | * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE |
| 22 | * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE |
| 23 | * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL |
| 24 | * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS |
| 25 | * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) |
| 26 | * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT |
| 27 | * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY |
| 28 | * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF |
| 29 | * SUCH DAMAGE. |
| 30 | */ |
| 31 | |
| 32 | #include <sys/cdefs.h> |
| 33 | __KERNEL_RCSID(0, "$NetBSD: if_hippisubr.c,v 1.47 2016/04/28 00:16:56 ozaki-r Exp $" ); |
| 34 | |
| 35 | #ifdef _KERNEL_OPT |
| 36 | #include "opt_inet.h" |
| 37 | #endif |
| 38 | |
| 39 | |
| 40 | #include <sys/param.h> |
| 41 | #include <sys/systm.h> |
| 42 | #include <sys/kernel.h> |
| 43 | #include <sys/malloc.h> |
| 44 | #include <sys/mbuf.h> |
| 45 | #include <sys/protosw.h> |
| 46 | #include <sys/socket.h> |
| 47 | #include <sys/ioctl.h> |
| 48 | #include <sys/errno.h> |
| 49 | #include <sys/syslog.h> |
| 50 | |
| 51 | #include <sys/cpu.h> |
| 52 | |
| 53 | #include <net/if.h> |
| 54 | #include <net/netisr.h> |
| 55 | #include <net/route.h> |
| 56 | #include <net/if_llc.h> |
| 57 | #include <net/if_dl.h> |
| 58 | #include <net/if_types.h> |
| 59 | |
| 60 | #include <net/bpf.h> |
| 61 | |
| 62 | #include <net/if_hippi.h> |
| 63 | |
| 64 | #include <netinet/in.h> |
| 65 | #if defined(INET) || defined(INET6) |
| 66 | #include <netinet/in_var.h> |
| 67 | #endif |
| 68 | |
| 69 | #define senderr(e) { error = (e); goto bad;} |
| 70 | |
| 71 | #ifndef llc_snap |
| 72 | #define llc_snap llc_un.type_snap |
| 73 | #endif |
| 74 | |
| 75 | static int hippi_output(struct ifnet *, struct mbuf *, |
| 76 | const struct sockaddr *, const struct rtentry *); |
| 77 | static void hippi_input(struct ifnet *, struct mbuf *); |
| 78 | |
| 79 | /* |
| 80 | * HIPPI output routine. |
| 81 | * Encapsulate a packet of type family for the local net. |
| 82 | * I don't know anything about the mapping of AppleTalk or OSI |
| 83 | * protocols to HIPPI, so I don't include any code for them. |
| 84 | */ |
| 85 | |
| 86 | static int |
| 87 | hippi_output(struct ifnet *ifp, struct mbuf *m0, const struct sockaddr *dst, |
| 88 | const struct rtentry *rt) |
| 89 | { |
| 90 | uint16_t htype; |
| 91 | uint32_t ifield = 0; |
| 92 | int error = 0; |
| 93 | struct mbuf *m = m0; |
| 94 | struct hippi_header *hh; |
| 95 | uint32_t *cci; |
| 96 | uint32_t d2_len; |
| 97 | |
| 98 | if ((ifp->if_flags & (IFF_UP|IFF_RUNNING)) != (IFF_UP|IFF_RUNNING)) |
| 99 | senderr(ENETDOWN); |
| 100 | |
| 101 | /* HIPPI doesn't really do broadcast or multicast right now */ |
| 102 | if (m->m_flags & (M_BCAST | M_MCAST)) |
| 103 | senderr(EOPNOTSUPP); /* XXX: some other error? */ |
| 104 | |
| 105 | /* |
| 106 | * If the queueing discipline needs packet classification, |
| 107 | * do it before prepending link headers. |
| 108 | */ |
| 109 | IFQ_CLASSIFY(&ifp->if_snd, m, dst->sa_family); |
| 110 | |
| 111 | switch (dst->sa_family) { |
| 112 | #ifdef INET |
| 113 | case AF_INET: |
| 114 | if (rt) { |
| 115 | const struct sockaddr_dl *sdl = |
| 116 | satocsdl(rt->rt_gateway); |
| 117 | if (sdl->sdl_family == AF_LINK && sdl->sdl_alen != 0) |
| 118 | memcpy(&ifield, CLLADDR(sdl), sizeof(ifield)); |
| 119 | } |
| 120 | if (!ifield) /* XXX: bogus check, but helps us get going */ |
| 121 | senderr(EHOSTUNREACH); |
| 122 | htype = htons(ETHERTYPE_IP); |
| 123 | break; |
| 124 | #endif |
| 125 | |
| 126 | #ifdef INET6 |
| 127 | case AF_INET6: |
| 128 | if (rt) { |
| 129 | const struct sockaddr_dl *sdl = |
| 130 | satocsdl(rt->rt_gateway); |
| 131 | if (sdl->sdl_family == AF_LINK && sdl->sdl_alen != 0) |
| 132 | memcpy(&ifield, CLLADDR(sdl), sizeof(ifield)); |
| 133 | } |
| 134 | if (!ifield) /* XXX: bogus check, but helps us get going */ |
| 135 | senderr(EHOSTUNREACH); |
| 136 | htype = htons(ETHERTYPE_IPV6); |
| 137 | break; |
| 138 | #endif |
| 139 | |
| 140 | default: |
| 141 | printf("%s: can't handle af%d\n" , ifp->if_xname, |
| 142 | dst->sa_family); |
| 143 | senderr(EAFNOSUPPORT); |
| 144 | } |
| 145 | |
| 146 | if (htype != 0) { |
| 147 | struct llc *l; |
| 148 | M_PREPEND(m, sizeof (struct llc), M_DONTWAIT); |
| 149 | if (m == 0) |
| 150 | senderr(ENOBUFS); |
| 151 | l = mtod(m, struct llc *); |
| 152 | l->llc_control = LLC_UI; |
| 153 | l->llc_dsap = l->llc_ssap = LLC_SNAP_LSAP; |
| 154 | l->llc_snap.org_code[0] = l->llc_snap.org_code[1] = |
| 155 | l->llc_snap.org_code[2] = 0; |
| 156 | memcpy((void *) &l->llc_snap.ether_type, (void *) &htype, |
| 157 | sizeof(uint16_t)); |
| 158 | } |
| 159 | |
| 160 | d2_len = m->m_pkthdr.len; |
| 161 | |
| 162 | /* |
| 163 | * Add local net header. If no space in first mbuf, |
| 164 | * allocate another. |
| 165 | */ |
| 166 | |
| 167 | M_PREPEND(m, sizeof (struct hippi_header) + 8, M_DONTWAIT); |
| 168 | if (m == 0) |
| 169 | senderr(ENOBUFS); |
| 170 | cci = mtod(m, uint32_t *); |
| 171 | memset(cci, 0, sizeof(struct hippi_header) + 8); |
| 172 | cci[0] = 0; |
| 173 | cci[1] = ifield; |
| 174 | hh = (struct hippi_header *) &cci[2]; |
| 175 | hh->hi_fp.fp_ulp = HIPPI_ULP_802; |
| 176 | hh->hi_fp.fp_flags = HIPPI_FP_D1_PRESENT; |
| 177 | hh->hi_fp.fp_offsets = htons(sizeof(struct hippi_le)); |
| 178 | hh->hi_fp.fp_d2_len = htonl(d2_len); |
| 179 | |
| 180 | /* Pad out the D2 area to end on a quadword (64-bit) boundry. */ |
| 181 | |
| 182 | if (d2_len % 8 != 0) { |
| 183 | static uint32_t buffer[2] = {0, 0}; |
| 184 | m_copyback(m, m->m_pkthdr.len, 8 - d2_len % 8, (void *) buffer); |
| 185 | } |
| 186 | |
| 187 | return ifq_enqueue(ifp, m); |
| 188 | |
| 189 | bad: |
| 190 | if (m) |
| 191 | m_freem(m); |
| 192 | return (error); |
| 193 | } |
| 194 | |
| 195 | /* |
| 196 | * Process a received HIPPI packet; |
| 197 | * the packet is in the mbuf chain m with |
| 198 | * the HIPPI header. |
| 199 | */ |
| 200 | |
| 201 | static void |
| 202 | hippi_input(struct ifnet *ifp, struct mbuf *m) |
| 203 | { |
| 204 | pktqueue_t *pktq; |
| 205 | struct llc *l; |
| 206 | uint16_t htype; |
| 207 | struct hippi_header *hh; |
| 208 | |
| 209 | if ((ifp->if_flags & IFF_UP) == 0) { |
| 210 | m_freem(m); |
| 211 | return; |
| 212 | } |
| 213 | |
| 214 | /* XXX: need to check flags and drop if bogus! */ |
| 215 | |
| 216 | hh = mtod(m, struct hippi_header *); |
| 217 | |
| 218 | ifp->if_ibytes += m->m_pkthdr.len; |
| 219 | if (hh->hi_le.le_dest_addr[0] & 1) { |
| 220 | if (memcmp(etherbroadcastaddr, hh->hi_le.le_dest_addr, |
| 221 | sizeof(etherbroadcastaddr)) == 0) |
| 222 | m->m_flags |= M_BCAST; |
| 223 | else |
| 224 | m->m_flags |= M_MCAST; |
| 225 | } |
| 226 | if (m->m_flags & (M_BCAST|M_MCAST)) |
| 227 | ifp->if_imcasts++; |
| 228 | |
| 229 | /* Skip past the HIPPI header. */ |
| 230 | m_adj(m, sizeof(struct hippi_header)); |
| 231 | |
| 232 | l = mtod(m, struct llc *); |
| 233 | if (l->llc_dsap != LLC_SNAP_LSAP) { |
| 234 | m_freem(m); |
| 235 | return; |
| 236 | } |
| 237 | htype = ntohs(l->llc_snap.ether_type); |
| 238 | m_adj(m, 8); |
| 239 | switch (htype) { |
| 240 | #ifdef INET |
| 241 | case ETHERTYPE_IP: |
| 242 | pktq = ip_pktq; |
| 243 | break; |
| 244 | #endif |
| 245 | #ifdef INET6 |
| 246 | case ETHERTYPE_IPV6: |
| 247 | pktq = ip6_pktq; |
| 248 | break; |
| 249 | #endif |
| 250 | default: |
| 251 | m_freem(m); |
| 252 | return; |
| 253 | } |
| 254 | |
| 255 | if (__predict_false(!pktq_enqueue(pktq, m, 0))) { |
| 256 | m_freem(m); |
| 257 | } |
| 258 | } |
| 259 | |
| 260 | /* |
| 261 | * Handle packet from HIPPI that has no MAC header |
| 262 | */ |
| 263 | |
| 264 | #ifdef INET |
| 265 | void |
| 266 | hippi_ip_input(struct ifnet *ifp, struct mbuf *m) |
| 267 | { |
| 268 | int s; |
| 269 | |
| 270 | s = splnet(); |
| 271 | if (__predict_false(!pktq_enqueue(ip_pktq, m, 0))) { |
| 272 | m_freem(m); |
| 273 | } |
| 274 | splx(s); |
| 275 | } |
| 276 | #endif |
| 277 | |
| 278 | /* |
| 279 | * Perform common duties while attaching to interface list |
| 280 | */ |
| 281 | void |
| 282 | hippi_ifattach(struct ifnet *ifp, void *lla) |
| 283 | { |
| 284 | |
| 285 | ifp->if_type = IFT_HIPPI; |
| 286 | ifp->if_hdrlen = sizeof(struct hippi_header) + 8; /* add CCI */ |
| 287 | ifp->if_dlt = DLT_HIPPI; |
| 288 | ifp->if_mtu = HIPPIMTU; |
| 289 | ifp->if_output = hippi_output; |
| 290 | ifp->_if_input = hippi_input; |
| 291 | ifp->if_baudrate = IF_Mbps(800); /* XXX double-check */ |
| 292 | |
| 293 | if_set_sadl(ifp, lla, 6, true); |
| 294 | |
| 295 | bpf_attach(ifp, DLT_HIPPI, sizeof(struct hippi_header)); |
| 296 | } |
| 297 | |