GCC supports two pseudo variables to get the function name, __FUNCTION__
[dragonfly.git] / lib / libncp / ncpl_subr.c
1 /*
2  * Copyright (c) 1999, 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  * $FreeBSD: src/lib/libncp/ncpl_subr.c,v 1.3 2000/01/01 14:21:31 bp Exp $
33  * $DragonFly: src/lib/libncp/ncpl_subr.c,v 1.4 2005/02/17 13:59:35 joerg Exp $
34  */
35
36 #include <sys/param.h>
37 #include <sys/types.h>
38 #include <sys/errno.h>
39 #include <sys/sysctl.h>
40 #include <sys/syscall.h>
41 #include <unistd.h>
42 #include <ctype.h>
43 #include <string.h>
44 #include <stdio.h>
45 #include <stdlib.h>
46 #include <stdarg.h>
47
48 #include <netncp/ncp_lib.h>
49 #include <netncp/ncp_rcfile.h>
50 #include <netncp/ncp_nls.h>
51 /*#include <netncp/ncp_cfg.h>*/
52 #include "ncp_mod.h"
53
54 extern char *__progname;
55
56 int sysentoffset;
57
58 void
59 ncp_add_word_lh(struct ncp_buf *conn, u_int16_t x) {
60         setwle(conn->packet, conn->rqsize, x);
61         conn->rqsize += 2;
62         return;
63 }
64
65 void
66 ncp_add_dword_lh(struct ncp_buf *conn, u_int32_t x) {
67         setdle(conn->packet, conn->rqsize, x);
68         conn->rqsize += 4;
69         return;
70 }
71
72 void
73 ncp_add_word_hl(struct ncp_buf *conn, u_int16_t x){
74         setwbe(conn->packet, conn->rqsize, x);
75         conn->rqsize += 2;
76         return;
77 }
78
79 void
80 ncp_add_dword_hl(struct ncp_buf *conn, u_int32_t x) {
81         setdbe(conn->packet, conn->rqsize, x);
82         conn->rqsize += 4;
83         return;
84 }
85
86 void
87 ncp_add_mem(struct ncp_buf *conn, const void *source, int size) {
88         memcpy(conn->packet+conn->rqsize, source, size);
89         conn->rqsize += size;
90         return;
91 }
92
93 void
94 ncp_add_mem_nls(struct ncp_buf *conn, const void *source, int size) {
95         ncp_nls_mem_u2n(conn->packet+conn->rqsize, source, size);
96         conn->rqsize += size;
97         return;
98 }
99
100 void
101 ncp_add_pstring(struct ncp_buf *conn, const char *s) {
102         int len = strlen(s);
103         if (len > 255) {
104                 ncp_printf("ncp_add_pstring: string too long: %s\n", s);
105                 len = 255;
106         }
107         ncp_add_byte(conn, len);
108         ncp_add_mem(conn, s, len);
109         return;
110 }
111
112 void
113 ncp_add_handle_path(struct ncp_buf *conn, nuint32 volNumber, nuint32 dirNumber,
114         int handleFlag, const char *path)
115 {
116         ncp_add_byte(conn, volNumber);
117         ncp_add_dword_lh(conn, dirNumber);
118         ncp_add_byte(conn, handleFlag);
119         if (path) {
120                 ncp_add_byte(conn, 1);          /* 1 component */
121                 ncp_add_pstring(conn, path);
122         } else {
123                 ncp_add_byte(conn, 0);
124         }
125 }
126
127 void
128 ncp_init_request(struct ncp_buf *conn) {
129         conn->rqsize = 0;
130         conn->rpsize = 0;
131 }
132
133 void
134 ncp_init_request_s(struct ncp_buf *conn, int subfn) {
135         ncp_init_request(conn);
136         ncp_add_word_lh(conn, 0);
137         ncp_add_byte(conn, subfn);
138 }
139
140 u_int16_t
141 ncp_reply_word_hl(struct ncp_buf *conn, int offset) {
142         return getwbe(ncp_reply_data(conn, offset), 0);
143 }
144
145 u_int16_t
146 ncp_reply_word_lh(struct ncp_buf *conn, int offset) {
147         return getwle(ncp_reply_data(conn, offset), 0);
148 }
149
150 u_int32_t
151 ncp_reply_dword_hl(struct ncp_buf *conn, int offset) {
152         return getdbe(ncp_reply_data(conn, offset), 0);
153 }
154
155 u_int32_t
156 ncp_reply_dword_lh(struct ncp_buf *conn, int offset) {
157         return getdle(ncp_reply_data(conn, offset), 0);
158 }
159
160
161 int
162 ncp_connect(struct ncp_conn_args *li, int *connHandle) {
163         return syscall(NCP_CONNECT,li,connHandle);
164 }
165
166 int
167 ncp_disconnect(int cH) {
168         DECLARE_RQ;
169
170         ncp_init_request(conn);
171         ncp_add_byte(conn, NCP_CONN_CONNCLOSE);
172         return ncp_conn_request(cH, conn);
173 }
174
175 int
176 ncp_request(int connHandle,int function, struct ncp_buf *ncpbuf){
177         int err = syscall(SNCP_REQUEST,connHandle,function,ncpbuf);
178         return (err<0) ? errno : 0;
179 }
180
181 int
182 ncp_conn_request(int connHandle, struct ncp_buf *ncpbuf){
183         return syscall(SNCP_REQUEST, connHandle, NCP_CONN, ncpbuf);
184 }
185
186 int
187 ncp_conn_scan(struct ncp_conn_loginfo *li, int *connid) {
188         return syscall(NCP_CONNSCAN,li, connid);
189 }
190
191 NWCCODE
192 NWRequest(NWCONN_HANDLE cH, nuint16 fn,
193         nuint16 nrq, NW_FRAGMENT* rq, 
194         nuint16 nrp, NW_FRAGMENT* rp) 
195 {
196         int error;
197         struct ncp_conn_frag nf;
198         DECLARE_RQ;
199
200         ncp_init_request(conn);
201         ncp_add_byte(conn, NCP_CONN_FRAG);
202         nf.fn = fn;
203         nf.rqfcnt = nrq;
204         nf.rqf = rq;
205         nf.rpf = rp;
206         nf.rpfcnt = nrp;
207         ncp_add_mem(conn, &nf, sizeof(nf));
208         error = ncp_conn_request(cH, conn);
209         return error;
210 }
211
212
213 int
214 ncp_initlib(void){
215         int error;
216         int len = sizeof(sysentoffset);
217         int kv, kvlen = sizeof(kv);
218         static int ncp_initialized;
219
220         if (ncp_initialized)
221                 return 0;
222         error = sysctlbyname("net.ncp.sysent", &sysentoffset, &len, NULL, 0);
223         if (error) {
224                 fprintf(stderr, "%s: can't find kernel module\n", __func__);
225                 return error;
226         }
227         error = sysctlbyname("net.ncp.version", &kv, &kvlen, NULL, 0);
228         if (error) {
229                 fprintf(stderr, "%s: kernel module is old, please recompile it.\n", __func__);
230                 return error;
231         }
232         if (NCP_VERSION != kv) {
233                 fprintf(stderr, "%s: kernel module version(%d) don't match library(%d).\n", __func__, kv, NCP_VERSION);
234                 return EINVAL;
235         }
236         if ((error = ncp_nls_setrecode(0)) != 0) {
237                 fprintf(stderr, "%s: can't initialise recode\n", __func__);
238                 return error;
239         }
240         if ((error = ncp_nls_setlocale("")) != 0) {
241                 fprintf(stderr, "%s: can't initialise locale\n", __func__);
242                 return error;
243         }
244         ncp_initialized++;
245         return 0;
246 }
247
248
249 /*
250  */
251 int     ncp_opterr = 1,         /* if error message should be printed */
252         ncp_optind = 1,         /* index into parent argv vector */
253         ncp_optopt,                     /* character checked for validity */
254         ncp_optreset;           /* reset getopt */
255 char    *ncp_optarg;            /* argument associated with option */
256
257 #define BADCH   (int)'?'
258 #define BADARG  (int)':'
259 #define EMSG    ""
260
261 int
262 ncp_getopt(nargc, nargv, ostr)
263         int nargc;
264         char * const *nargv;
265         const char *ostr;
266 {
267         static char *place = EMSG;              /* option letter processing */
268         char *oli;                              /* option letter list index */
269         int tmpind;
270
271         if (ncp_optreset || !*place) {          /* update scanning pointer */
272                 ncp_optreset = 0;
273                 tmpind = ncp_optind;
274                 while (1) {
275                         if (tmpind >= nargc) {
276                                 place = EMSG;
277                                 return (-1);
278                         }
279                         if (*(place = nargv[tmpind]) != '-') {
280                                 tmpind++;
281                                 continue;       /* lookup next option */
282                         }
283                         if (place[1] && *++place == '-') {      /* found "--" */
284                                 ncp_optind = ++tmpind;
285                                 place = EMSG;
286                                 return (-1);
287                         }
288                         ncp_optind = tmpind;
289                         break;
290                 }
291         }                                       /* option letter okay? */
292         if ((ncp_optopt = (int)*place++) == (int)':' ||
293             !(oli = strchr(ostr, ncp_optopt))) {
294                 /*
295                  * if the user didn't specify '-' as an option,
296                  * assume it means -1.
297                  */
298                 if (ncp_optopt == (int)'-')
299                         return (-1);
300                 if (!*place)
301                         ++ncp_optind;
302                 if (ncp_opterr && *ostr != ':')
303                         (void)fprintf(stderr,
304                             "%s: illegal option -- %c\n", __progname, ncp_optopt);
305                 return (BADCH);
306         }
307         if (*++oli != ':') {                    /* don't need argument */
308                 ncp_optarg = NULL;
309                 if (!*place)
310                         ++ncp_optind;
311         }
312         else {                                  /* need an argument */
313                 if (*place)                     /* no white space */
314                         ncp_optarg = place;
315                 else if (nargc <= ++ncp_optind) {       /* no arg */
316                         place = EMSG;
317                         if (*ostr == ':')
318                                 return (BADARG);
319                         if (ncp_opterr)
320                                 (void)fprintf(stderr,
321                                     "%s: option requires an argument -- %c\n",
322                                     __progname, ncp_optopt);
323                         return (BADCH);
324                 }
325                 else                            /* white space */
326                         ncp_optarg = nargv[ncp_optind];
327                 place = EMSG;
328                 ++ncp_optind;
329         }
330         return (ncp_optopt);                    /* dump back option letter */
331 }
332 /*
333  * misc options parsing routines
334  */
335 int
336 ncp_args_parserc(struct ncp_args *na, char *sect, ncp_setopt_t *set_callback) {
337         int len, error;
338
339         for (; na->opt; na++) {
340                 switch (na->at) {
341                     case NCA_STR:
342                         if (rc_getstringptr(ncp_rc,sect,na->name,&na->str) == 0) {
343                                 len = strlen(na->str);
344                                 if (len > na->ival) {
345                                         fprintf(stderr,"rc: Argument for option '%c' (%s) too long\n",na->opt,na->name);
346                                         return EINVAL;
347                                 }
348                                 set_callback(na);
349                         }
350                         break;
351                     case NCA_BOOL:
352                         error = rc_getbool(ncp_rc,sect,na->name,&na->ival);
353                         if (error == ENOENT) break;
354                         if (error) return EINVAL;
355                         set_callback(na);
356                         break;
357                     case NCA_INT:
358                         if (rc_getint(ncp_rc,sect,na->name,&na->ival) == 0) {
359                                 if (((na->flag & NAFL_HAVEMIN) && 
360                                      (na->ival < na->min)) || 
361                                     ((na->flag & NAFL_HAVEMAX) && 
362                                      (na->ival > na->max))) {
363                                         fprintf(stderr,"rc: Argument for option '%c' (%s) should be in [%d-%d] range\n",na->opt,na->name,na->min,na->max);
364                                         return EINVAL;
365                                 }
366                                 set_callback(na);
367                         };
368                         break;
369                     default:
370                         break;
371                 }
372         }
373         return 0;
374 }
375
376 int
377 ncp_args_parseopt(struct ncp_args *na, int opt, char *optarg, ncp_setopt_t *set_callback) {
378         int len;
379
380         for (; na->opt; na++) {
381                 if (na->opt != opt) continue;
382                 switch (na->at) {
383                     case NCA_STR:
384                         na->str = optarg;
385                         if (optarg) {
386                                 len = strlen(na->str);
387                                 if (len > na->ival) {
388                                         fprintf(stderr,"opt: Argument for option '%c' (%s) too long\n",na->opt,na->name);
389                                         return EINVAL;
390                                 }
391                                 set_callback(na);
392                         }
393                         break;
394                     case NCA_BOOL:
395                         na->ival = 0;
396                         set_callback(na);
397                         break;
398                     case NCA_INT:
399                         errno = 0;
400                         na->ival = strtol(optarg, NULL, 0);
401                         if (errno) {
402                                 fprintf(stderr,"opt: Invalid integer value for option '%c' (%s).\n",na->opt,na->name);
403                                 return EINVAL;
404                         }
405                         if (((na->flag & NAFL_HAVEMIN) && 
406                              (na->ival < na->min)) || 
407                             ((na->flag & NAFL_HAVEMAX) && 
408                              (na->ival > na->max))) {
409                                 fprintf(stderr,"opt: Argument for option '%c' (%s) should be in [%d-%d] range\n",na->opt,na->name,na->min,na->max);
410                                 return EINVAL;
411                         }
412                         set_callback(na);
413                         break;
414                     default:
415                         break;
416                 }
417                 break;
418         }
419         return 0;
420 }
421
422 /*
423  * Print a (descriptive) error message
424  * error values:
425  *         0 - no specific error code available;
426  *  -999..-1 - NDS error
427  *  1..32767 - system error
428  *  the rest - requester error;
429  */
430 void
431 ncp_error(char *fmt, int error,...) {
432         va_list ap;
433
434         fprintf(stderr, "%s: ", __progname);
435         va_start(ap, error);
436         vfprintf(stderr, fmt, ap);
437         va_end(ap);
438         if (error == -1)
439                 error = errno;
440         if (error > -1000 && error < 0) {
441                 fprintf(stderr, ": dserr = %d\n", error);
442         } else if (error & 0x8000) {
443                 fprintf(stderr, ": nwerr = %04x\n", error);
444         } else if (error) {
445                 fprintf(stderr, ": syserr = %s\n", strerror(error));
446         } else
447                 fprintf(stderr, "\n");
448 }
449
450 char *
451 ncp_printb(char *dest, int flags, const struct ncp_bitname *bnp) {
452         int first = 1;
453
454         strcpy(dest, "<");
455         for(; bnp->bn_bit; bnp++) {
456                 if (flags & bnp->bn_bit) {
457                         strcat(dest, bnp->bn_name);
458                         first = 0;
459                 }
460                 if (!first && (flags & bnp[1].bn_bit))
461                         strcat(dest, "|");
462         }
463         strcat(dest, ">");
464         return dest;
465 }