1 /* 2 * Copyright (c) 2000, Boris Popov 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 3. All advertising materials mentioning features or use of this software 14 * must display the following acknowledgement: 15 * This product includes software developed by Boris Popov. 16 * 4. Neither the name of the author nor the names of any co-contributors 17 * may be used to endorse or promote products derived from this software 18 * without specific prior written permission. 19 * 20 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 21 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 22 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 23 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 24 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 25 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 26 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 27 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 28 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 29 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 30 * SUCH DAMAGE. 31 * 32 * $Id: nb_name.c,v 1.1 2000/07/16 01:52:07 bp Exp $ 33 */ 34 #include <sys/param.h> 35 #include <sys/socket.h> 36 37 #include <ctype.h> 38 #include <err.h> 39 #include <errno.h> 40 #include <stdio.h> 41 #include <stdlib.h> 42 #include <string.h> 43 44 #include <netsmb/netbios.h> 45 #include <netsmb/smb_lib.h> 46 #include <netsmb/nb_lib.h> 47 48 int 49 nb_snballoc(int namelen, struct sockaddr_nb **dst) 50 { 51 struct sockaddr_nb *snb; 52 int slen; 53 54 slen = namelen + sizeof(*snb) - sizeof(snb->snb_name); 55 snb = malloc(slen); 56 if (snb == NULL) 57 return ENOMEM; 58 bzero(snb, slen); 59 snb->snb_family = AF_NETBIOS; 60 snb->snb_len = slen; 61 *dst = snb; 62 return 0; 63 } 64 65 void 66 nb_snbfree(struct sockaddr *snb) 67 { 68 free(snb); 69 } 70 71 /* 72 * Create a full NETBIOS address 73 */ 74 int 75 nb_sockaddr(struct sockaddr *peer, struct nb_name *np, 76 struct sockaddr_nb **dst) 77 78 { 79 struct sockaddr_nb *snb; 80 int nmlen, error; 81 82 if (peer && (peer->sa_family != AF_INET && peer->sa_family != AF_IPX)) 83 return EPROTONOSUPPORT; 84 nmlen = nb_name_len(np); 85 if (nmlen < NB_ENCNAMELEN) 86 return EINVAL; 87 error = nb_snballoc(nmlen, &snb); 88 if (error) 89 return error; 90 if (nmlen != nb_name_encode(np, snb->snb_name)) 91 printf("a bug somewhere in the nb_name* code\n"); 92 if (peer) 93 memcpy(&snb->snb_tran, peer, peer->sa_len); 94 *dst = snb; 95 return 0; 96 } 97 98 int 99 nb_name_len(struct nb_name *np) 100 { 101 u_char *name; 102 int len, sclen; 103 104 len = 1 + NB_ENCNAMELEN; 105 if (np->nn_scope == NULL) 106 return len + 1; 107 sclen = 0; 108 for (name = np->nn_scope; *name; name++) { 109 if (*name == '.') { 110 sclen = 0; 111 } else { 112 if (sclen < NB_MAXLABLEN) { 113 sclen++; 114 len++; 115 } 116 } 117 } 118 return len + 1; 119 } 120 121 int 122 nb_encname_len(const char *str) 123 { 124 const u_char *cp = (const u_char *)str; 125 int len, blen; 126 127 if ((cp[0] & 0xc0) == 0xc0) 128 return -1; /* first two bytes are offset to name */ 129 130 len = 1; 131 for (;;) { 132 blen = *cp; 133 if (blen++ == 0) 134 break; 135 len += blen; 136 cp += blen; 137 } 138 return len; 139 } 140 141 #define NBENCODE(c) ((u_short)(((u_char)(c) >> 4) | \ 142 (((u_char)(c) & 0xf) << 8)) + 0x4141) 143 144 static void 145 memsetw(char *dst, int n, u_short word) 146 { 147 while (n--) { 148 *(u_short*)dst = word; 149 dst += 2; 150 } 151 } 152 153 int 154 nb_name_encode(struct nb_name *np, u_char *dst) 155 { 156 u_char *name, *plen; 157 u_char *cp = dst; 158 int i, lblen; 159 160 *cp++ = NB_ENCNAMELEN; 161 name = np->nn_name; 162 if (name[0] == '*' && name[1] == 0) { 163 *(u_short*)cp = NBENCODE('*'); 164 memsetw(cp + 2, NB_NAMELEN - 1, NBENCODE(' ')); 165 cp += NB_ENCNAMELEN; 166 } else { 167 for (i = 0; *name && i < NB_NAMELEN; i++, cp += 2, name++) 168 *(u_short*)cp = NBENCODE(toupper(*name)); 169 i = NB_NAMELEN - i - 1; 170 if (i > 0) { 171 memsetw(cp, i, NBENCODE(' ')); 172 cp += i * 2; 173 } 174 *(u_short*)cp = NBENCODE(np->nn_type); 175 cp += 2; 176 } 177 *cp = 0; 178 if (np->nn_scope == NULL) 179 return nb_encname_len(dst); 180 plen = cp++; 181 lblen = 0; 182 for (name = np->nn_scope; ; name++) { 183 if (*name == '.' || *name == 0) { 184 *plen = lblen; 185 plen = cp++; 186 *plen = 0; 187 if (*name == 0) 188 break; 189 } else { 190 if (lblen < NB_MAXLABLEN) { 191 *cp++ = *name; 192 lblen++; 193 } 194 } 195 } 196 return nb_encname_len(dst); 197 } 198 199