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