1/* PPPoE support library "libpppoe" 2 * 3 * Copyright 2000 Michal Ostrowski <mostrows@styx.uwaterloo.ca>, 4 * Jamal Hadi Salim <hadi@cyberus.ca> 5 * 6 * This program is free software; you can redistribute it and/or 7 * modify it under the terms of the GNU General Public License 8 * as published by the Free Software Foundation; either version 9 * 2 of the License, or (at your option) any later version. 10 */ 11#include "pppoe.h" 12#include <unistd.h> 13 14static unsigned int pcid=1111; 15static int srv_rcv_padi(struct session* ses, 16 struct pppoe_packet *p_in, 17 struct pppoe_packet **p_out){ 18 struct pppoe_con *newpc = NULL; 19 struct pppoe_tag *tag; 20 21 poe_dbglog(ses,"Srv Recv'd packet: %P\n",p_in); 22 23 24 ses->curr_pkt.hdr = (struct pppoe_hdr*) ses->curr_pkt.buf; 25 ses->curr_pkt.hdr->ver = 1; 26 ses->curr_pkt.hdr->type = 1; 27 28 tag = get_tag(p_in->hdr,PTT_SRV_NAME); 29 30 if(!tag ) 31 return 0; 32 33 if( ntohs(tag->tag_len)==0 ){ 34 ses->curr_pkt.tags[TAG_SRV_NAME] = ses->filt->stag ; 35 }else if( tag->tag_len != ses->filt->stag->tag_len 36 || !memcmp( tag+1, ses->filt->stag, ntohs(tag->tag_len)) ){ 37 return 0; 38 }else{ 39 ses->curr_pkt.tags[TAG_SRV_NAME] = tag; 40 } 41 42 ses->curr_pkt.tags[ TAG_AC_NAME] = ses->filt->ntag ; 43 ses->curr_pkt.tags[ TAG_HOST_UNIQ ] = get_tag(p_in->hdr,PTT_HOST_UNIQ); 44 45 memcpy(&ses->remote, &p_in->addr, sizeof(struct sockaddr_ll)); 46 memcpy( &ses->curr_pkt.addr, &ses->remote , sizeof(struct sockaddr_ll)); 47 48 ses->curr_pkt.hdr->code = PADO_CODE; 49 50 51 ses->curr_pkt.tags[ TAG_RELAY_SID ] = get_tag(p_in->hdr,PTT_RELAY_SID); 52 53 send_disc(ses, &ses->curr_pkt); 54 poe_dbglog(ses,"Srv Sent packet: %P\n",&ses->curr_pkt); 55 56 return 0; 57} 58 59 60static int srv_rcv_padr(struct session* ses, 61 struct pppoe_packet *p_in, 62 struct pppoe_packet **p_out){ 63 struct pppoe_tag *tag; 64 65 poe_dbglog(ses,"Recv'd packet: %P\n",p_in); 66 67 68 69 /* Run checks to ensure this packets asks for 70 what we're willing to offer */ 71 72 tag = get_tag(p_in->hdr,PTT_SRV_NAME); 73 74 if(!tag || tag->tag_len == 0 ){ 75 p_in->tags[TAG_SRV_NAME] = ses->filt->stag; 76 77 }else if( tag->tag_len != ses->filt->stag->tag_len 78 || !memcmp(tag + 1 , ses->filt->stag, ntohs(tag->tag_len)) ){ 79 return 0; 80 }else{ 81 p_in->tags[TAG_SRV_NAME] = tag; 82 } 83 84 tag = get_tag(p_in->hdr,PTT_AC_NAME); 85 if( !tag || tag->tag_len==0 ){ 86 p_in->tags[TAG_AC_NAME] = ses->filt->ntag; 87 }else if( tag->tag_len != ses->filt->ntag->tag_len 88 || !memcmp(tag + 1, ses->filt->ntag, ntohs(tag->tag_len)) ){ 89 return 0; 90 }else{ 91 p_in->tags[TAG_AC_NAME] = tag; 92 } 93 94 95 96 97 pcid = ++pcid & 0x0000ffff ; 98 if(pcid == 0 ){ 99 pcid = 1111; 100 } 101 102 p_in->hdr->sid = ntohs(pcid); 103 104 p_in->hdr->code = PADS_CODE; 105 send_disc(ses, p_in); 106 107 poe_dbglog(ses,"Sent packet: %P\n",p_in); 108 109 ses->sp.sa_family = AF_PPPOX; 110 ses->sp.sa_protocol=PX_PROTO_OE; 111 ses->sp.sa_addr.pppoe.sid = p_in->hdr->sid; 112 memcpy(ses->sp.sa_addr.pppoe.dev, ses->name, IFNAMSIZ); 113 memcpy(ses->sp.sa_addr.pppoe.remote, p_in->addr.sll_addr, ETH_ALEN); 114 memcpy(&ses->remote, &p_in->addr, sizeof(struct sockaddr_ll)); 115 return 1; 116} 117 118static int srv_rcv_padt(struct session* ses, 119 struct pppoe_packet *p_in, 120 struct pppoe_packet **p_out){ 121 return 0; 122} 123 124 125 126int srv_init_ses(struct session *ses, char* from) 127{ 128 int retval; 129 retval = client_init_ses(ses, from); 130 ses->init_disc = NULL; 131 ses->rcv_pado = NULL; 132 ses->rcv_pads = NULL; 133 ses->rcv_padi = srv_rcv_padi; 134 ses->rcv_padr = srv_rcv_padr; 135 ses->rcv_padt = srv_rcv_padt; 136 137 /* retries forever */ 138 ses->retries = -1; 139 140 return retval; 141} 142 143 144