612 lines
17 KiB
C
612 lines
17 KiB
C
/****************************************************************************
|
|
* apps/netutils/pppd/lcp.c
|
|
* Link Configuration Protocol Handler
|
|
*
|
|
* Version - 0.1 Original Version June 3, 2000 -
|
|
* Copyright (C) 2000, Mycal Labs www.mycal.com - -
|
|
* Copyright (c) 2003, Mike Johnson, Mycal Labs, www.mycal.net
|
|
* All rights reserved.
|
|
*
|
|
* 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. All advertising materials mentioning features or use of this software
|
|
* must display the following acknowledgement:
|
|
* This product includes software developed by Mike Johnson/Mycal Labs
|
|
* www.mycal.net.
|
|
* 4. The name of the author may not be used to endorse or promote
|
|
* products derived from this software without specific prior
|
|
* written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``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 THE AUTHOR 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.
|
|
*
|
|
****************************************************************************/
|
|
|
|
/****************************************************************************
|
|
* Included Files
|
|
****************************************************************************/
|
|
|
|
#include <nuttx/config.h>
|
|
|
|
#include "ppp_conf.h"
|
|
#include "ppp_arch.h"
|
|
#include "ppp.h"
|
|
#include "ahdlc.h"
|
|
#include "lcp.h"
|
|
|
|
#include "netutils/pppd.h"
|
|
|
|
/****************************************************************************
|
|
* Pre-processor Definitions
|
|
****************************************************************************/
|
|
|
|
#if PPP_DEBUG
|
|
# define DEBUG1(x) debug_printf x
|
|
# define DEBUG2(x) debug_printf x
|
|
#else
|
|
# define DEBUG1(x)
|
|
# define DEBUG2(x)
|
|
#endif
|
|
|
|
/****************************************************************************
|
|
* Private Types
|
|
****************************************************************************/
|
|
|
|
/* We need this when we neg our direction.
|
|
* uint8_t lcp_tx_options;
|
|
*/
|
|
|
|
/* Define the supported parameters for this module here. */
|
|
|
|
static const uint8_t g_lcplist[] =
|
|
{
|
|
LPC_MAGICNUMBER,
|
|
LPC_PFC,
|
|
LPC_ACFC,
|
|
#ifdef CONFIG_NETUTILS_PPPD_PAP
|
|
LPC_AUTH,
|
|
#endif
|
|
LPC_ACCM,
|
|
LPC_MRU,
|
|
0
|
|
};
|
|
|
|
/****************************************************************************
|
|
* Private Functions
|
|
****************************************************************************/
|
|
|
|
/****************************************************************************
|
|
* lcp_init() - Initialize the LCP engine to startup values
|
|
*
|
|
****************************************************************************/
|
|
|
|
void lcp_init(struct ppp_context_s *ctx)
|
|
{
|
|
ctx->lcp_state = 0;
|
|
ctx->lcp_retry = 0;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* lcp_rx() - Receive an LCP packet and process it.
|
|
* This routine receives a LCP packet in buffer of length count.
|
|
* Process it here, support for CONF_REQ, CONF_ACK, CONF_NACK, CONF_REJ or
|
|
* TERM_REQ.
|
|
*
|
|
****************************************************************************/
|
|
|
|
void lcp_rx(struct ppp_context_s *ctx, uint8_t * buffer, uint16_t count)
|
|
{
|
|
FAR uint8_t *bptr = buffer;
|
|
FAR uint8_t *tptr;
|
|
uint8_t error = 0;
|
|
uint8_t id;
|
|
uint16_t len;
|
|
uint16_t j;
|
|
|
|
switch (*bptr++)
|
|
{
|
|
case CONF_REQ: /* config request */
|
|
|
|
/* Parse request and see if we can ACK it */
|
|
|
|
id = *bptr++;
|
|
UNUSED(id);
|
|
len = (*bptr++ << 8);
|
|
len |= *bptr++;
|
|
|
|
/* len -= 2; */
|
|
|
|
/* In case of new peer connection */
|
|
|
|
ipcp_init(ctx);
|
|
ctx->lcp_state &= ~LCP_RX_UP;
|
|
|
|
DEBUG1(("received [LCP Config Request id %u\n", id));
|
|
if (scan_packet
|
|
(ctx, (uint16_t)LCP, g_lcplist, buffer, bptr, (uint16_t)(len - 4)))
|
|
{
|
|
/* Must do the -4 here, !scan packet */
|
|
|
|
DEBUG1((" options were rejected\n"));
|
|
}
|
|
else
|
|
{
|
|
/* Lets try to implement what peer wants */
|
|
|
|
tptr = bptr;
|
|
error = 0;
|
|
|
|
/* First scan for unknown values */
|
|
|
|
while (bptr < (buffer + len))
|
|
{
|
|
switch (*bptr++)
|
|
{
|
|
case LPC_MRU: /* mru */
|
|
j = *bptr++;
|
|
j -= 2;
|
|
|
|
if (j == 2)
|
|
{
|
|
ctx->ppp_tx_mru = ((int)*bptr++) << 8;
|
|
ctx->ppp_tx_mru |= *bptr++;
|
|
DEBUG1(("<mru %d> ", ctx->ppp_tx_mru));
|
|
}
|
|
else
|
|
{
|
|
DEBUG1(("<mru ?? > "));
|
|
}
|
|
break;
|
|
|
|
case LPC_ACCM:
|
|
bptr++; /* skip length */
|
|
j = *bptr++;
|
|
j += *bptr++;
|
|
j += *bptr++;
|
|
j += *bptr++;
|
|
|
|
if (j == 0)
|
|
{
|
|
/* OK */
|
|
|
|
DEBUG1(("<asyncmap sum=0x%04x>", j));
|
|
ctx->ahdlc_flags |= PPP_TX_ASYNC_MAP;
|
|
}
|
|
else if (j == 0x3fc)
|
|
{
|
|
/* OK */
|
|
|
|
DEBUG1(("<asyncmap sum=0x%04x>, assume all ones", j));
|
|
ctx->ahdlc_flags &= ~PPP_TX_ASYNC_MAP;
|
|
}
|
|
else
|
|
{
|
|
/* Fail. We only support default or all zeros */
|
|
|
|
DEBUG1(("We only support default or all zeros ACCM "));
|
|
error = 1;
|
|
*tptr++ = LPC_ACCM;
|
|
*tptr++ = 0x6;
|
|
*tptr++ = 0;
|
|
*tptr++ = 0;
|
|
*tptr++ = 0;
|
|
*tptr++ = 0;
|
|
}
|
|
break;
|
|
|
|
#ifdef CONFIG_NETUTILS_PPPD_PAP
|
|
case LPC_AUTH:
|
|
bptr++;
|
|
if ((*bptr++ == 0xc0) && (*bptr++ == 0x23))
|
|
{
|
|
/* Negotiate PAP */
|
|
|
|
DEBUG1(("<auth pap> "));
|
|
ctx->lcp_state |= LCP_RX_AUTH;
|
|
}
|
|
else
|
|
{
|
|
/* We only support PAP */
|
|
|
|
DEBUG1(("<auth ?? >"));
|
|
error = 1;
|
|
*tptr++ = LPC_AUTH;
|
|
*tptr++ = 0x4;
|
|
*tptr++ = 0xc0;
|
|
*tptr++ = 0x23;
|
|
}
|
|
break;
|
|
#endif /* CONFIG_NETUTILS_PPPD_PAP */
|
|
|
|
case LPC_MAGICNUMBER:
|
|
DEBUG1(("<magic > "));
|
|
|
|
/* Compare incoming number to our number */
|
|
|
|
bptr++; /* For now just dump */
|
|
bptr++;
|
|
bptr++;
|
|
bptr++;
|
|
bptr++;
|
|
break;
|
|
|
|
case LPC_PFC:
|
|
bptr++;
|
|
DEBUG1(("<pcomp> "));
|
|
ctx->ahdlc_flags |= PPP_PFC;
|
|
break;
|
|
|
|
case LPC_ACFC:
|
|
bptr++;
|
|
DEBUG1(("<accomp> "));
|
|
ctx->ahdlc_flags |= PPP_ACFC;
|
|
break;
|
|
}
|
|
}
|
|
|
|
/* Error? if we we need to send a config Reject ++++ this is good
|
|
* for a subroutine.
|
|
*/
|
|
|
|
if (error)
|
|
{
|
|
/* Write the config NAK packet we've built above, take on the
|
|
* header
|
|
*/
|
|
|
|
bptr = buffer;
|
|
*bptr++ = CONF_NAK; /* Write Conf_rej */
|
|
bptr++; /* tptr++; skip over ID */
|
|
|
|
/* Write new length */
|
|
|
|
*bptr++ = 0;
|
|
*bptr = tptr - buffer;
|
|
|
|
/* Write the reject frame */
|
|
|
|
DEBUG1(("\nWriting NAK frame\n"));
|
|
|
|
/* Send packet:
|
|
* ahdlc_txz(procol,header,data,headerlen,datalen);
|
|
*/
|
|
|
|
ahdlc_tx(ctx, LCP, 0, buffer, 0, (uint16_t)(tptr - buffer));
|
|
DEBUG1(("- end NAK Write frame\n"));
|
|
}
|
|
else
|
|
{
|
|
/* If we get here then we are OK, lets send an ACK and tell the
|
|
* rest of our modules our negotiated config.
|
|
*/
|
|
|
|
DEBUG1(("\nSend ACK!\n"));
|
|
bptr = buffer;
|
|
*bptr++ = CONF_ACK; /* Write Conf_ACK */
|
|
bptr++; /* Skip ID (send same one) */
|
|
|
|
/* Set stuff */
|
|
|
|
/* ppp_flags |= tflag;
|
|
* DEBUG2("SET- stuff -- are we up? c=%d dif=%d\n", count,
|
|
* (uint16_t)(bptr-buffer));
|
|
*/
|
|
|
|
/* Write the ACK frame */
|
|
|
|
DEBUG2(("Writing ACK frame\n"));
|
|
|
|
/* Send packet:
|
|
* ahdlc_txz(procol,header,data,headerlen,datalen);
|
|
*/
|
|
|
|
ahdlc_tx(ctx, LCP, 0, buffer, 0, count /* bptr-buffer */);
|
|
DEBUG2(("- end ACK Write frame\n"));
|
|
ctx->lcp_state |= LCP_RX_UP;
|
|
}
|
|
}
|
|
break;
|
|
|
|
case CONF_ACK: /* config Ack Anytime we do an ack reset the
|
|
* timer to force send. */
|
|
DEBUG1(("LCP-ACK - "));
|
|
|
|
/* Check that ID matches one sent */
|
|
|
|
if (*bptr++ == ctx->ppp_id)
|
|
{
|
|
/* Change state to PPP up. */
|
|
|
|
DEBUG1((">>>>>>>> good ACK id up! %d\n", ctx->ppp_id));
|
|
|
|
/* Copy negotiated values over */
|
|
|
|
ctx->lcp_state |= LCP_TX_UP;
|
|
}
|
|
else
|
|
{
|
|
DEBUG1(("*************++++++++++ bad id %d\n", ctx->ppp_id));
|
|
}
|
|
break;
|
|
|
|
case CONF_NAK: /* Config Nack */
|
|
DEBUG1(("LCP-CONF NAK\n"));
|
|
ctx->ppp_id++;
|
|
break;
|
|
|
|
case CONF_REJ: /* Config Reject */
|
|
DEBUG1(("LCP-CONF REJ\n"));
|
|
ctx->ppp_id++;
|
|
break;
|
|
|
|
case TERM_REQ: /* Terminate Request */
|
|
DEBUG1(("LCP-TERM-REQ -"));
|
|
bptr = buffer;
|
|
*bptr++ = TERM_ACK; /* Write TERM_ACK */
|
|
|
|
/* Write the reject frame */
|
|
|
|
DEBUG1(("Writing TERM_ACK frame\n"));
|
|
|
|
/* Send packet ahdlc_txz(procol,header,data,headerlen,datalen); */
|
|
|
|
ahdlc_tx(ctx, LCP, 0, buffer, 0, count);
|
|
|
|
ctx->lcp_state &= ~LCP_TX_UP;
|
|
ctx->lcp_state |= LCP_TERM_PEER;
|
|
break;
|
|
|
|
case TERM_ACK:
|
|
DEBUG1(("LCP-TERM ACK\n"));
|
|
break;
|
|
|
|
case ECHO_REQ:
|
|
if ((ctx->lcp_state & LCP_TX_UP) && (ctx->lcp_state & LCP_RX_UP))
|
|
{
|
|
bptr = buffer;
|
|
*bptr++ = ECHO_REP; /* Write ECHO-REPLY */
|
|
|
|
bptr += 3; /* Skip id and length */
|
|
|
|
*bptr++ = 0; /* Zero Magic */
|
|
*bptr++ = 0;
|
|
*bptr++ = 0;
|
|
*bptr++ = 0;
|
|
|
|
/* Write the echo reply frame */
|
|
|
|
DEBUG1(("\nWriting ECHO-REPLY frame\n"));
|
|
|
|
/* Send packet ahdlc_txz(procol,header,data,headerlen,datalen); */
|
|
|
|
ahdlc_tx(ctx, LCP, 0, buffer, 0, count);
|
|
DEBUG1(("- end ECHO-REPLY Write frame\n"));
|
|
}
|
|
break;
|
|
|
|
case ECHO_REP:
|
|
DEBUG1(("LCP-ECHO REPLY\n"));
|
|
if ((ctx->lcp_state & LCP_TX_UP) && (ctx->lcp_state & LCP_RX_UP))
|
|
{
|
|
ctx->ppp_id++;
|
|
}
|
|
break;
|
|
|
|
default:
|
|
DEBUG1(("LCP unknown packet: %02x", *(bptr - 1)));
|
|
break;
|
|
}
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: lcp_disconnect
|
|
****************************************************************************/
|
|
|
|
void lcp_disconnect(struct ppp_context_s *ctx, uint8_t id)
|
|
{
|
|
uint8_t buffer[4];
|
|
FAR uint8_t *bptr = buffer;
|
|
|
|
*bptr++ = TERM_REQ;
|
|
*bptr++ = id;
|
|
*bptr++ = 0;
|
|
*bptr++ = 4;
|
|
|
|
ahdlc_tx(ctx, LCP, 0, buffer, 0, bptr - buffer);
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: lcp_echo_request
|
|
****************************************************************************/
|
|
|
|
void lcp_echo_request(struct ppp_context_s *ctx)
|
|
{
|
|
uint8_t buffer[8];
|
|
FAR uint8_t *bptr;
|
|
uint16_t t;
|
|
LCPPKT *pkt;
|
|
|
|
if ((ctx->lcp_state & LCP_TX_UP) && (ctx->lcp_state & LCP_RX_UP))
|
|
{
|
|
if ((ppp_arch_clock_seconds() - ctx->lcp_prev_seconds) >
|
|
LCP_ECHO_INTERVAL)
|
|
{
|
|
ctx->lcp_prev_seconds = ppp_arch_clock_seconds();
|
|
|
|
pkt = (LCPPKT *)buffer;
|
|
|
|
/* Configure-Request only here, write id */
|
|
|
|
pkt->code = ECHO_REQ;
|
|
pkt->id = ctx->ppp_id;
|
|
|
|
bptr = pkt->data;
|
|
|
|
*bptr++ = 0;
|
|
*bptr++ = 0;
|
|
*bptr++ = 0;
|
|
*bptr++ = 0;
|
|
|
|
/* Write length */
|
|
|
|
t = bptr - buffer;
|
|
pkt->len = htons(t); /* length here - code and ID + */
|
|
|
|
DEBUG1((" len %d\n", t));
|
|
|
|
/* Send packet
|
|
* Send packet ahdlc_txz(procol,header,data,headerlen,datalen);
|
|
*/
|
|
|
|
DEBUG1(("\nWriting ECHO-REQUEST frame\n"));
|
|
ahdlc_tx(ctx, LCP, 0, buffer, 0, t);
|
|
DEBUG1(("- end ECHO-REQUEST Write frame\n"));
|
|
}
|
|
}
|
|
}
|
|
|
|
/****************************************************************************
|
|
* lcp_task(buffer) - This routine see if a lcp request needs to be sent
|
|
* out. It uses the passed buffer to form the packet. This formed LCP
|
|
* request is what we negotiate for sending options on the link.
|
|
*
|
|
* Currently we negotiate : Magic Number Only, but this will change.
|
|
*
|
|
****************************************************************************/
|
|
|
|
void lcp_task(FAR struct ppp_context_s *ctx, FAR uint8_t * buffer)
|
|
{
|
|
FAR uint8_t *bptr;
|
|
uint16_t t;
|
|
LCPPKT *pkt;
|
|
|
|
/* lcp tx not up and hasn't timed out then lets see if we need to send a
|
|
* request
|
|
*/
|
|
|
|
if (!(ctx->lcp_state & LCP_TX_UP) && !(ctx->lcp_state & LCP_TX_TIMEOUT))
|
|
{
|
|
/* Check if we have a request pending */
|
|
|
|
if ((ppp_arch_clock_seconds() - ctx->lcp_prev_seconds) > LCP_TIMEOUT)
|
|
{
|
|
ctx->lcp_prev_seconds = ppp_arch_clock_seconds();
|
|
|
|
DEBUG1(("\nSending LCP request packet - "));
|
|
|
|
/* No pending request, lets build one */
|
|
|
|
pkt = (LCPPKT *)buffer;
|
|
|
|
/* Configure-Request only here, write id */
|
|
|
|
pkt->code = CONF_REQ;
|
|
pkt->id = ctx->ppp_id;
|
|
|
|
bptr = pkt->data;
|
|
|
|
/* Write options */
|
|
|
|
*bptr++ = LPC_ACCM;
|
|
*bptr++ = 0x6;
|
|
*bptr++ = 0xff;
|
|
*bptr++ = 0xff;
|
|
*bptr++ = 0xff;
|
|
*bptr++ = 0xff;
|
|
|
|
#if 0
|
|
/* Write magic number */
|
|
|
|
DEBUG1(("LPC_MAGICNUMBER -"));
|
|
*bptr++ = LPC_MAGICNUMBER;
|
|
*bptr++ = 0x6;
|
|
|
|
/* bptr++ = random_rand() & 0xff;
|
|
* bptr++ = random_rand() & 0xff;
|
|
* bptr++ = random_rand() & 0xff;
|
|
* bptr++ = random_rand() & 0xff;
|
|
*/
|
|
|
|
*bptr++ = 0x11;
|
|
*bptr++ = 0x11;
|
|
*bptr++ = 0x11;
|
|
*bptr++ = 0x11;
|
|
#endif
|
|
|
|
#if 0
|
|
/* Authentication protocol */
|
|
|
|
if ((lcp_tx_options & LCP_OPT_AUTH) && 0)
|
|
{
|
|
/* If turned on, we only negotiate PAP */
|
|
|
|
*bptr++ = LPC_AUTH;
|
|
*bptr++ = 0x4;
|
|
*bptr++ = 0xc0;
|
|
*bptr++ = 0x23;
|
|
}
|
|
|
|
/* PFC */
|
|
|
|
if ((lcp_tx_options & LCP_OPT_PFC) && 0)
|
|
{
|
|
/* If turned on, we only negotiate PAP */
|
|
|
|
*bptr++ = LPC_PFC;
|
|
*bptr++ = 0x2;
|
|
}
|
|
|
|
/* ACFC */
|
|
|
|
if ((lcp_tx_options & LCP_OPT_ACFC) && 0)
|
|
{
|
|
/* If turned on, we only negotiate PAP */
|
|
|
|
*bptr++ = LPC_ACFC;
|
|
*bptr++ = 0x2;
|
|
}
|
|
#endif
|
|
|
|
/* Write length */
|
|
|
|
t = bptr - buffer;
|
|
pkt->len = htons(t); /* length here - code and ID + */
|
|
|
|
DEBUG1((" len %d\n", t));
|
|
|
|
/* Send packet
|
|
* Send packet ahdlc_txz(procol,header,data,headerlen,datalen);
|
|
*/
|
|
|
|
ahdlc_tx(ctx, LCP, 0, buffer, 0, t);
|
|
|
|
/* Inc retry */
|
|
|
|
ctx->lcp_retry++;
|
|
|
|
/* Have we timed out? */
|
|
|
|
if (ctx->lcp_retry > LCP_RETRY_COUNT)
|
|
{
|
|
ctx->lcp_state |= LCP_TX_TIMEOUT;
|
|
}
|
|
}
|
|
}
|
|
}
|