summaryrefslogtreecommitdiff
path: root/accel-pptpd/ppp/ppp_lcp.c
diff options
context:
space:
mode:
authorDmitry Kozlov <xeb@mail.ru>2011-01-05 15:18:59 +0300
committerDmitry Kozlov <xeb@mail.ru>2011-01-05 15:18:59 +0300
commitf28cb1b0a926f1ea98700b7871537ad1793511fd (patch)
treebaf35570bc6b38b6fab5b6524e8f19f58f71e57f /accel-pptpd/ppp/ppp_lcp.c
parent2fdf3586c13a72c36f9530084962e29d57dc0329 (diff)
downloadaccel-ppp-xebd-f28cb1b0a926f1ea98700b7871537ad1793511fd.tar.gz
accel-ppp-xebd-f28cb1b0a926f1ea98700b7871537ad1793511fd.zip
rename accel-pptp to accel-ppp
Diffstat (limited to 'accel-pptpd/ppp/ppp_lcp.c')
-rw-r--r--accel-pptpd/ppp/ppp_lcp.c847
1 files changed, 0 insertions, 847 deletions
diff --git a/accel-pptpd/ppp/ppp_lcp.c b/accel-pptpd/ppp/ppp_lcp.c
deleted file mode 100644
index e40e321..0000000
--- a/accel-pptpd/ppp/ppp_lcp.c
+++ /dev/null
@@ -1,847 +0,0 @@
-#include <stdlib.h>
-#include <string.h>
-#include <sys/socket.h>
-#include <arpa/inet.h>
-#include "linux_ppp.h"
-
-#include "triton.h"
-
-#include "log.h"
-
-#include "ppp.h"
-#include "ppp_lcp.h"
-#include "events.h"
-
-#include "memdebug.h"
-
-struct recv_opt_t
-{
- struct list_head entry;
- struct lcp_opt_hdr_t *hdr;
- int len;
- int state;
- struct lcp_option_t *lopt;
-};
-
-static int conf_echo_interval = 0;
-static int conf_echo_failure = 3;
-
-static LIST_HEAD(option_handlers);
-static struct ppp_layer_t lcp_layer;
-
-static void lcp_layer_up(struct ppp_fsm_t*);
-static void lcp_layer_down(struct ppp_fsm_t*);
-static void lcp_layer_finished(struct ppp_fsm_t*);
-static int send_conf_req(struct ppp_fsm_t*);
-static void send_conf_ack(struct ppp_fsm_t*);
-static void send_conf_nak(struct ppp_fsm_t*);
-static void send_conf_rej(struct ppp_fsm_t*);
-static void send_code_rej(struct ppp_fsm_t*);
-static void start_echo(struct ppp_lcp_t *lcp);
-static void stop_echo(struct ppp_lcp_t *lcp);
-static void send_term_req(struct ppp_fsm_t *fsm);
-static void send_term_ack(struct ppp_fsm_t *fsm);
-static void lcp_recv(struct ppp_handler_t*);
-
-static void lcp_options_init(struct ppp_lcp_t *lcp)
-{
- struct lcp_option_t *lopt;
- struct lcp_option_handler_t *h;
-
- INIT_LIST_HEAD(&lcp->options);
-
- lcp->conf_req_len = sizeof(struct lcp_hdr_t);
-
- list_for_each_entry(h, &option_handlers, entry) {
- lopt = h->init(lcp);
- if (lopt) {
- lopt->h = h;
- list_add_tail(&lopt->entry, &lcp->options);
- lcp->conf_req_len += lopt->len;
- }
- }
-}
-
-static void lcp_options_free(struct ppp_lcp_t *lcp)
-{
- struct lcp_option_t *lopt;
-
- while (!list_empty(&lcp->options)) {
- lopt = list_entry(lcp->options.next, typeof(*lopt), entry);
- list_del(&lopt->entry);
- lopt->h->free(lcp, lopt);
- }
-}
-
-static struct ppp_layer_data_t *lcp_layer_init(struct ppp_t *ppp)
-{
- struct ppp_lcp_t *lcp = _malloc(sizeof(*lcp));
- memset(lcp, 0, sizeof(*lcp));
-
- log_ppp_debug("lcp_layer_init\n");
-
- lcp->ppp = ppp;
- lcp->fsm.ppp = ppp;
-
- lcp->hnd.proto = PPP_LCP;
- lcp->hnd.recv = lcp_recv;
-
- ppp_register_chan_handler(ppp, &lcp->hnd);
-
- lcp->fsm.proto = PPP_LCP;
- ppp_fsm_init(&lcp->fsm);
-
- lcp->fsm.layer_up = lcp_layer_up;
- lcp->fsm.layer_down = lcp_layer_down;
- lcp->fsm.layer_finished = lcp_layer_finished;
- lcp->fsm.send_conf_req = send_conf_req;
- lcp->fsm.send_conf_ack = send_conf_ack;
- lcp->fsm.send_conf_nak = send_conf_nak;
- lcp->fsm.send_conf_rej = send_conf_rej;
- lcp->fsm.send_code_rej = send_code_rej;
- lcp->fsm.send_term_req = send_term_req;
- lcp->fsm.send_term_ack = send_term_ack;
-
- INIT_LIST_HEAD(&lcp->ropt_list);
-
- return &lcp->ld;
-}
-
-int lcp_layer_start(struct ppp_layer_data_t *ld)
-{
- struct ppp_lcp_t *lcp = container_of(ld, typeof(*lcp), ld);
-
- log_ppp_debug("lcp_layer_start\n");
-
- lcp_options_init(lcp);
- ppp_fsm_lower_up(&lcp->fsm);
- if (ppp_fsm_open(&lcp->fsm))
- return -1;
-
- return 0;
-}
-
-static void _lcp_layer_finished(struct ppp_lcp_t *lcp)
-{
- ppp_layer_finished(lcp->ppp, &lcp->ld);
-}
-
-void lcp_layer_finish(struct ppp_layer_data_t *ld)
-{
- struct ppp_lcp_t *lcp = container_of(ld,typeof(*lcp),ld);
-
- log_ppp_debug("lcp_layer_finish\n");
-
- if (lcp->started) {
- stop_echo(lcp);
- ppp_fsm_close(&lcp->fsm);
- } else
- triton_context_call(lcp->ppp->ctrl->ctx, (triton_event_func)_lcp_layer_finished, lcp);
-}
-
-void lcp_layer_free(struct ppp_layer_data_t *ld)
-{
- struct ppp_lcp_t *lcp = container_of(ld, typeof(*lcp), ld);
-
- log_ppp_debug("lcp_layer_free\n");
-
- stop_echo(lcp);
- ppp_unregister_handler(lcp->ppp, &lcp->hnd);
- lcp_options_free(lcp);
- ppp_fsm_free(&lcp->fsm);
- triton_cancel_call(lcp->ppp->ctrl->ctx, (triton_event_func)_lcp_layer_finished);
-
- _free(lcp);
-}
-
-static void lcp_layer_up(struct ppp_fsm_t *fsm)
-{
- struct ppp_lcp_t *lcp = container_of(fsm, typeof(*lcp), fsm);
-
- log_ppp_debug("lcp_layer_started\n");
-
- if (!lcp->started) {
- lcp->started = 1;
- ppp_layer_started(lcp->ppp, &lcp->ld);
- }
- start_echo(lcp);
-}
-
-static void lcp_layer_down(struct ppp_fsm_t *fsm)
-{
- struct ppp_lcp_t *lcp = container_of(fsm, typeof(*lcp), fsm);
- //ppp_fsm_close(&lcp->fsm);
- stop_echo(lcp);
- //ppp_layer_finished(lcp->ppp,&lcp->ld);
-}
-
-static void lcp_layer_finished(struct ppp_fsm_t *fsm)
-{
- struct ppp_lcp_t *lcp = container_of(fsm, typeof(*lcp), fsm);
-
- log_ppp_debug("lcp_layer_finished\n");
-
- stop_echo(lcp);
- if (lcp->started) {
- lcp->started = 0;
- if (lcp->ppp->terminating)
- ppp_layer_finished(lcp->ppp, &lcp->ld);
- else
- ppp_terminate(lcp->ppp, TERM_NAS_ERROR, 0);
- } else
- ppp_terminate(lcp->ppp, TERM_NAS_ERROR, 0);
-}
-
-static void print_ropt(struct recv_opt_t *ropt)
-{
- int i;
- uint8_t *ptr = (uint8_t*)ropt->hdr;
-
- log_ppp_info2("<");
- for (i = 0; i < ropt->len; i++) {
- log_ppp_info2(" %x", ptr[i]);
- }
- log_ppp_info2(" >");
-}
-
-static int send_conf_req(struct ppp_fsm_t *fsm)
-{
- struct ppp_lcp_t *lcp = container_of(fsm, typeof(*lcp), fsm);
- uint8_t *buf = _malloc(lcp->conf_req_len), *ptr = buf;
- struct lcp_hdr_t *lcp_hdr = (struct lcp_hdr_t*)ptr;
- struct lcp_option_t *lopt;
- int n;
-
- lcp_hdr->proto = htons(PPP_LCP);
- lcp_hdr->code = CONFREQ;
- lcp_hdr->id = ++lcp->fsm.id;
- lcp_hdr->len = 0;
-
- ptr += sizeof(*lcp_hdr);
-
- list_for_each_entry(lopt, &lcp->options, entry) {
- n = lopt->h->send_conf_req(lcp, lopt, ptr);
- if (n < 0)
- return -1;
- if (n) {
- ptr += n;
- lopt->print = 1;
- } else
- lopt->print = 0;
- }
-
- if (conf_ppp_verbose) {
- log_ppp_info2("send [LCP ConfReq id=%x", lcp_hdr->id);
- list_for_each_entry(lopt,&lcp->options,entry) {
- if (lopt->print) {
- log_ppp_info2(" ");
- lopt->h->print(log_ppp_info2, lopt, NULL);
- }
- }
- log_ppp_info2("]\n");
- }
-
- lcp_hdr->len = htons(ptr - buf - 2);
- ppp_chan_send(lcp->ppp, lcp_hdr, ptr-buf);
-
- _free(buf);
-
- return 0;
-}
-
-static void send_conf_ack(struct ppp_fsm_t *fsm)
-{
- struct ppp_lcp_t *lcp = container_of(fsm, typeof(*lcp), fsm);
- struct lcp_hdr_t *hdr = (struct lcp_hdr_t*)lcp->ppp->chan_buf;
-
- hdr->code = CONFACK;
-
- if (conf_ppp_verbose)
- log_ppp_info2("send [LCP ConfAck id=%x ]\n", lcp->fsm.recv_id);
-
- ppp_chan_send(lcp->ppp, hdr, ntohs(hdr->len) + 2);
-}
-
-static void send_code_rej(struct ppp_fsm_t *fsm)
-{
- struct ppp_lcp_t *lcp = container_of(fsm, typeof(*lcp), fsm);
- struct lcp_hdr_t *hdr = (struct lcp_hdr_t*)lcp->ppp->chan_buf;
-
- hdr->code = CONFACK;
-
- if (conf_ppp_verbose)
- log_ppp_info2("send [LCP CodeRej %x id=%x ]\n",hdr->code, lcp->fsm.recv_id);
-
- ppp_chan_send(lcp->ppp, hdr, ntohs(hdr->len) + 2);
-}
-
-static void send_conf_nak(struct ppp_fsm_t *fsm)
-{
- struct ppp_lcp_t *lcp = container_of(fsm, typeof(*lcp), fsm);
- uint8_t *buf = _malloc(lcp->conf_req_len), *ptr = buf;
- struct lcp_hdr_t *lcp_hdr = (struct lcp_hdr_t*)ptr;
- struct lcp_option_t *lopt;
-
- if (conf_ppp_verbose)
- log_ppp_info2("send [LCP ConfNak id=%x", lcp->fsm.recv_id);
-
- lcp_hdr->proto = htons(PPP_LCP);
- lcp_hdr->code = CONFNAK;
- lcp_hdr->id = lcp->fsm.recv_id;
- lcp_hdr->len = 0;
-
- ptr += sizeof(*lcp_hdr);
-
- list_for_each_entry(lopt, &lcp->options, entry) {
- if (lopt->state == LCP_OPT_NAK) {
- ptr+=lopt->h->send_conf_nak(lcp,lopt,ptr);
-
- if (conf_ppp_verbose) {
- log_ppp_info2(" ");
- lopt->h->print(log_ppp_info2, lopt, NULL);
- }
- }
- }
-
- if (conf_ppp_verbose)
- log_ppp_info2("]\n");
-
- lcp_hdr->len = htons(ptr - buf - 2);
- ppp_chan_send(lcp->ppp, lcp_hdr,ptr - buf);
-
- _free(buf);
-}
-
-static void send_conf_rej(struct ppp_fsm_t *fsm)
-{
- struct ppp_lcp_t *lcp = container_of(fsm, typeof(*lcp), fsm);
- uint8_t *buf = _malloc(lcp->ropt_len + sizeof(struct lcp_hdr_t)), *ptr = buf;
- struct lcp_hdr_t *lcp_hdr = (struct lcp_hdr_t*)ptr;
- struct recv_opt_t *ropt;
-
- if (conf_ppp_verbose)
- log_ppp_info2("send [LCP ConfRej id=%x ", lcp->fsm.recv_id);
-
- lcp_hdr->proto = htons(PPP_LCP);
- lcp_hdr->code = CONFREJ;
- lcp_hdr->id = lcp->fsm.recv_id;
- lcp_hdr->len = 0;
-
- ptr += sizeof(*lcp_hdr);
-
- list_for_each_entry(ropt, &lcp->ropt_list, entry) {
- if (ropt->state == LCP_OPT_REJ) {
- memcpy(ptr, ropt->hdr, ropt->len);
- ptr += ropt->len;
-
- if (conf_ppp_verbose) {
- log_ppp_info2(" ");
- if (ropt->lopt)
- ropt->lopt->h->print(log_ppp_info2, ropt->lopt, (uint8_t*)ropt->hdr);
- else
- print_ropt(ropt);
- }
- }
- }
-
- if (conf_ppp_verbose)
- log_ppp_info2("]\n");
-
- lcp_hdr->len = htons(ptr - buf - 2);
- ppp_chan_send(lcp->ppp, lcp_hdr, ptr - buf);
-
- _free(buf);
-}
-
-static int lcp_recv_conf_req(struct ppp_lcp_t *lcp, uint8_t *data, int size)
-{
- struct lcp_opt_hdr_t *hdr;
- struct recv_opt_t *ropt;
- struct lcp_option_t *lopt;
- int r, ret = 1;
-
- lcp->ropt_len = size;
-
- while (size > 0) {
- hdr = (struct lcp_opt_hdr_t *)data;
-
- ropt = _malloc(sizeof(*ropt));
- memset(ropt, 0, sizeof(*ropt));
-
- if (hdr->len > size)
- ropt->len = size;
- else
- ropt->len = hdr->len;
-
- ropt->hdr = hdr;
- ropt->state = LCP_OPT_NONE;
- list_add_tail(&ropt->entry, &lcp->ropt_list);
-
- data += ropt->len;
- size -= ropt->len;
- }
-
- list_for_each_entry(lopt, &lcp->options, entry)
- lopt->state = LCP_OPT_NONE;
-
- if (conf_ppp_verbose)
- log_ppp_info2("recv [LCP ConfReq id=%x", lcp->fsm.recv_id);
-
- list_for_each_entry(ropt, &lcp->ropt_list, entry) {
- list_for_each_entry(lopt, &lcp->options, entry) {
- if (lopt->id == ropt->hdr->id) {
- if (conf_ppp_verbose) {
- log_ppp_info2(" ");
- lopt->h->print(log_ppp_info2, lopt, (uint8_t*)ropt->hdr);
- }
- r = lopt->h->recv_conf_req(lcp, lopt, (uint8_t*)ropt->hdr);
- lopt->state = r;
- ropt->state = r;
- ropt->lopt = lopt;
- if (r<ret)
- ret = r;
- break;
- }
- }
- if (!ropt->lopt) {
- if (conf_ppp_verbose) {
- log_ppp_info2(" ");
- print_ropt(ropt);
- }
- ropt->state=LCP_OPT_REJ;
- ret=LCP_OPT_REJ;
- }
- }
-
- if (conf_ppp_verbose)
- log_ppp_info2("]\n");
-
- /*list_for_each_entry(lopt,&lcp->options,entry)
- {
- if (lopt->state==LCP_OPT_NONE)
- {
- r=lopt->h->recv_conf_req(lcp,lopt,NULL);
- lopt->state=r;
- if (r<ret) ret=r;
- }
- }*/
-
- return ret;
-}
-
-static void lcp_free_conf_req(struct ppp_lcp_t *lcp)
-{
- struct recv_opt_t *ropt;
-
- while (!list_empty(&lcp->ropt_list)) {
- ropt = list_entry(lcp->ropt_list.next, typeof(*ropt), entry);
- list_del(&ropt->entry);
- _free(ropt);
- }
-}
-
-static int lcp_recv_conf_rej(struct ppp_lcp_t *lcp, uint8_t *data, int size)
-{
- struct lcp_opt_hdr_t *hdr;
- struct lcp_option_t *lopt;
- int res = 0;
-
- if (conf_ppp_verbose)
- log_ppp_info2("recv [LCP ConfRej id=%x", lcp->fsm.recv_id);
-
- if (lcp->fsm.recv_id != lcp->fsm.id) {
- if (conf_ppp_verbose)
- log_ppp_info2(": id mismatch ]\n");
- return 0;
- }
-
- while (size > 0) {
- hdr = (struct lcp_opt_hdr_t *)data;
-
- list_for_each_entry(lopt, &lcp->options, entry) {
- if (lopt->id == hdr->id) {
- if (conf_ppp_verbose) {
- log_ppp_info2(" ");
- lopt->h->print(log_ppp_info2, lopt, (uint8_t*)hdr);
- }
- if (!lopt->h->recv_conf_rej)
- res = -1;
- else if (lopt->h->recv_conf_rej(lcp, lopt, data))
- res = -1;
- break;
- }
- }
-
- data += hdr->len;
- size -= hdr->len;
- }
-
- if (conf_ppp_verbose)
- log_ppp_info2("]\n");
-
- return res;
-}
-
-static int lcp_recv_conf_nak(struct ppp_lcp_t *lcp, uint8_t *data, int size)
-{
- struct lcp_opt_hdr_t *hdr;
- struct lcp_option_t *lopt;
- int res = 0;
-
- if (conf_ppp_verbose)
- log_ppp_info2("recv [LCP ConfNak id=%x", lcp->fsm.recv_id);
-
- if (lcp->fsm.recv_id != lcp->fsm.id) {
- if (conf_ppp_verbose)
- log_ppp_info2(": id mismatch ]\n");
- return 0;
- }
-
- while (size > 0) {
- hdr = (struct lcp_opt_hdr_t *)data;
-
- list_for_each_entry(lopt,&lcp->options,entry) {
- if (lopt->id == hdr->id) {
- if (conf_ppp_verbose) {
- log_ppp_info2(" ");
- lopt->h->print(log_ppp_info2, lopt, data);
- }
- if (lopt->h->recv_conf_nak && lopt->h->recv_conf_nak(lcp, lopt, data))
- res = -1;
- break;
- }
- }
-
- data += hdr->len;
- size -= hdr->len;
- }
-
- if (conf_ppp_verbose)
- log_ppp_info2("]\n");
-
- return res;
-}
-
-static int lcp_recv_conf_ack(struct ppp_lcp_t *lcp, uint8_t *data, int size)
-{
- struct lcp_opt_hdr_t *hdr;
- struct lcp_option_t *lopt;
- int res=0;
-
- if (conf_ppp_verbose)
- log_ppp_info2("recv [LCP ConfAck id=%x", lcp->fsm.recv_id);
-
- if (lcp->fsm.recv_id != lcp->fsm.id) {
- if (conf_ppp_verbose)
- log_ppp_info2(": id mismatch ]\n");
- return 0;
- }
-
- while (size > 0) {
- hdr = (struct lcp_opt_hdr_t *)data;
-
- list_for_each_entry(lopt, &lcp->options, entry) {
- if (lopt->id == hdr->id) {
- if (conf_ppp_verbose) {
- log_ppp_info2(" ");
- lopt->h->print(log_ppp_info2, lopt, data);
- }
- if (!lopt->h->recv_conf_ack)
- break;
- if (lopt->h->recv_conf_ack(lcp, lopt, data))
- res = -1;
- break;
- }
- }
-
- data += hdr->len;
- size -= hdr->len;
- }
-
- if (conf_ppp_verbose)
- log_ppp_info2("]\n");
-
- return res;
-}
-
-static void lcp_recv_echo_repl(struct ppp_lcp_t *lcp, uint8_t *data, int size)
-{
- uint32_t magic = *(uint32_t *)data;
-
- if (size != 4) {
- log_ppp_error("lcp:echo: magic number size mismatch\n");
- ppp_terminate(lcp->ppp, TERM_USER_ERROR, 0);
- }
-
- if (conf_ppp_verbose)
- log_ppp_debug("recv [LCP EchoRep id=%x <magic %x>]\n", lcp->fsm.recv_id, magic);
-
- if (magic == lcp->magic) {
- log_ppp_error("lcp: echo: loop-back detected\n");
- ppp_terminate(lcp->ppp, TERM_NAS_ERROR, 0);
- }
-
- lcp->echo_sent = 0;
-}
-
-static void send_echo_reply(struct ppp_lcp_t *lcp)
-{
- struct lcp_hdr_t *hdr = (struct lcp_hdr_t*)lcp->ppp->chan_buf;
- uint32_t magic = *(uint32_t *)(hdr + 1);
-
- hdr->code = ECHOREP;
- *(uint32_t *)(hdr + 1) = lcp->magic;
-
- if (conf_ppp_verbose)
- log_ppp_debug("send [LCP EchoRep id=%x <magic %x>]\n", hdr->id, magic);
-
- ppp_chan_send(lcp->ppp, hdr, ntohs(hdr->len) + 2);
-}
-
-static void send_echo_request(struct triton_timer_t *t)
-{
- struct ppp_lcp_t *lcp = container_of(t, typeof(*lcp), echo_timer);
- struct lcp_echo_req_t
- {
- struct lcp_hdr_t hdr;
- uint32_t magic;
- } __attribute__((packed)) msg = {
- .hdr.proto = htons(PPP_LCP),
- .hdr.code = ECHOREQ,
- .hdr.id = ++lcp->fsm.id,
- .hdr.len = htons(8),
- .magic = lcp->magic,
- };
-
- if (++lcp->echo_sent > lcp->echo_failure) {
- log_ppp_warn("lcp: no echo reply\n");
- ppp_terminate(lcp->ppp, TERM_USER_ERROR, 1);
- } else {
- if (conf_ppp_verbose)
- log_ppp_debug("send [LCP EchoReq id=%x <magic %x>]\n", msg.hdr.id, msg.magic);
- ppp_chan_send(lcp->ppp,&msg,ntohs(msg.hdr.len)+2);
- }
-}
-
-static void start_echo(struct ppp_lcp_t *lcp)
-{
- lcp->echo_interval = conf_echo_interval;
- lcp->echo_failure = conf_echo_failure;
-
- lcp->echo_timer.period = lcp->echo_interval * 1000;
- lcp->echo_timer.expire = send_echo_request;
- if (lcp->echo_timer.period && !lcp->echo_timer.tpd)
- triton_timer_add(lcp->ppp->ctrl->ctx, &lcp->echo_timer, 0);
-}
-static void stop_echo(struct ppp_lcp_t *lcp)
-{
- if (lcp->echo_timer.tpd)
- triton_timer_del(&lcp->echo_timer);
-}
-
-static void send_term_req(struct ppp_fsm_t *fsm)
-{
- struct ppp_lcp_t *lcp=container_of(fsm,typeof(*lcp),fsm);
- struct lcp_hdr_t hdr = {
- .proto = htons(PPP_LCP),
- .code = TERMREQ,
- .id = ++lcp->fsm.id,
- .len = htons(4),
- };
-
- if (conf_ppp_verbose)
- log_ppp_info2("send [LCP TermReq id=%i]\n", hdr.id);
-
- ppp_chan_send(lcp->ppp, &hdr, 6);
-}
-
-static void send_term_ack(struct ppp_fsm_t *fsm)
-{
- struct ppp_lcp_t *lcp = container_of(fsm, typeof(*lcp), fsm);
- struct lcp_hdr_t hdr = {
- .proto = htons(PPP_LCP),
- .code = TERMACK,
- .id = lcp->fsm.recv_id,
- .len = htons(4),
- };
-
- if (conf_ppp_verbose)
- log_ppp_info2("send [LCP TermAck id=%i]\n", hdr.id);
-
- ppp_chan_send(lcp->ppp, &hdr, 6);
-}
-
-void lcp_send_proto_rej(struct ppp_t *ppp, uint16_t proto)
-{
- struct ppp_lcp_t *lcp = container_of(ppp_find_layer_data(ppp, &lcp_layer), typeof(*lcp), ld);
- struct rej_msg_t
- {
- struct lcp_hdr_t hdr;
- uint16_t proto;
- } __attribute__((packed)) msg = {
- .hdr.proto = htons(PPP_LCP),
- .hdr.code = PROTOREJ,
- .hdr.id = ++lcp->fsm.id,
- .hdr.len = htons(6),
- .proto = ntohs(proto),
- };
-
- if (conf_ppp_verbose)
- log_ppp_info2("send [LCP ProtoRej id=%i <%04x>]\n", msg.hdr.id, proto);
-
- ppp_chan_send(lcp->ppp, &msg, sizeof(msg));
-}
-
-static void lcp_recv(struct ppp_handler_t*h)
-{
- struct lcp_hdr_t *hdr;
- struct ppp_lcp_t *lcp = container_of(h, typeof(*lcp), hnd);
- int r;
- char *term_msg;
-
- if (lcp->fsm.fsm_state == FSM_Initial || lcp->fsm.fsm_state == FSM_Closed || lcp->ppp->terminating) {
- /*if (conf_ppp_verbose)
- log_ppp_warn("LCP: discaring packet\n");
- lcp_send_proto_rej(ccp->ppp, htons(PPP_CCP));*/
- return;
- }
-
- if (lcp->ppp->chan_buf_size < PPP_HEADERLEN + 2) {
- log_ppp_warn("LCP: short packet received\n");
- return;
- }
-
- hdr = (struct lcp_hdr_t *)lcp->ppp->chan_buf;
- if (ntohs(hdr->len) < PPP_HEADERLEN) {
- log_ppp_warn("LCP: short packet received\n");
- return;
- }
-
- lcp->fsm.recv_id = hdr->id;
- switch(hdr->code) {
- case CONFREQ:
- r = lcp_recv_conf_req(lcp, (uint8_t*)(hdr + 1), ntohs(hdr->len) - PPP_HDRLEN);
- switch(r) {
- case LCP_OPT_ACK:
- ppp_fsm_recv_conf_req_ack(&lcp->fsm);
- break;
- case LCP_OPT_NAK:
- ppp_fsm_recv_conf_req_nak(&lcp->fsm);
- break;
- case LCP_OPT_REJ:
- ppp_fsm_recv_conf_req_rej(&lcp->fsm);
- break;
- }
- lcp_free_conf_req(lcp);
- if (r == LCP_OPT_FAIL)
- ppp_terminate(lcp->ppp, TERM_USER_ERROR, 0);
- break;
- case CONFACK:
- if (lcp_recv_conf_ack(lcp,(uint8_t*)(hdr + 1), ntohs(hdr->len) - PPP_HDRLEN))
- ppp_terminate(lcp->ppp, TERM_USER_ERROR, 0);
- else
- if (lcp->fsm.recv_id != lcp->fsm.id)
- break;
- ppp_fsm_recv_conf_ack(&lcp->fsm);
- break;
- case CONFNAK:
- lcp_recv_conf_nak(lcp, (uint8_t*)(hdr + 1), ntohs(hdr->len) - PPP_HDRLEN);
- if (lcp->fsm.recv_id != lcp->fsm.id)
- break;
- ppp_fsm_recv_conf_rej(&lcp->fsm);
- break;
- case CONFREJ:
- if (lcp_recv_conf_rej(lcp,(uint8_t*)(hdr + 1), ntohs(hdr->len) - PPP_HDRLEN))
- ppp_terminate(lcp->ppp, TERM_USER_ERROR, 0);
- else
- if (lcp->fsm.recv_id != lcp->fsm.id)
- break;
- ppp_fsm_recv_conf_rej(&lcp->fsm);
- break;
- case TERMREQ:
- if (conf_ppp_verbose)
- log_ppp_info2("recv [LCP TermReq id=%x]\n", hdr->id);
- ppp_fsm_recv_term_req(&lcp->fsm);
- ppp_terminate(lcp->ppp, TERM_USER_REQUEST, 0);
- break;
- case TERMACK:
- if (conf_ppp_verbose)
- log_ppp_info2("recv [LCP TermAck id=%x]\n", hdr->id);
- ppp_fsm_recv_term_ack(&lcp->fsm);
- break;
- case CODEREJ:
- if (conf_ppp_verbose)
- log_ppp_info2("recv [LCP CodeRej id=%x]\n", hdr->id);
- ppp_fsm_recv_code_rej_bad(&lcp->fsm);
- break;
- case ECHOREQ:
- if (conf_ppp_verbose)
- log_ppp_debug("recv [LCP EchoReq id=%x <magic %x>]\n", hdr->id, *(uint32_t*)(hdr + 1));
- send_echo_reply(lcp);
- break;
- case ECHOREP:
- lcp_recv_echo_repl(lcp, (uint8_t*)(hdr + 1), ntohs(hdr->len) - PPP_HDRLEN);
- break;
- case PROTOREJ:
- if (conf_ppp_verbose)
- log_ppp_info2("recv [LCP ProtoRej id=%x <%04x>]\n", hdr->code, hdr->id, ntohs(*(uint16_t*)(hdr + 1)));
- ppp_recv_proto_rej(lcp->ppp, ntohs(*(uint16_t *)(hdr + 1)));
- break;
- case IDENT:
- if (conf_ppp_verbose) {
- term_msg = _strndup((char*)(hdr + 1) + 4, ntohs(hdr->len) - 4 - 4);
- log_ppp_info2("recv [LCP Ident id=%x <%s>]\n", hdr->id, term_msg);
- _free(term_msg);
- }
- break;
- default:
- if (conf_ppp_verbose)
- log_ppp_info2("recv [LCP Unknown %x]\n", hdr->code);
- ppp_fsm_recv_unk(&lcp->fsm);
- break;
- }
-}
-
-int lcp_option_register(struct lcp_option_handler_t *h)
-{
- /*struct lcp_option_drv_t *p;
-
- list_for_each_entry(p,option_drv_list,entry)
- if (p->id==h->id)
- return -1;*/
-
- list_add_tail(&h->entry, &option_handlers);
-
- return 0;
-}
-
-static struct ppp_layer_t lcp_layer=
-{
- .init = lcp_layer_init,
- .start = lcp_layer_start,
- .finish = lcp_layer_finish,
- .free = lcp_layer_free,
-};
-
-static void load_config(void)
-{
- char *opt;
-
- opt = conf_get_opt("lcp", "echo-interval");
- if (opt && atoi(opt) > 0)
- conf_echo_interval = atoi(opt);
-
- opt = conf_get_opt("lcp", "echo-failure");
- if (opt && atoi(opt) > 0)
- conf_echo_failure = atoi(opt);
-}
-
-static void __init lcp_init(void)
-{
- load_config();
-
- ppp_register_layer("lcp", &lcp_layer);
-
- triton_event_register_handler(EV_CONFIG_RELOAD, (triton_event_func)load_config);
-}
-