/*      $NetBSD: btpin.c,v 1.8 2019/10/12 17:50:56 christos Exp $       */

/*-
 * Copyright (c) 2006 Itronix Inc.
 * All rights reserved.
 *
 * Written by Iain Hibbert for Itronix Inc.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 * 3. The name of Itronix Inc. may not be used to endorse
 *    or promote products derived from this software without specific
 *    prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY ITRONIX INC. ``AS IS'' AND
 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
 * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL ITRONIX INC. BE LIABLE FOR ANY
 * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
 * ON ANY THEORY OF LIABILITY, WHETHER IN
 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
 * POSSIBILITY OF SUCH DAMAGE.
 */

#include <sys/cdefs.h>
__COPYRIGHT("@(#) Copyright (c) 2006 Itronix, Inc.  All rights reserved.");
__RCSID("$NetBSD: btpin.c,v 1.8 2019/10/12 17:50:56 christos Exp $");

#include <sys/types.h>
#include <sys/un.h>
#include <bluetooth.h>
#include <err.h>
#include <errno.h>
#include <stdlib.h>
#include <string.h>
#include <time.h>
#include <unistd.h>

__dead static void usage(void);

int
main(int ac, char *av[])
{
        bthcid_pin_response_t rp;
        struct sockaddr_un un;
        struct sockaddr_bt bt;
        char *pin = NULL;
        int ch, s, len, pair;

        memset(&rp, 0, sizeof(rp));
        len = -1;
        pair = 0;

        memset(&un, 0, sizeof(un));
        un.sun_len = sizeof(un);
        un.sun_family = AF_LOCAL;
        strlcpy(un.sun_path, BTHCID_SOCKET_NAME, sizeof(un.sun_path));

        while ((ch = getopt(ac, av, "a:d:l:Pp:rs:")) != -1) {
                switch (ch) {
                case 'a':
                        if (!bt_aton(optarg, &rp.raddr)) {
                                struct hostent  *he = NULL;

                                if ((he = bt_gethostbyname(optarg)) == NULL)
                                        errx(EXIT_FAILURE, "%s: %s", optarg,
                                                        hstrerror(h_errno));

                                bdaddr_copy(&rp.raddr, (bdaddr_t *)he->h_addr);
                        }
                        break;

                case 'd':
                        if (!bt_devaddr(optarg, &rp.laddr))
                                err(EXIT_FAILURE, "%s", optarg);

                        break;

                case 'l':
                        len = atoi(optarg);
                        if (len < 1 || len > HCI_PIN_SIZE)
                                errx(EXIT_FAILURE, "Invalid PIN length");

                        break;

                case 'P':
                        pair++;
                        break;

                case 'p':
                        pin = optarg;
                        break;

                case 'r':
                        if (len == -1)
                                len = 4;

                        break;

                case 's':
                        strlcpy(un.sun_path, optarg, sizeof(un.sun_path));
                        break;

                default:
                        usage();
                }
        }

        if (bdaddr_any(&rp.raddr))
                usage();

        if (pin == NULL) {
                if (len == -1)
                        usage();

                srandom(time(NULL));

                pin = (char *)rp.pin;
                while (len-- > 0)
                        *pin++ = '0' + (random() % 10);

                printf("PIN: %.*s\n", HCI_PIN_SIZE, rp.pin);
        } else {
                if (len != -1)
                        usage();
                len = strlen(pin);
                if (len > HCI_PIN_SIZE)
                        len = HCI_PIN_SIZE;

                memcpy(rp.pin, pin, len);
        }

        s = socket(PF_LOCAL, SOCK_STREAM, 0);
        if (s == -1)
                err(EXIT_FAILURE, "socket");

        if (connect(s, (struct sockaddr *)&un, sizeof(un)) == -1)
                err(EXIT_FAILURE, "connect(\"%s\")", un.sun_path);
        
        if (send(s, &rp, sizeof(rp), 0) != sizeof(rp))
                err(EXIT_FAILURE, "send");

        close(s);

        if (pair == 0) 
                exit(EXIT_SUCCESS);

        s = socket(PF_BLUETOOTH, SOCK_SEQPACKET, BTPROTO_L2CAP);
        if (s == -1)
                err(EXIT_FAILURE, "socket");

        ch = L2CAP_LM_AUTH;
        if (setsockopt(s, BTPROTO_L2CAP, SO_L2CAP_LM, &ch, sizeof(ch)) == -1)
                err(EXIT_FAILURE, "SO_L2CAP_LM");

        memset(&bt, 0, sizeof(bt));
        bt.bt_len = sizeof(bt);
        bt.bt_family = AF_BLUETOOTH;
        bdaddr_copy(&bt.bt_bdaddr, &rp.laddr);
        if (bind(s, (struct sockaddr *)&bt, sizeof(bt)) == -1)
                err(EXIT_FAILURE, "bind");

        fprintf(stdout, "Pairing.. ");
        fflush(stdout);

        bt.bt_psm = L2CAP_PSM_SDP;
        bdaddr_copy(&bt.bt_bdaddr, &rp.raddr);
        if (connect(s, (struct sockaddr *)&bt, sizeof(bt)) == -1) {
                fprintf(stdout, "failed (%s)\n", strerror(errno));
                exit(EXIT_FAILURE);
        }

        close(s);
        fprintf(stdout, "done\n");

        exit(EXIT_SUCCESS);
}

static void
usage(void)
{

        fprintf(stderr,
                "usage: %s [-P] [-d device] [-s socket] {-p pin | -r [-l len]} -a addr\n"
                "", getprogname());

        exit(EXIT_FAILURE);
}