/*
* Configure-Nak or Configure-Reject received.
*/
static void LcpRxConfNakRej(NUTDEVICE * dev, uint8_t id, NETBUF * nb, uint8_t rejected)
{
PPPDCB *dcb = dev->dev_dcb;
XCPOPT *xcpo;
uint16_t xcpl;
/*
* Ignore, if we are not expecting this id.
*/
if (id != dcb->dcb_reqid || dcb->dcb_acked) {
NutNetBufFree(nb);
return;
}
/*
* TODO: Process acked options.
*/
dcb->dcb_acked = 1;
xcpo = nb->nb_ap.vp;
xcpl = nb->nb_ap.sz;
while (xcpl >= 2) {
xcpl -= xcpo->xcpo_len;
xcpo = (XCPOPT *) ((char *) xcpo + xcpo->xcpo_len);
}
NutNetBufFree(nb);
switch (dcb->dcb_lcp_state) {
case PPPS_CLOSED:
case PPPS_STOPPED:
/*
* Go away, we're closed.
*/
NutLcpOutput(dev, XCP_TERMACK, id, 0);
break;
case PPPS_REQSENT:
case PPPS_ACKSENT:
/* They didn't agree to what we wanted - try another request */
LcpTxConfReq(dev, ++dcb->dcb_reqid, rejected);
break;
case PPPS_ACKRCVD:
/* Got a Nak/reject when we had already had an Ack?? oh well... */
LcpTxConfReq(dev, ++dcb->dcb_reqid, 0);
dcb->dcb_lcp_state = PPPS_REQSENT;
break;
case PPPS_OPENED:
/*
* Go down and restart negotiation.
*/
IpcpLowerDown(dev);
LcpTxConfReq(dev, ++dcb->dcb_reqid, 0);
dcb->dcb_lcp_state = PPPS_REQSENT;
break;
}
}
/*
* Received an Echo-Request.
*/
static void LcpRxEchoReq(NUTDEVICE * dev, uint8_t id, NETBUF * nb)
{
PPPDCB *dcb = dev->dev_dcb;
if (dcb->dcb_lcp_state != PPPS_OPENED) {
NutNetBufFree(nb);
} else {
/* Use local magic number. */
memcpy(nb->nb_ap.vp, &dcb->dcb_loc_magic, sizeof(uint32_t));
NutLcpOutput(dev, LCP_ERP, id, nb);
}
}
/*
* Send a Protocol-Reject for some protocol.
*/
void LcpTxProtRej(NUTDEVICE * dev, uint16_t protocol, NETBUF * nb)
{
PPPDCB *dcb = dev->dev_dcb;
NETBUF *nbr;
uint16_t *sp;
if ((nbr = NutNetBufAlloc(0, NBAF_APPLICATION, nb->nb_nw.sz)) != 0) {
sp = nbr->nb_ap.vp;
*sp++ = htons(protocol);
memcpy(sp, nb->nb_nw.vp, nb->nb_nw.sz - 2);
NutNetBufFree(nb);
NutLcpOutput(dev, LCP_PROTREJ, ++dcb->dcb_rejid, nbr);
} else {
NutNetBufFree(nb);
}
}
/*
* Send a Configure-Request.
*/
void LcpTxConfReq(NUTDEVICE * dev, uint8_t id, uint8_t rejected)
{
PPPDCB *dcb = dev->dev_dcb;
XCPOPT *xcpo;
NETBUF *nb;
/*
* Not currently negotiating, reset options.
*/
if (dcb->dcb_lcp_state != PPPS_REQSENT && dcb->dcb_lcp_state != PPPS_ACKRCVD && dcb->dcb_lcp_state != PPPS_ACKSENT) {
LcpResetOptions(dev);
dcb->dcb_lcp_naks = 0;
}
dcb->dcb_acked = 0;
dcb->dcb_retries = 0;
/*
* Create the request.
*/
if ((nb = NutNetBufAlloc(0, NBAF_APPLICATION, rejected ? 6 : 12)) != 0) {
xcpo = nb->nb_ap.vp;
xcpo->xcpo_type = LCP_ASYNCMAP;
xcpo->xcpo_len = 6;
xcpo->xcpo_.ul = htonl(LCP_DEFOPT_ASYNCMAP); /* Should this be "= 0;" instead? */
/*
* This is a temporary hack. In the initial version
* we sent the ASYNCMAP only and never expected any
* rejects. The MAGICNUMBER had been added later
* to support echo requests, but some servers reject
* this option. Now we still do not provide full
* reject processing but blindly assume, that the
* MAGICNUMBER is the rejected option.
*/
if (!rejected) {
xcpo = (XCPOPT *) ((char *) xcpo + xcpo->xcpo_len);
xcpo->xcpo_type = LCP_MAGICNUMBER;
xcpo->xcpo_len = 6;
xcpo->xcpo_.ul = dcb->dcb_neg_magic;
}
NutLcpOutput(dev, XCP_CONFREQ, id, nb);
}
}
/*
* Terminate-Request received.
*/
static void LcpRxTermReq(NUTDEVICE * dev, uint8_t id, NETBUF * nb)
{
PPPDCB *dcb = dev->dev_dcb;
NutNetBufFree(nb);
switch (dcb->dcb_lcp_state) {
case PPPS_ACKRCVD:
case PPPS_ACKSENT:
dcb->dcb_lcp_state = PPPS_REQSENT; /* Start over but keep trying */
break;
case PPPS_OPENED:
IpcpLowerDown(dev);
dcb->dcb_lcp_state = PPPS_STOPPING;
break;
}
NutLcpOutput(dev, XCP_TERMACK, id, 0);
}
/*
* Configure-Ack received.
* Never called in INITIAL or STARTING phase.
*/
static void LcpRxConfAck(NUTDEVICE * dev, uint8_t id, NETBUF * nb)
{
PPPDCB *dcb = dev->dev_dcb;
XCPOPT *xcpo;
uint16_t xcpl;
/*
* Check if this is a valid ack.
*/
if (id == dcb->dcb_reqid && dcb->dcb_acked == 0) {
dcb->dcb_acked = 1;
xcpo = nb->nb_ap.vp;
xcpl = nb->nb_ap.sz;
while (xcpl >= 2) {
switch (xcpo->xcpo_type) {
case LCP_MRU:
if (htons(xcpo->xcpo_.us) != 1500)
dcb->dcb_acked = 0;
break;
case LCP_ASYNCMAP:
//if(ntohl(xcpo->xcpo_.ul) != )
// dcb->dcb_acked = 0;
break;
case LCP_AUTHTYPE:
if (htons(xcpo->xcpo_.us) != dcb->dcb_auth)
dcb->dcb_acked = 0;
break;
case LCP_MAGICNUMBER:
if (xcpo->xcpo_.ul == dcb->dcb_neg_magic) {
dcb->dcb_loc_magic = dcb->dcb_neg_magic;
} else {
dcb->dcb_acked = 0;
}
break;
case LCP_PCOMPRESSION:
dcb->dcb_acked = 0;
break;
case LCP_ACCOMPRESSION:
dcb->dcb_acked = 0;
break;
}
xcpl -= xcpo->xcpo_len;
xcpo = (XCPOPT *) ((char *) xcpo + xcpo->xcpo_len);
}
}
/*
* We don't need the NETBUF any more.
*/
NutNetBufFree(nb);
/*
* Ignore invalid acks.
*/
if (dcb->dcb_acked == 0)
return;
switch (dcb->dcb_lcp_state) {
case PPPS_CLOSED:
case PPPS_STOPPED:
/*
* Go away, we're closed.
*/
NutLcpOutput(dev, XCP_TERMACK, id, 0);
break;
case PPPS_REQSENT:
dcb->dcb_lcp_state = PPPS_ACKRCVD;
dcb->dcb_retries = 0;
break;
case PPPS_ACKRCVD:
LcpTxConfReq(dev, ++dcb->dcb_reqid, 0);
dcb->dcb_lcp_state = PPPS_REQSENT;
break;
case PPPS_ACKSENT:
/*
* ACK sent and ACK received.
*/
dcb->dcb_lcp_state = PPPS_OPENED;
if (dcb->dcb_auth == PPP_PAP)
PapTxAuthReq(dev, ++dcb->dcb_reqid);
else
IpcpLowerUp(dev);
break;
case PPPS_OPENED:
/*
* Go down and restart negotiation.
*/
IpcpLowerDown(dev);
LcpTxConfReq(dev, ++dcb->dcb_reqid, 0);
dcb->dcb_lcp_state = PPPS_REQSENT;
break;
}
}
/*
* Received Configure-Request.
*/
static void LcpRxConfReq(NUTDEVICE * dev, uint8_t id, NETBUF * nb)
{
PPPDCB *dcb = dev->dev_dcb;
int rc = XCP_CONFACK;
XCPOPT *xcpo;
uint16_t xcpl;
XCPOPT *xcpr;
uint16_t xcps;
uint16_t len = 0;
uint16_t sval;
uint_fast8_t i;
switch (dcb->dcb_lcp_state) {
case PPPS_CLOSED:
/*
* Go away, we're closed.
*/
NutNetBufFree(nb);
NutLcpOutput(dev, XCP_TERMACK, id, 0);
return;
case PPPS_CLOSING:
case PPPS_STOPPING:
/*
* Silently ignore configuration requests while going down.
*/
NutNetBufFree(nb);
return;
case PPPS_OPENED:
/*
* Go down and restart negotiation.
*/
IpcpLowerDown(dev);
LcpTxConfReq(dev, ++dcb->dcb_reqid, 0);
break;
case PPPS_STOPPED:
/*
* Negotiation started by our peer.
*/
LcpTxConfReq(dev, ++dcb->dcb_reqid, 0);
dcb->dcb_lcp_state = PPPS_REQSENT;
break;
}
/*
* Check if there is anything to reject.
*/
xcpo = nb->nb_ap.vp;
xcpl = nb->nb_ap.sz;
xcpr = nb->nb_ap.vp;
xcps = 0;
while (xcpl >= 2) {
len = xcpo->xcpo_len;
if (len > xcpl)
len = xcpl;
else {
switch (xcpo->xcpo_type) {
case LCP_MRU:
if (xcpo->xcpo_len == 4)
len = 0;
break;
case LCP_MAGICNUMBER:
case LCP_ASYNCMAP:
if (xcpo->xcpo_len == 6)
len = 0;
break;
case LCP_AUTHTYPE:
if (xcpo->xcpo_len >= 4)
len = 0;
break;
case LCP_PCOMPRESSION:
len = 0;
break;
case LCP_ACCOMPRESSION:
len = 0;
break;
}
}
if (len) {
if (xcpr != xcpo) {
xcpr->xcpo_type = xcpo->xcpo_type;
xcpr->xcpo_len = len;
for (i = 0; i < len - 2; i++)
/* bug fix by Michel Hendriks. Thanks! */
xcpr->xcpo_.uc[i] = xcpo->xcpo_.uc[i];
}
xcpr = (XCPOPT *) ((char *) xcpr + len);
xcps += len;
}
xcpl -= xcpo->xcpo_len;
xcpo = (XCPOPT *) ((char *) xcpo + xcpo->xcpo_len);
}
if (xcps) {
nb->nb_ap.sz = xcps;
rc = XCP_CONFREJ;
}
/*
* Check if there is anything to negotiate.
*/
else {
xcpo = nb->nb_ap.vp;
xcpl = nb->nb_ap.sz;
xcpr = nb->nb_ap.vp;
xcps = 0;
len = 0;
while (xcpl >= 2) {
switch (xcpo->xcpo_type) {
case LCP_MRU:
if ((sval = htons(xcpo->xcpo_.us)) < MIN_LCPMRU) {
len = 4;
xcpr->xcpo_.us = ntohs(MIN_LCPMRU);
} else
dcb->dcb_rem_mru = sval;
break;
case LCP_ASYNCMAP:
dcb->dcb_accm = ntohl(xcpo->xcpo_.ul);
break;
case LCP_AUTHTYPE:
if (htons(xcpo->xcpo_.us) != PPP_PAP) {
len = 4;
xcpr->xcpo_.us = htons(PPP_PAP);
}
break;
case LCP_MAGICNUMBER:
if (xcpo->xcpo_.ul == dcb->dcb_loc_magic || xcpo->xcpo_.ul == dcb->dcb_neg_magic) {
dcb->dcb_rem_magic = new_magic;
len = 6;
xcpr->xcpo_.ul = dcb->dcb_rem_magic;
}
break;
case LCP_PCOMPRESSION:
dcb->dcb_compr |= PPP_PFC;
break;
case LCP_ACCOMPRESSION:
dcb->dcb_compr |= PPP_ACFC;
break;
}
if (len) {
if (xcpr != xcpo) {
xcpr->xcpo_type = xcpo->xcpo_type;
xcpr->xcpo_len = len;
}
xcpr = (XCPOPT *) ((char *) xcpr + len);
xcps += len;
len = 0;
}
xcpl -= xcpo->xcpo_len;
xcpo = (XCPOPT *) ((char *) xcpo + xcpo->xcpo_len);
}
if (xcps) {
nb->nb_ap.sz = xcps;
rc = XCP_CONFNAK;
}
}
NutLcpOutput(dev, rc, id, nb);
if (rc == XCP_CONFACK) {
if (dcb->dcb_lcp_state == PPPS_ACKRCVD) {
dcb->dcb_lcp_state = PPPS_OPENED;
if (dcb->dcb_auth == PPP_PAP)
PapTxAuthReq(dev, ++dcb->dcb_reqid);
else
IpcpLowerUp(dev);
} else
dcb->dcb_lcp_state = PPPS_ACKSENT;
dcb->dcb_lcp_naks = 0;
} else if (dcb->dcb_lcp_state != PPPS_ACKRCVD)
dcb->dcb_lcp_state = PPPS_REQSENT;
}
