ipoe.c 74.4 KB
Newer Older
K
Kozlov Dmitry 已提交
1 2 3 4 5 6 7
#include <unistd.h>
#include <stdlib.h>
#include <stdio.h>
#include <stdarg.h>
#include <errno.h>
#include <string.h>
#include <fcntl.h>
8
#include <assert.h>
K
Kozlov Dmitry 已提交
9 10 11
#include <time.h>
#include <arpa/inet.h>
#include <netinet/in.h>
12 13
#include <net/ethernet.h>
#include <netinet/ip.h>
K
Kozlov Dmitry 已提交
14 15 16
#include <sys/socket.h>
#include <sys/ioctl.h>
#include <linux/if.h>
17
#include <linux/route.h>
K
Kozlov Dmitry 已提交
18 19 20 21 22 23 24 25 26 27 28 29 30 31

#include <pcre.h>

#include "events.h"
#include "list.h"
#include "triton.h"
#include "log.h"
#include "mempool.h"
#include "utils.h"
#include "cli.h"
#include "ap_session.h"
#include "pwdb.h"
#include "ipdb.h"

32
#include "iputils.h"
33 34
#include "ipset.h"

K
Kozlov Dmitry 已提交
35 36 37 38 39 40
#include "connlimit.h"

#include "ipoe.h"

#include "memdebug.h"

41 42 43
#define USERNAME_UNSET 0
#define USERNAME_IFNAME 1
#define USERNAME_LUA 2
K
Kozlov Dmitry 已提交
44

K
Kozlov Dmitry 已提交
45 46 47
#define MODE_L2 0
#define MODE_L3 1

D
Dmitry Kozlov 已提交
48 49 50
struct ifaddr {
	struct list_head entry;
	in_addr_t addr;
51
	int mask;
D
Dmitry Kozlov 已提交
52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90
	int refs;
};

struct iplink_arg {
	pcre *re;
	const char *opt;
	long *arg1;
};

struct unit_cache {
	struct list_head entry;
	int ifindex;
};

struct l4_redirect {
	struct list_head entry;
	in_addr_t addr;
	time_t timeout;
};

struct gw_addr {
	struct list_head entry;
	in_addr_t addr;
	int mask;
	int mask1;
};

struct disc_item {
	struct list_head entry;
	struct dhcpv4_packet *pack;
	struct timespec ts;
};

struct delay {
	struct list_head entry;
	unsigned int conn_cnt;
	int delay;
};

91 92 93 94 95 96 97
struct request_item {
	struct list_head entry;
	uint32_t xid;
	time_t expire;
	int cnt;
};

K
Kozlov Dmitry 已提交
98
static int conf_dhcpv4 = 1;
99 100
static int conf_up;
static int conf_mode;
K
Kozlov Dmitry 已提交
101
static int conf_shared = 1;
102
static int conf_ifcfg = 1;
103 104 105
static int conf_nat;
static int conf_arp;
static int conf_ipv6;
106
static uint32_t conf_src;
107
static const char *conf_ip_pool;
K
Kozlov Dmitry 已提交
108 109
//static int conf_dhcpv6;
static int conf_username;
110
static const char *conf_password;
K
Kozlov Dmitry 已提交
111
static int conf_unit_cache;
K
Kozlov Dmitry 已提交
112
static int conf_noauth;
113 114 115 116
#ifdef RADIUS
static int conf_attr_dhcp_client_ip;
static int conf_attr_dhcp_router_ip;
static int conf_attr_dhcp_mask;
117
static int conf_attr_dhcp_lease_time;
118
static int conf_attr_l4_redirect;
119
static const char *conf_attr_dhcp_opt82;
120 121
#endif
static int conf_l4_redirect_table;
122
static int conf_l4_redirect_on_reject;
123
static const char *conf_l4_redirect_ipset;
D
Dmitry Kozlov 已提交
124
static int conf_vlan_timeout = 30;
125
static int conf_max_request = 3;
126

K
Kozlov Dmitry 已提交
127
static const char *conf_relay;
K
Kozlov Dmitry 已提交
128 129 130 131 132

#ifdef USE_LUA
static const char *conf_lua_username_func;
#endif

133 134 135
static int conf_offer_timeout = 10;
static int conf_relay_timeout = 3;
static int conf_relay_retransmit = 3;
136
static LIST_HEAD(conf_gw_addr);
K
Kozlov Dmitry 已提交
137 138 139 140
static int conf_netmask = 24;
static int conf_lease_time = 600;
static int conf_lease_timeout = 660;
static int conf_verbose;
141
static const char *conf_agent_remote_id;
142
static int conf_proto;
D
Dmitry Kozlov 已提交
143
static LIST_HEAD(conf_offer_delay);
144
static const char *conf_vlan_name;
145
static int conf_ip_unnumbered;
K
Kozlov Dmitry 已提交
146 147 148

static unsigned int stat_starting;
static unsigned int stat_active;
D
Dmitry Kozlov 已提交
149
static unsigned int stat_delayed_offer;
K
Kozlov Dmitry 已提交
150 151

static mempool_t ses_pool;
D
Dmitry Kozlov 已提交
152
static mempool_t disc_item_pool;
153
static mempool_t req_item_pool;
K
Kozlov Dmitry 已提交
154

155
static int connlimit_loaded;
156
static int radius_loaded;
157

K
Kozlov Dmitry 已提交
158
static LIST_HEAD(serv_list);
D
Dmitry Kozlov 已提交
159
static pthread_mutex_t serv_lock = PTHREAD_MUTEX_INITIALIZER;
D
Dmitry Kozlov 已提交
160

K
Kozlov Dmitry 已提交
161 162 163 164 165
static pthread_mutex_t uc_lock = PTHREAD_MUTEX_INITIALIZER;
static LIST_HEAD(uc_list);
static int uc_size;
static mempool_t uc_pool;

166 167 168 169 170
static pthread_rwlock_t l4_list_lock = PTHREAD_RWLOCK_INITIALIZER;
static LIST_HEAD(l4_redirect_list);
static struct triton_timer_t l4_redirect_timer;
static struct triton_context_t l4_redirect_ctx;

K
Kozlov Dmitry 已提交
171
static void ipoe_session_finished(struct ap_session *s);
K
Kozlov Dmitry 已提交
172
static void ipoe_drop_sessions(struct ipoe_serv *serv, struct ipoe_session *skip);
D
Dmitry Kozlov 已提交
173
static void ipoe_serv_release(struct ipoe_serv *serv);
K
Kozlov Dmitry 已提交
174
static void __ipoe_session_activate(struct ipoe_session *ses);
175
static void ipoe_ses_recv_dhcpv4(struct dhcpv4_serv *dhcpv4, struct dhcpv4_packet *pack);
D
Dmitry Kozlov 已提交
176
static void __ipoe_recv_dhcpv4(struct dhcpv4_serv *dhcpv4, struct dhcpv4_packet *pack, int force);
177
static void ipoe_session_keepalive(struct dhcpv4_packet *pack);
D
Dmitry Kozlov 已提交
178
static void add_interface(const char *ifname, int ifindex, const char *opt, int parent_ifindex, int vid);
D
Dmitry Kozlov 已提交
179
static int get_offer_delay();
180
static void __ipoe_session_start(struct ipoe_session *ses);
181
static int ipoe_rad_send_request(struct rad_plugin_t *rad, struct rad_packet_t *pack);
K
Kozlov Dmitry 已提交
182

K
Kozlov Dmitry 已提交
183
static struct ipoe_session *ipoe_session_lookup(struct ipoe_serv *serv, struct dhcpv4_packet *pack, struct ipoe_session **opt82_ses)
K
Kozlov Dmitry 已提交
184
{
K
Kozlov Dmitry 已提交
185
	struct ipoe_session *ses, *res = NULL;
K
Kozlov Dmitry 已提交
186 187 188
	
	uint8_t *agent_circuit_id = NULL;
	uint8_t *agent_remote_id = NULL;
K
Kozlov Dmitry 已提交
189 190 191 192
	int opt82_match;

	if (opt82_ses)
		*opt82_ses = NULL;
K
Kozlov Dmitry 已提交
193

K
Kozlov Dmitry 已提交
194 195 196 197
	if (pack->relay_agent && dhcpv4_parse_opt82(pack->relay_agent, &agent_circuit_id, &agent_remote_id)) {
		agent_circuit_id = NULL;
		agent_remote_id = NULL;
	}
K
Kozlov Dmitry 已提交
198

K
Kozlov Dmitry 已提交
199
	list_for_each_entry(ses, &serv->sessions, entry) {
200
		opt82_match = pack->relay_agent != NULL;
K
Kozlov Dmitry 已提交
201
		
202
		if (agent_circuit_id && !ses->agent_circuit_id)
K
Kozlov Dmitry 已提交
203
			opt82_match = 0;
K
Kozlov Dmitry 已提交
204
		
K
Kozlov Dmitry 已提交
205 206
		if (opt82_match && agent_remote_id && !ses->agent_remote_id)
			opt82_match = 0;
K
Kozlov Dmitry 已提交
207
		
K
Kozlov Dmitry 已提交
208 209 210 211 212
		if (opt82_match && !agent_circuit_id && ses->agent_circuit_id)
			opt82_match = 0;
		
		if (opt82_match && !agent_remote_id && ses->agent_remote_id)
			opt82_match = 0;
K
Kozlov Dmitry 已提交
213
		
K
Kozlov Dmitry 已提交
214
		if (opt82_match && agent_circuit_id) {
K
Kozlov Dmitry 已提交
215
			if (*agent_circuit_id != *ses->agent_circuit_id)
K
Kozlov Dmitry 已提交
216 217
				opt82_match = 0;
		
K
Kozlov Dmitry 已提交
218
			if (memcmp(agent_circuit_id + 1, ses->agent_circuit_id + 1, *agent_circuit_id))
K
Kozlov Dmitry 已提交
219
				opt82_match = 0;
K
Kozlov Dmitry 已提交
220 221
		}
		
K
Kozlov Dmitry 已提交
222
		if (opt82_match && agent_remote_id) {
K
Kozlov Dmitry 已提交
223
			if (*agent_remote_id != *ses->agent_remote_id)
K
Kozlov Dmitry 已提交
224 225
				opt82_match = 0;

K
Kozlov Dmitry 已提交
226
			if (memcmp(agent_remote_id + 1, ses->agent_remote_id + 1, *agent_remote_id))
K
Kozlov Dmitry 已提交
227
				opt82_match = 0;
K
Kozlov Dmitry 已提交
228
		}
K
Kozlov Dmitry 已提交
229 230 231

		if (opt82_match && opt82_ses)
			*opt82_ses = ses;
K
Kozlov Dmitry 已提交
232
			
D
Dmitry Kozlov 已提交
233
		if (memcmp(pack->hdr->chaddr, ses->hwaddr, ETH_ALEN))
K
Kozlov Dmitry 已提交
234 235
			continue;
	
K
Kozlov Dmitry 已提交
236 237
		res = ses;
		break;
K
Kozlov Dmitry 已提交
238
		
K
Kozlov Dmitry 已提交
239
		/*if (pack->client_id && !ses->client_id)
240 241 242 243 244
			continue;
		
		if (!pack->client_id && ses->client_id)
			continue;
		
K
Kozlov Dmitry 已提交
245 246 247 248 249 250 251
		if (pack->client_id) {
			if (pack->client_id->len != ses->client_id->len)
				continue;
			if (memcmp(pack->client_id->data, ses->client_id->data, pack->client_id->len))
				continue;
		}

K
Kozlov Dmitry 已提交
252 253 254 255 256
		ses1 = ses;

		if (pack->hdr->xid != ses->xid)
			continue;

K
Kozlov Dmitry 已提交
257
		return ses;*/
K
Kozlov Dmitry 已提交
258 259
	}

K
Kozlov Dmitry 已提交
260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296
	if (!res || !pack->relay_agent || !opt82_ses || *opt82_ses)
		return res;
	
	list_for_each_entry(ses, &serv->sessions, entry) {
		if (agent_circuit_id && !ses->agent_circuit_id)
			continue;
		
		if (opt82_match && agent_remote_id && !ses->agent_remote_id)
			continue;
		
		if (opt82_match && !agent_circuit_id && ses->agent_circuit_id)
			continue;
		
		if (opt82_match && !agent_remote_id && ses->agent_remote_id)
			continue;
		
		if (opt82_match && agent_circuit_id) {
			if (*agent_circuit_id != *ses->agent_circuit_id)
				continue;
		
			if (memcmp(agent_circuit_id + 1, ses->agent_circuit_id + 1, *agent_circuit_id))
				continue;
		}
		
		if (opt82_match && agent_remote_id) {
			if (*agent_remote_id != *ses->agent_remote_id)
				continue;

			if (memcmp(agent_remote_id + 1, ses->agent_remote_id + 1, *agent_remote_id))
				continue;
		}

		*opt82_ses = ses;
		break;
	}
			
	return res;
K
Kozlov Dmitry 已提交
297 298 299 300 301 302 303 304
}

static void ipoe_session_timeout(struct triton_timer_t *t)
{
	struct ipoe_session *ses = container_of(t, typeof(*ses), timer);

	triton_timer_del(t);

K
Kozlov Dmitry 已提交
305
	log_ppp_info2("ipoe: session timed out\n");
K
Kozlov Dmitry 已提交
306 307 308 309

	ap_session_terminate(&ses->ses, TERM_LOST_CARRIER, 0);
}

310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329
static void ipoe_relay_timeout(struct triton_timer_t *t)
{
	struct ipoe_session *ses = container_of(t, typeof(*ses), timer);

	if (!ses->serv->dhcpv4_relay || !ses->dhcpv4_request) {
		triton_timer_del(t);
		return;
	}

	if (++ses->relay_retransmit > conf_relay_retransmit) {
		triton_timer_del(t);

		log_ppp_info2("ipoe: relay timed out\n");

		ap_session_terminate(&ses->ses, TERM_LOST_CARRIER, 0);
	} else
		dhcpv4_relay_send(ses->serv->dhcpv4_relay, ses->dhcpv4_request, ses->relay_server_id, ses->serv->ifname, conf_agent_remote_id);
}


330
static char *ipoe_session_get_username(struct ipoe_session *ses)
K
Kozlov Dmitry 已提交
331 332
{
#ifdef USE_LUA
333 334 335
	if (ses->serv->opt_username == USERNAME_LUA)
		return ipoe_lua_get_username(ses, ses->serv->opt_lua_username_func ? : conf_lua_username_func);
	else
K
Kozlov Dmitry 已提交
336
#endif
337 338
	if (!ses->dhcpv4_request)
		return _strdup(ses->ctrl.calling_station_id);
339

340
	return _strdup(ses->ses.ifname);
K
Kozlov Dmitry 已提交
341 342
}

343
static void l4_redirect_list_add(in_addr_t addr)
344 345 346 347 348 349 350 351 352 353 354 355 356
{
	struct l4_redirect *n = _malloc(sizeof(*n));
	struct timespec ts;

	if (!n)
		return;

	clock_gettime(CLOCK_MONOTONIC, &ts);

	memset(n, 0, sizeof(*n));
	n->addr = addr;
	n->timeout = ts.tv_sec + conf_l4_redirect_on_reject;
	
357
	ipoe_nl_add_exclude(addr, 32);
358 359 360 361 362 363

	if (conf_l4_redirect_table)
		iprule_add(addr, conf_l4_redirect_table);

	if (conf_l4_redirect_ipset)
		ipset_add(conf_l4_redirect_ipset, addr);
364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402

	pthread_rwlock_wrlock(&l4_list_lock);
	
	list_add_tail(&n->entry, &l4_redirect_list);
	
	if (!l4_redirect_timer.tpd)
		triton_timer_add(&l4_redirect_ctx, &l4_redirect_timer, 0);

	pthread_rwlock_unlock(&l4_list_lock);	
}

static int l4_redirect_list_check(in_addr_t addr)
{
	struct l4_redirect *n;

	pthread_rwlock_rdlock(&l4_list_lock);
	list_for_each_entry(n, &l4_redirect_list, entry) {
		if (n->addr == addr) {
			pthread_rwlock_unlock(&l4_list_lock);
			return 1;
		}
	}
	pthread_rwlock_unlock(&l4_list_lock);
	return 0;
}

static void l4_redirect_list_timer(struct triton_timer_t *t)
{
	struct l4_redirect *n;
	struct timespec ts;

	clock_gettime(CLOCK_MONOTONIC, &ts);

	pthread_rwlock_wrlock(&l4_list_lock);
	while (!list_empty(&l4_redirect_list)) {
		n = list_entry(l4_redirect_list.next, typeof(*n), entry);
		if (ts.tv_sec > n->timeout) {
			list_del(&n->entry);
			pthread_rwlock_unlock(&l4_list_lock);
403 404 405 406 407 408

			if (conf_l4_redirect_table)
				iprule_del(n->addr, conf_l4_redirect_table);
			
			if (conf_l4_redirect_ipset)
				ipset_del(conf_l4_redirect_ipset, n->addr);
409 410
	
			ipoe_nl_del_exclude(n->addr);
411 412 413 414 415 416 417 418 419 420 421 422 423

			_free(n);
			pthread_rwlock_wrlock(&l4_list_lock);
		} else
			break;
	}

	if (list_empty(&l4_redirect_list) && l4_redirect_timer.tpd)
		triton_timer_del(&l4_redirect_timer);

	pthread_rwlock_unlock(&l4_list_lock);
}

424 425 426
static void ipoe_change_l4_redirect(struct ipoe_session *ses, int del)
{
	in_addr_t addr;
427
		
428
	if (ses->ses.ipv4)
429
		addr = ses->ses.ipv4->peer_addr;
430 431
	else
		addr = ses->yiaddr;
432 433 434 435 436 437 438 439 440 441
	
	if (conf_l4_redirect_table) {
		if (del) {
			iprule_del(addr, conf_l4_redirect_table);
			ses->l4_redirect_set = 0;
		} else {
			iprule_add(addr, conf_l4_redirect_table);
			ses->l4_redirect_set = 1;
		}
	}
442

443 444 445 446 447 448 449 450
	if (conf_l4_redirect_ipset) {
		if (del) {
			ipset_del(conf_l4_redirect_ipset, addr);
			ses->l4_redirect_set = 0;
		} else {
			ipset_add(conf_l4_redirect_ipset, addr);
			ses->l4_redirect_set = 1;
		}
K
Kozlov Dmitry 已提交
451
	}
452 453 454 455 456 457 458
}

static void ipoe_change_addr(struct ipoe_session *ses, in_addr_t newaddr)
{

}

459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493
static int ipoe_create_interface(struct ipoe_session *ses)
{
	struct unit_cache *uc;
	struct ifreq ifr;

	pthread_mutex_lock(&uc_lock);
	if (!list_empty(&uc_list)) {
		uc = list_entry(uc_list.next, typeof(*uc), entry);
		ses->ifindex = uc->ifindex;
		list_del(&uc->entry);
		--uc_size;
		pthread_mutex_unlock(&uc_lock);
		mempool_free(uc);
	} else {
		pthread_mutex_unlock(&uc_lock);
		ses->ifindex = ipoe_nl_create(0, 0, ses->serv->opt_mode == MODE_L2 ? ses->serv->ifname : NULL, ses->hwaddr);
		if (ses->ifindex == -1) {
			log_ppp_error("ipoe: failed to create interface\n");
			ap_session_terminate(&ses->ses, TERM_NAS_ERROR, 1);
			return -1;
		}
	}

	memset(&ifr, 0, sizeof(ifr));
	ifr.ifr_ifindex = ses->ifindex;
	if (ioctl(sock_fd, SIOCGIFNAME, &ifr, sizeof(ifr))) {
		log_ppp_error("ipoe: failed to get interface name\n");
		ses->ifindex = -1;
		ap_session_terminate(&ses->ses, TERM_NAS_ERROR, 1);
		return -1;
	}

	strncpy(ses->ses.ifname, ifr.ifr_name, AP_IFNAME_LEN);
	ses->ses.ifindex = ses->ifindex;
	ses->ses.unit_idx = ses->ifindex;
494
	ses->ctrl.dont_ifcfg = !conf_ip_unnumbered;
495

496 497
	log_ppp_info2("create interface %s parent %s\n", ifr.ifr_name, ses->serv->ifname);

498 499 500
	return 0;
}

501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546
static void auth_result(struct ipoe_session *ses, int r)
{
	char *username = ses->username;

	ses->username = NULL;

	if (r == PWDB_DENIED) {
		pthread_rwlock_wrlock(&ses_lock);
		ses->ses.username = username;
		ses->ses.terminate_cause = TERM_AUTH_ERROR;
		pthread_rwlock_unlock(&ses_lock);
		if (conf_ppp_verbose)
			log_ppp_warn("authentication failed\n");
		if (conf_l4_redirect_on_reject && !ses->dhcpv4_request)
			l4_redirect_list_add(ses->yiaddr);
		ap_session_terminate(&ses->ses, TERM_AUTH_ERROR, 0);
		return;
	}

	ap_session_set_username(&ses->ses, username);
	log_ppp_info1("%s: authentication succeeded\n", ses->ses.username);
	triton_event_fire(EV_SES_AUTHORIZED, &ses->ses);

	if (ses->serv->opt_nat)
		ses->ses.ipv4 = ipdb_get_ipv4(&ses->ses);
	
	if (ses->serv->opt_shared == 0 && (!ses->ses.ipv4 || ses->ses.ipv4->peer_addr == ses->yiaddr)) {
		strncpy(ses->ses.ifname, ses->serv->ifname, AP_IFNAME_LEN);
		ses->ses.ifindex = ses->serv->ifindex;
	} else if (ses->ifindex == -1) {
		if (ipoe_create_interface(ses))
			return;
	}

	ap_session_set_ifindex(&ses->ses);

	if (ses->dhcpv4_request && ses->serv->dhcpv4_relay) {
		dhcpv4_relay_send(ses->serv->dhcpv4_relay, ses->dhcpv4_request, ses->relay_server_id, ses->serv->ifname, conf_agent_remote_id);

		ses->timer.expire = ipoe_relay_timeout;
		ses->timer.period = conf_relay_timeout * 1000;
		triton_timer_add(&ses->ctx, &ses->timer, 0);
	} else
		__ipoe_session_start(ses);
}

K
Kozlov Dmitry 已提交
547 548 549 550
static void ipoe_session_start(struct ipoe_session *ses)
{
	int r;
	char *passwd;
551
	char *username;
K
Kozlov Dmitry 已提交
552

D
Dmitry Kozlov 已提交
553 554
	__sync_add_and_fetch(&stat_starting, 1);
	
555
	assert(!ses->ses.username);
556

557 558 559 560 561 562 563
	strncpy(ses->ses.ifname, ses->serv->ifname, AP_IFNAME_LEN);
	
	username = ipoe_session_get_username(ses);

	if (!username) {
		ipoe_session_finished(&ses->ses);
		return;
K
Kozlov Dmitry 已提交
564
	}
565 566

	ses->ses.unit_idx = ses->serv->ifindex;
K
Kozlov Dmitry 已提交
567 568 569 570 571 572
	
	triton_event_fire(EV_CTRL_STARTING, &ses->ses);
	triton_event_fire(EV_CTRL_STARTED, &ses->ses);

	ap_session_starting(&ses->ses);
	
573 574 575
	if (conf_noauth) 
		r = PWDB_SUCCESS;
	else {
576 577 578
		if (ses->serv->opt_shared && ipoe_create_interface(ses))
			return;

579 580 581 582 583 584 585 586
#ifdef RADIUS
		if (conf_attr_dhcp_opt82 && ses->relay_agent && radius_loaded) {
			ses->radius.send_access_request = ipoe_rad_send_request;
			ses->radius.send_accounting_request = ipoe_rad_send_request;
			rad_register_plugin(&ses->ses, &ses->radius);
		}
#endif

587 588 589 590 591 592
		ses->username = username;
		r = pwdb_check(&ses->ses, (pwdb_callback)auth_result, ses, username, PPP_PAP, conf_password ? conf_password : username);
		
		if (r == PWDB_WAIT)
			return;

K
Kozlov Dmitry 已提交
593 594 595 596 597 598 599 600
		if (r == PWDB_NO_IMPL) {
			passwd = pwdb_get_passwd(&ses->ses, ses->ses.username);
			if (!passwd)
				r = PWDB_DENIED;
			else {
				r = PWDB_SUCCESS;
				_free(passwd);
			}
K
Kozlov Dmitry 已提交
601 602
		}
	}
K
Kozlov Dmitry 已提交
603
	
604
	auth_result(ses, r);
K
Kozlov Dmitry 已提交
605 606
}

607 608 609 610 611
static void find_gw_addr(struct ipoe_session *ses)
{
	struct gw_addr *a;

	list_for_each_entry(a, &conf_gw_addr, entry) {
612
		if ((ntohl(ses->yiaddr) & (a->mask1)) == (ntohl(a->addr) & (a->mask1))) {
613 614 615 616 617 618 619
			ses->siaddr = a->addr;
			ses->mask = a->mask;
			return;
		}
	}
}

K
Kozlov Dmitry 已提交
620 621
static void __ipoe_session_start(struct ipoe_session *ses) 
{
622
	if (!ses->yiaddr) {
623
		dhcpv4_get_ip(ses->serv->dhcpv4, &ses->yiaddr, &ses->router, &ses->mask);
624 625 626
		if (ses->yiaddr)
			ses->dhcp_addr = 1;
	}
627

628 629 630 631 632 633
	if (!ses->yiaddr && !ses->serv->opt_nat)
		ses->ses.ipv4 = ipdb_get_ipv4(&ses->ses);

	if (!ses->mask)
		ses->mask = conf_netmask;

K
Kozlov Dmitry 已提交
634
	if (ses->ses.ipv4) {
635 636
		if (!ses->mask)
			ses->mask = ses->ses.ipv4->mask;
K
Kozlov Dmitry 已提交
637

K
Kozlov Dmitry 已提交
638 639
		if (!ses->yiaddr)
			ses->yiaddr = ses->ses.ipv4->peer_addr;
640 641 642
	
		if (!ses->router)
			ses->router = ses->ses.ipv4->addr;
K
Kozlov Dmitry 已提交
643
	} /*else if (ses->yiaddr) {
K
Kozlov Dmitry 已提交
644 645 646 647 648
		ses->ses.ipv4 = &ses->ipv4;
		ses->ipv4.addr = ses->siaddr;
		ses->ipv4.peer_addr = ses->yiaddr;
		ses->ipv4.mask = ses->mask;
		ses->ipv4.owner = NULL;
K
Kozlov Dmitry 已提交
649
	}*/
650

K
Kozlov Dmitry 已提交
651 652 653 654 655 656 657 658 659
	if (ses->dhcpv4_request) {
		if (!ses->yiaddr) {
			log_ppp_error("no free IPv4 address\n");
			ap_session_terminate(&ses->ses, TERM_NAS_REQUEST, 0);
			return;
		}
			
		if (!ses->siaddr && ses->router != ses->yiaddr)
			ses->siaddr = ses->router;
660
		
661 662 663
		if (!ses->siaddr)
			find_gw_addr(ses);
		
664 665 666
		if (!ses->siaddr)
			ses->siaddr = ses->serv->opt_src;		

K
Kozlov Dmitry 已提交
667 668
		if (!ses->siaddr && ses->serv->dhcpv4_relay)
			ses->siaddr = ses->serv->dhcpv4_relay->giaddr;
669

K
Kozlov Dmitry 已提交
670 671 672 673 674
		if (!ses->siaddr) {
			log_ppp_error("can't determine Server-ID\n");
			ap_session_terminate(&ses->ses, TERM_NAS_ERROR, 0);
			return;
		}
675

676 677 678
		if (ses->ses.ipv4 && !ses->ses.ipv4->addr)
			ses->ses.ipv4->addr = ses->siaddr;

679 680
		if (!ses->router)
			ses->router = ses->siaddr;
K
Kozlov Dmitry 已提交
681 682 683
				
		if (!ses->mask)
			ses->mask = 32;
684

685
		dhcpv4_send_reply(DHCPOFFER, ses->serv->dhcpv4, ses->dhcpv4_request, ses->yiaddr, ses->siaddr, ses->router, ses->mask, ses->lease_time, ses->dhcpv4_relay_reply);
K
Kozlov Dmitry 已提交
686 687 688

		dhcpv4_packet_free(ses->dhcpv4_request);
		ses->dhcpv4_request = NULL;
689 690
	
		ses->timer.expire = ipoe_session_timeout;
691
		ses->timer.period = 0;
692 693
		ses->timer.expire_tv.tv_sec = conf_offer_timeout;
		triton_timer_add(&ses->ctx, &ses->timer, 0);
694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712
	} else {
		if (!ses->siaddr)
			find_gw_addr(ses);
		
		if (!ses->siaddr)
			ses->siaddr = ses->serv->opt_src;

		if (!ses->siaddr)
			ses->siaddr = iproute_get(ses->yiaddr);

		if (!ses->siaddr) {
			log_ppp_error("can't determine local address\n");
			ap_session_terminate(&ses->ses, TERM_NAS_ERROR, 0);
			return;
		}
		
		if (ses->ses.ipv4 && !ses->ses.ipv4->addr)
			ses->ses.ipv4->addr = ses->siaddr;

K
Kozlov Dmitry 已提交
713
		__ipoe_session_activate(ses);
714
	}
K
Kozlov Dmitry 已提交
715 716
}

717
static void ipoe_serv_add_addr(struct ipoe_serv *serv, in_addr_t addr, int mask)
718 719 720 721 722
{
	struct ifaddr *a;

	pthread_mutex_lock(&serv->lock);
	
723 724 725 726 727
	if (serv->opt_shared) {
		list_for_each_entry(a, &serv->addr_list, entry) {
			if (a->addr == addr) {
				a->refs++;
				pthread_mutex_unlock(&serv->lock);
K
Kozlov Dmitry 已提交
728

729 730
				return;
			}
K
Kozlov Dmitry 已提交
731 732 733 734 735
		}
	}

	a = _malloc(sizeof(*a));
	a->addr = addr;
736
	a->mask = mask;
K
Kozlov Dmitry 已提交
737 738 739
	a->refs = 1;
	list_add_tail(&a->entry, &serv->addr_list);

740
	if (ipaddr_add(serv->ifindex, a->addr, mask))
K
Kozlov Dmitry 已提交
741 742 743 744 745
		log_warn("ipoe: failed to add addess to interface '%s'\n", serv->ifname);

	pthread_mutex_unlock(&serv->lock);
}

746
static void ipoe_serv_del_addr(struct ipoe_serv *serv, in_addr_t addr, int lock)
K
Kozlov Dmitry 已提交
747 748 749
{
	struct ifaddr *a;

750 751
	if (lock)
		pthread_mutex_lock(&serv->lock);
K
Kozlov Dmitry 已提交
752 753 754 755

	list_for_each_entry(a, &serv->addr_list, entry) {
		if (a->addr == addr) {
			if (--a->refs == 0) {
756
				if (ipaddr_del(serv->ifindex, a->addr, a->mask))
K
Kozlov Dmitry 已提交
757 758 759
					log_warn("ipoe: failed to delete addess from interface '%s'\n", serv->ifname);
				list_del(&a->entry);
				_free(a);
760
			}
K
Kozlov Dmitry 已提交
761
			break;
762
		}
K
Kozlov Dmitry 已提交
763 764
	}
	
765 766
	if (lock)
		pthread_mutex_unlock(&serv->lock);
K
Kozlov Dmitry 已提交
767 768 769 770 771 772
}

static void ipoe_ifcfg_add(struct ipoe_session *ses)
{
	struct ipoe_serv *serv = ses->serv;

773 774 775 776
	if (ses->serv->opt_ifcfg)
		ipoe_serv_add_addr(ses->serv, ses->siaddr, conf_ip_unnumbered ? 32 : ses->mask);
	
	if (conf_ip_unnumbered) {
777
		if (iproute_add(serv->ifindex, ses->serv->opt_src ? ses->serv->opt_src : ses->router, ses->yiaddr, conf_proto))
K
Kozlov Dmitry 已提交
778
			log_ppp_warn("ipoe: failed to add route to interface '%s'\n", serv->ifname);
779
	}
780 781 782 783

	ses->ifcfg = 1;
}

D
Dmitry Kozlov 已提交
784
static void ipoe_ifcfg_del(struct ipoe_session *ses, int lock)
785 786
{
	struct ipoe_serv *serv = ses->serv;
K
Kozlov Dmitry 已提交
787
	
788 789 790
	if (conf_ip_unnumbered) {
		if (iproute_del(serv->ifindex, ses->yiaddr, conf_proto))
			log_ppp_warn("ipoe: failed to delete route from interface '%s'\n", serv->ifname);
K
Kozlov Dmitry 已提交
791
	}
792 793

	if (ses->serv->opt_ifcfg)
794
		ipoe_serv_del_addr(ses->serv, ses->siaddr, lock);
795 796
}

K
Kozlov Dmitry 已提交
797
static void __ipoe_session_activate(struct ipoe_session *ses)
K
Kozlov Dmitry 已提交
798
{
799 800
	uint32_t addr;

801 802
	if (ses->terminating)
		return;
803
	
804
	if (ses->ifindex != -1) {
K
Kozlov Dmitry 已提交
805
		addr = 0;
806 807 808 809 810 811
		if (!ses->ses.ipv4) {
			if (ses->serv->opt_mode == MODE_L3) {
				addr = 1;
				ses->ctrl.dont_ifcfg = 1;
			}
		} else if (ses->ses.ipv4->peer_addr != ses->yiaddr)
812
			addr = ses->ses.ipv4->peer_addr;
813 814
		else if (!conf_ip_unnumbered)
			ses->ctrl.dont_ifcfg = 1;
K
Kozlov Dmitry 已提交
815
		
816
		if (ipoe_nl_modify(ses->ifindex, ses->yiaddr, addr, NULL, NULL)) {
817 818 819
			ap_session_terminate(&ses->ses, TERM_NAS_ERROR, 0);
			return;
		}
K
Kozlov Dmitry 已提交
820
	}
821
	
822 823 824 825 826 827 828
	if (!ses->ses.ipv4) {
		ses->ses.ipv4 = &ses->ipv4;
		ses->ipv4.owner = NULL;
		ses->ipv4.peer_addr = ses->yiaddr;
		ses->ipv4.addr = ses->siaddr;
	}
	
829 830 831
	if (ses->ifindex == -1) {
		if (ses->serv->opt_ifcfg || (ses->serv->opt_mode == MODE_L2))
			ipoe_ifcfg_add(ses);
832 833 834 835 836 837
	
		ipoe_nl_add_exclude(ses->yiaddr, 32);

		iproute_add(ses->serv->ifindex, ses->siaddr, ses->yiaddr, conf_proto);
		
		ses->ctrl.dont_ifcfg = 1;
838 839
	} else if (ses->ctrl.dont_ifcfg)
		ipaddr_add(ses->ifindex, ses->siaddr, ses->mask);
840 841 842
	
	if (ses->l4_redirect)
		ipoe_change_l4_redirect(ses, 0);
843 844 845 846 847 848 849 850
	
	if (ses->serv->opt_mode == MODE_L2 && ses->serv->opt_ipv6 && sock6_fd != -1) {
		ses->ses.ipv6 = ipdb_get_ipv6(&ses->ses);
		if (!ses->ses.ipv6)
			log_ppp_warn("ipoe: no free IPv6 address\n");
		if (!ses->ses.ipv6->peer_intf_id)
			ses->ses.ipv6->peer_intf_id = htobe64(1);
	}
851

D
Dmitry Kozlov 已提交
852 853 854 855
	__sync_sub_and_fetch(&stat_starting, 1);
	__sync_add_and_fetch(&stat_active, 1);
	ses->started = 1;

K
Kozlov Dmitry 已提交
856 857
	ap_session_activate(&ses->ses);

858 859
	if (ses->dhcpv4_request) {
		if (ses->ses.state == AP_STATE_ACTIVE)
860
			dhcpv4_send_reply(DHCPACK, ses->serv->dhcpv4, ses->dhcpv4_request, ses->yiaddr, ses->siaddr, ses->router, ses->mask, ses->lease_time, ses->dhcpv4_relay_reply);
861 862
		else
			dhcpv4_send_nak(ses->serv->dhcpv4, ses->dhcpv4_request);
K
Kozlov Dmitry 已提交
863

864 865 866
		dhcpv4_packet_free(ses->dhcpv4_request);
		ses->dhcpv4_request = NULL;
	}
K
Kozlov Dmitry 已提交
867 868
	
	ses->timer.expire = ipoe_session_timeout;
869
	ses->timer.period = 0;
K
Kozlov Dmitry 已提交
870 871 872
	ses->timer.expire_tv.tv_sec = conf_lease_timeout ? conf_lease_timeout : ses->lease_time;
	if (ses->timer.tpd)
		triton_timer_mod(&ses->timer, 0);
K
Kozlov Dmitry 已提交
873 874
}

875
static void ipoe_session_activate(struct dhcpv4_packet *pack)
K
Kozlov Dmitry 已提交
876
{
877 878 879 880 881 882 883 884 885 886 887 888
	struct ipoe_session *ses = container_of(triton_context_self(), typeof(*ses), ctx);
	
	if (ses->ses.state == AP_STATE_ACTIVE) {
		ipoe_session_keepalive(pack);
		return;
	}

	if (ses->dhcpv4_request)
		dhcpv4_packet_free(ses->dhcpv4_request);
	
	ses->dhcpv4_request = pack;

K
Kozlov Dmitry 已提交
889
	if (ses->serv->dhcpv4_relay)
890
		dhcpv4_relay_send(ses->serv->dhcpv4_relay, ses->dhcpv4_request, ses->relay_server_id, ses->serv->ifname, conf_agent_remote_id);
K
Kozlov Dmitry 已提交
891 892 893 894 895
	else
		__ipoe_session_activate(ses);
}

static void ipoe_session_keepalive(struct dhcpv4_packet *pack)
K
Kozlov Dmitry 已提交
896
{
K
Kozlov Dmitry 已提交
897 898 899 900 901 902 903
	struct ipoe_session *ses = container_of(triton_context_self(), typeof(*ses), ctx);

	if (ses->dhcpv4_request)
		dhcpv4_packet_free(ses->dhcpv4_request);
	
	ses->dhcpv4_request = pack;

K
Kozlov Dmitry 已提交
904 905 906 907
	if (ses->timer.tpd)
		triton_timer_mod(&ses->timer, 0);

	ses->xid = ses->dhcpv4_request->hdr->xid;
K
Kozlov Dmitry 已提交
908
	
909
	if (/*ses->ses.state == AP_STATE_ACTIVE &&*/ ses->serv->dhcpv4_relay) {
910
		dhcpv4_relay_send(ses->serv->dhcpv4_relay, ses->dhcpv4_request, ses->relay_server_id, ses->serv->ifname, conf_agent_remote_id);
K
Kozlov Dmitry 已提交
911 912
		return;
	}
K
Kozlov Dmitry 已提交
913

K
Kozlov Dmitry 已提交
914
	if (ses->ses.state == AP_STATE_ACTIVE) {
915
		dhcpv4_send_reply(DHCPACK, ses->serv->dhcpv4, ses->dhcpv4_request, ses->yiaddr, ses->siaddr, ses->router, ses->mask, ses->lease_time, ses->dhcpv4_relay_reply);
K
Kozlov Dmitry 已提交
916
	} else
K
Kozlov Dmitry 已提交
917 918 919 920 921
		dhcpv4_send_nak(ses->serv->dhcpv4, ses->dhcpv4_request);

	dhcpv4_packet_free(ses->dhcpv4_request);
	ses->dhcpv4_request = NULL;
}
K
Kozlov Dmitry 已提交
922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938
			
static void ipoe_session_decline(struct dhcpv4_packet *pack)
{
	struct ipoe_session *ses = container_of(triton_context_self(), typeof(*ses), ctx);

	if (conf_verbose) {
		log_ppp_info2("recv ");
		dhcpv4_print_packet(pack, 0, log_ppp_info2);
	}
	
	if (pack->msg_type == DHCPDECLINE && ses->serv->dhcpv4_relay)
		dhcpv4_relay_send(ses->serv->dhcpv4_relay, pack, 0, ses->serv->ifname, conf_agent_remote_id);

	dhcpv4_packet_free(pack);

	ap_session_terminate(&ses->ses, TERM_USER_REQUEST, 0);
}
K
Kozlov Dmitry 已提交
939

K
Kozlov Dmitry 已提交
940 941 942 943
static void ipoe_session_started(struct ap_session *s)
{
	struct ipoe_session *ses = container_of(s, typeof(*ses), ses);
	
944
	log_ppp_info1("ipoe: session started\n");
K
Kozlov Dmitry 已提交
945

K
Kozlov Dmitry 已提交
946 947
	if (ses->timer.tpd)
		triton_timer_mod(&ses->timer, 0);
948 949 950 951 952 953 954 955 956
	
	if (ses->ifindex != -1 && ses->xid) {
		ses->dhcpv4 = dhcpv4_create(ses->ctrl.ctx, ses->ses.ifname, "");
		if (!ses->dhcpv4) {
			//terminate
			return;
		}
		ses->dhcpv4->recv = ipoe_ses_recv_dhcpv4;
	}
K
Kozlov Dmitry 已提交
957 958 959 960
}

static void ipoe_session_free(struct ipoe_session *ses)
{
D
Dmitry Kozlov 已提交
961 962 963 964 965
	if (ses->started)
		__sync_sub_and_fetch(&stat_active, 1);
	else
		__sync_sub_and_fetch(&stat_starting, 1);
	
K
Kozlov Dmitry 已提交
966 967 968
	if (ses->timer.tpd)
		triton_timer_del(&ses->timer);

K
Kozlov Dmitry 已提交
969 970 971
	if (ses->dhcpv4_request)
		dhcpv4_packet_free(ses->dhcpv4_request);
	
972 973 974
	if (ses->dhcpv4_relay_reply)
		dhcpv4_packet_free(ses->dhcpv4_relay_reply);
	
975 976 977 978 979 980
	if (ses->ctrl.called_station_id)
		_free(ses->ctrl.called_station_id);
	
	if (ses->ctrl.calling_station_id)
		_free(ses->ctrl.calling_station_id);

K
Kozlov Dmitry 已提交
981 982 983 984
	triton_context_unregister(&ses->ctx);
	
	if (ses->data)
		_free(ses->data);
985
	
K
Kozlov Dmitry 已提交
986 987 988 989 990 991
	mempool_free(ses);
}

static void ipoe_session_finished(struct ap_session *s)
{
	struct ipoe_session *ses = container_of(s, typeof(*ses), ses);
992
	struct unit_cache *uc;
K
Kozlov Dmitry 已提交
993

994
	log_ppp_info1("ipoe: session finished\n");
K
Kozlov Dmitry 已提交
995 996 997

	pthread_mutex_lock(&ses->serv->lock);
	list_del(&ses->entry);
D
Dmitry Kozlov 已提交
998 999
	if  ((ses->serv->vid || ses->serv->need_close) && list_empty(&ses->serv->sessions))
		triton_context_call(&ses->serv->ctx, (triton_event_func)ipoe_serv_release, ses->serv);
K
Kozlov Dmitry 已提交
1000 1001
	pthread_mutex_unlock(&ses->serv->lock);

1002 1003 1004 1005 1006 1007 1008 1009 1010 1011
	if (ses->ifindex != -1) {
		if (uc_size < conf_unit_cache && ipoe_nl_modify(ses->ifindex, 0, 0, "", NULL)) {
			uc = mempool_alloc(uc_pool);
			uc->ifindex = ses->ifindex;
			pthread_mutex_lock(&uc_lock);
			list_add_tail(&uc->entry, &uc_list);
			++uc_size;
			pthread_mutex_unlock(&uc_lock);
		} else
			ipoe_nl_delete(ses->ifindex);
1012 1013
	} else
		ipoe_nl_del_exclude(ses->yiaddr);
1014

1015
	if (ses->dhcp_addr)
1016
		dhcpv4_put_ip(ses->serv->dhcpv4, ses->yiaddr);
1017

K
Kozlov Dmitry 已提交
1018
	if (ses->relay_addr && ses->serv->dhcpv4_relay)
1019
		dhcpv4_relay_send_release(ses->serv->dhcpv4_relay, ses->hwaddr, ses->xid, ses->yiaddr, ses->client_id, ses->relay_agent, ses->serv->ifname, conf_agent_remote_id);
1020

1021
	if (s->ipv4 && s->ipv4->owner) {
1022 1023 1024 1025
		ipdb_put_ipv4(s, s->ipv4);
		s->ipv4 = NULL;
	}

1026
	if (ses->ifcfg)
D
Dmitry Kozlov 已提交
1027
		ipoe_ifcfg_del(ses, 1);
1028 1029 1030
	
	if (ses->dhcpv4)
		dhcpv4_free(ses->dhcpv4);
1031 1032

	triton_event_fire(EV_CTRL_FINISHED, s);
K
Kozlov Dmitry 已提交
1033
	
K
Kozlov Dmitry 已提交
1034 1035 1036 1037 1038
	triton_context_call(&ses->ctx, (triton_event_func)ipoe_session_free, ses);
}

static void ipoe_session_terminate(struct ap_session *s, int hard)
{
1039 1040
	struct ipoe_session *ses = container_of(s, typeof(*ses), ses);

K
Kozlov Dmitry 已提交
1041
	if (ses->l4_redirect_set)
1042 1043
		ipoe_change_l4_redirect(ses, 1);

K
Kozlov Dmitry 已提交
1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057
	ap_session_finished(s);
}


static void ipoe_session_close(struct triton_context_t *ctx)
{
	struct ipoe_session *ses = container_of(ctx, typeof(*ses), ctx);
	
	if (ses->ses.state)
		ap_session_terminate(&ses->ses, TERM_ADMIN_RESET, 1);
	else
		ipoe_session_finished(&ses->ses);
}

1058
static struct ipoe_session *ipoe_session_create_dhcpv4(struct ipoe_serv *serv, struct dhcpv4_packet *pack)
K
Kozlov Dmitry 已提交
1059 1060 1061
{
	struct ipoe_session *ses;
	int dlen = 0;
1062
	uint8_t *ptr = NULL;
K
Kozlov Dmitry 已提交
1063
	
1064 1065
	ses = ipoe_session_alloc();
	if (!ses)
K
Kozlov Dmitry 已提交
1066 1067 1068 1069
		return NULL;

	ses->serv = serv;
	ses->dhcpv4_request = pack;
1070
	strncpy(ses->ses.ifname, serv->ifname, AP_IFNAME_LEN);
K
Kozlov Dmitry 已提交
1071 1072 1073 1074
	
	ses->xid = pack->hdr->xid;
	memcpy(ses->hwaddr, pack->hdr->chaddr, 6);
	ses->giaddr = pack->hdr->giaddr;
K
Kozlov Dmitry 已提交
1075
	ses->lease_time = conf_lease_time;
K
Kozlov Dmitry 已提交
1076 1077

	if (pack->client_id)
K
Kozlov Dmitry 已提交
1078 1079 1080 1081
		dlen += sizeof(struct dhcpv4_option) + pack->client_id->len;
	
	if (pack->relay_agent)
		dlen += sizeof(struct dhcpv4_option) + pack->relay_agent->len;
K
Kozlov Dmitry 已提交
1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093
	
	if (dlen) {
		ses->data = _malloc(dlen);
		if (!ses->data) {
			log_emerg("out of memery\n");
			mempool_free(ses);
			return NULL;
		}
		ptr = ses->data;
	}

	if (pack->client_id) {
K
Kozlov Dmitry 已提交
1094
		ses->client_id = (struct dhcpv4_option *)ptr;
K
Kozlov Dmitry 已提交
1095
		ses->client_id->len = pack->client_id->len;
1096
		ses->client_id->data = (uint8_t *)(ses->client_id + 1);
K
Kozlov Dmitry 已提交
1097
		memcpy(ses->client_id->data, pack->client_id->data, pack->client_id->len);
K
Kozlov Dmitry 已提交
1098 1099 1100 1101 1102 1103
		ptr += sizeof(struct dhcpv4_option) + pack->client_id->len;
	}
	
	if (pack->relay_agent) {
		ses->relay_agent = (struct dhcpv4_option *)ptr;
		ses->relay_agent->len = pack->relay_agent->len;
1104
		ses->relay_agent->data = (uint8_t *)(ses->relay_agent + 1);
K
Kozlov Dmitry 已提交
1105 1106 1107 1108
		memcpy(ses->relay_agent->data, pack->relay_agent->data, pack->relay_agent->len);
		ptr += sizeof(struct dhcpv4_option) + pack->relay_agent->len;
		if (dhcpv4_parse_opt82(ses->relay_agent, &ses->agent_circuit_id, &ses->agent_remote_id))
			ses->relay_agent = NULL;
K
Kozlov Dmitry 已提交
1109 1110
	}

1111
	ses->ctrl.dont_ifcfg = 1;
K
Kozlov Dmitry 已提交
1112 1113
	
	ses->ctrl.calling_station_id = _malloc(19);
1114
	ses->ctrl.called_station_id = _strdup(serv->ifname);
K
Kozlov Dmitry 已提交
1115 1116 1117 1118 1119 1120 1121 1122
	
	ptr = ses->hwaddr;
	sprintf(ses->ctrl.calling_station_id, "%02x:%02x:%02x:%02x:%02x:%02x",
		ptr[0], ptr[1], ptr[2], ptr[3], ptr[4], ptr[5]);
	
	ses->ses.ctrl = &ses->ctrl;
	ses->ses.chan_name = ses->ctrl.calling_station_id;

1123 1124 1125
	if (conf_ip_pool)
		ses->ses.ipv4_pool_name = _strdup(conf_ip_pool);

K
Kozlov Dmitry 已提交
1126 1127 1128 1129 1130 1131 1132
	triton_context_register(&ses->ctx, &ses->ses);

	triton_context_wakeup(&ses->ctx);

	//pthread_mutex_lock(&serv->lock);
	list_add_tail(&ses->entry, &serv->sessions);
	//pthread_mutex_unlock(&serv->lock);
D
Dmitry Kozlov 已提交
1133 1134 1135
	
	if (serv->timer.tpd)
		triton_timer_del(&serv->timer);
K
Kozlov Dmitry 已提交
1136 1137 1138 1139 1140 1141

	triton_context_call(&ses->ctx, (triton_event_func)ipoe_session_start, ses);

	return ses;
}

K
Kozlov Dmitry 已提交
1142 1143 1144 1145 1146
static void __ipoe_session_terminate(struct ap_session *ses)
{
	ap_session_terminate(ses, TERM_USER_REQUEST, 0);
}

1147 1148 1149
static void ipoe_ses_recv_dhcpv4(struct dhcpv4_serv *dhcpv4, struct dhcpv4_packet *pack)
{
	struct ipoe_session *ses = container_of(dhcpv4->ctx, typeof(*ses), ctx);
K
Kozlov Dmitry 已提交
1150 1151 1152
	int opt82_match;
	uint8_t *agent_circuit_id = NULL;
	uint8_t *agent_remote_id = NULL;
1153 1154 1155

	if (ap_shutdown)
		return;
1156
	
1157 1158
	if (conf_verbose) {
		log_ppp_info2("recv ");
1159
		dhcpv4_print_packet(pack, 0, log_ppp_info2);
1160
	}
K
Kozlov Dmitry 已提交
1161 1162 1163 1164 1165 1166

	if (pack->relay_agent && dhcpv4_parse_opt82(pack->relay_agent, &agent_circuit_id, &agent_remote_id)) {
		agent_circuit_id = NULL;
		agent_remote_id = NULL;
	}

1167
	opt82_match = pack->relay_agent != NULL;
K
Kozlov Dmitry 已提交
1168
	
1169
	if (agent_circuit_id && !ses->agent_circuit_id)
K
Kozlov Dmitry 已提交
1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196
		opt82_match = 0;
	
	if (opt82_match && agent_remote_id && !ses->agent_remote_id)
		opt82_match = 0;
	
	if (opt82_match && !agent_circuit_id && ses->agent_circuit_id)
		opt82_match = 0;
	
	if (opt82_match && !agent_remote_id && ses->agent_remote_id)
		opt82_match = 0;
	
	if (opt82_match && agent_circuit_id) {
		if (*agent_circuit_id != *ses->agent_circuit_id)
			opt82_match = 0;
	
		if (memcmp(agent_circuit_id + 1, ses->agent_circuit_id + 1, *agent_circuit_id))
			opt82_match = 0;
	}
	
	if (opt82_match && agent_remote_id) {
		if (*agent_remote_id != *ses->agent_remote_id)
			opt82_match = 0;

		if (memcmp(agent_remote_id + 1, ses->agent_remote_id + 1, *agent_remote_id))
			opt82_match = 0;
	}

1197
	if (pack->relay_agent && !opt82_match) {
K
Kozlov Dmitry 已提交
1198 1199 1200 1201 1202 1203
		log_ppp_info2("port change detected\n");
		if (pack->msg_type == DHCPREQUEST)
			dhcpv4_send_nak(dhcpv4, pack);
		triton_context_call(ses->ctrl.ctx, (triton_event_func)__ipoe_session_terminate, &ses->ses);
		return;
	}
D
Dmitry Kozlov 已提交
1204

1205 1206 1207 1208
	if (pack->msg_type == DHCPDISCOVER) {
		if (ses->yiaddr) {
			if (ses->serv->dhcpv4_relay) {
				dhcpv4_packet_ref(pack);
K
Kozlov Dmitry 已提交
1209
				ipoe_session_keepalive(pack);
1210 1211 1212 1213
			} else
				dhcpv4_send_reply(DHCPOFFER, dhcpv4, pack, ses->yiaddr, ses->siaddr, ses->router, ses->mask, ses->lease_time, ses->dhcpv4_relay_reply);
		}
	} else if (pack->msg_type == DHCPREQUEST) {
D
Dmitry Kozlov 已提交
1214
		ses->xid = pack->hdr->xid;
1215 1216 1217 1218 1219 1220 1221 1222 1223 1224
		if (pack->hdr->ciaddr == ses->yiaddr && pack->hdr->xid != ses->xid)
			ses->xid = pack->hdr->xid;
		if ((pack->server_id && (pack->server_id != ses->siaddr || pack->request_ip != ses->yiaddr)) ||
			(pack->hdr->ciaddr && (pack->hdr->xid != ses->xid || pack->hdr->ciaddr != ses->yiaddr))) {

			if (pack->server_id == ses->siaddr)
				dhcpv4_send_nak(dhcpv4, pack);
			else if (ses->serv->dhcpv4_relay)
				dhcpv4_relay_send(ses->serv->dhcpv4_relay, pack, 0, ses->serv->ifname, conf_agent_remote_id);
			
K
Kozlov Dmitry 已提交
1225
			triton_context_call(ses->ctrl.ctx, (triton_event_func)__ipoe_session_terminate, &ses->ses);
1226 1227 1228 1229 1230 1231
		} else {
			dhcpv4_packet_ref(pack);
			ipoe_session_keepalive(pack);
		}
	} else if (pack->msg_type == DHCPDECLINE || pack->msg_type == DHCPRELEASE) {
		dhcpv4_packet_ref(pack);
K
Kozlov Dmitry 已提交
1232
		triton_context_call(ses->ctrl.ctx, (triton_event_func)ipoe_session_decline, pack);
1233 1234 1235
	}
}

D
Dmitry Kozlov 已提交
1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312
static void ipoe_serv_disc_timer(struct triton_timer_t *t)
{
	struct ipoe_serv *serv = container_of(t, typeof(*serv), disc_timer);
	struct disc_item *d;
	struct timespec ts;
	int delay, offer_delay;

	clock_gettime(CLOCK_MONOTONIC, &ts);
	
	while (!list_empty(&serv->disc_list)) {	
	  d = list_entry(serv->disc_list.next, typeof(*d), entry);
			
		delay = (ts.tv_sec - d->ts.tv_sec) * 1000 + (ts.tv_nsec - d->ts.tv_nsec) / 1000000;
		offer_delay = get_offer_delay();

		if (delay < offer_delay - 1) {
			delay = offer_delay - delay;
			t->expire_tv.tv_sec = delay / 1000;
			t->expire_tv.tv_usec = (delay % 1000) * 1000;
			triton_timer_mod(t, 0);
			return;
		}
	
		__ipoe_recv_dhcpv4(serv->dhcpv4, d->pack, 1);

		list_del(&d->entry);
		dhcpv4_packet_free(d->pack);
		mempool_free(d);

		__sync_sub_and_fetch(&stat_delayed_offer, 1);
	}

	triton_timer_del(t);
}

static void ipoe_serv_add_disc(struct ipoe_serv *serv, struct dhcpv4_packet *pack, int offer_delay)
{
	struct disc_item *d = mempool_alloc(disc_item_pool);

	if (!d)
		return;
		
	__sync_add_and_fetch(&stat_delayed_offer, 1);
	
	dhcpv4_packet_ref(pack);
	d->pack = pack;
	clock_gettime(CLOCK_MONOTONIC, &d->ts);
	list_add_tail(&d->entry, &serv->disc_list);
		
	if (!serv->disc_timer.tpd) {
		serv->disc_timer.expire_tv.tv_sec = offer_delay / 1000;
		serv->disc_timer.expire_tv.tv_usec = (offer_delay % 1000) * 1000;
		triton_timer_add(&serv->ctx, &serv->disc_timer, 0);
	}
}

static void ipoe_serv_check_disc(struct ipoe_serv *serv, struct dhcpv4_packet *pack)
{
	struct disc_item *d;

	list_for_each_entry(d, &serv->disc_list, entry) {
		if (d->pack->hdr->xid != pack->hdr->xid)
			continue;

		if (memcmp(d->pack->hdr->chaddr, pack->hdr->chaddr, ETH_ALEN))
			continue;
		
		list_del(&d->entry);
		dhcpv4_packet_free(d->pack);
		mempool_free(d);
		
		__sync_sub_and_fetch(&stat_delayed_offer, 1);
		
		break;
	}
}

1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348
static int ipoe_serv_request_check(struct ipoe_serv *serv, uint32_t xid)
{
	struct request_item *r;
	struct list_head *pos, *n;
	struct timespec ts;

	clock_gettime(CLOCK_MONOTONIC, &ts);

	list_for_each_safe(pos, n, &serv->req_list) {
		r = list_entry(pos, typeof(*r), entry);
		if (r->xid == xid) {
			if (++r->cnt == conf_max_request) {
				list_del(&r->entry);
				mempool_free(r);
				return 1;
			}

			r->expire = ts.tv_sec + 30;
			return 0;
		}

		if (ts.tv_sec > r->expire) {
			list_del(&r->entry);
			mempool_free(r);
		}
	}
	
	r = mempool_alloc(req_item_pool);
	r->xid = xid;
	r->expire = ts.tv_sec + 30;
	r->cnt = 0;
	list_add_tail(&r->entry, &serv->req_list);

	return 0;
}

D
Dmitry Kozlov 已提交
1349
static void __ipoe_recv_dhcpv4(struct dhcpv4_serv *dhcpv4, struct dhcpv4_packet *pack, int force)
K
Kozlov Dmitry 已提交
1350 1351
{
	struct ipoe_serv *serv = container_of(dhcpv4->ctx, typeof(*serv), ctx);
K
Kozlov Dmitry 已提交
1352
	struct ipoe_session *ses, *opt82_ses;
D
Dmitry Kozlov 已提交
1353
	int offer_delay;
K
Kozlov Dmitry 已提交
1354 1355
	//struct dhcpv4_packet *reply;

D
Dmitry Kozlov 已提交
1356 1357 1358
	if (serv->timer.tpd)
		triton_timer_mod(&serv->timer, 0);

1359 1360
	if (ap_shutdown)
		return;
1361
	
1362
	if (connlimit_loaded && pack->msg_type == DHCPDISCOVER && connlimit_check(serv->opt_shared ? cl_key_from_mac(pack->hdr->chaddr) : serv->ifindex))
1363
		return;
1364

K
Kozlov Dmitry 已提交
1365 1366
	pthread_mutex_lock(&serv->lock);
	if (pack->msg_type == DHCPDISCOVER) {
K
Kozlov Dmitry 已提交
1367
		ses = ipoe_session_lookup(serv, pack, &opt82_ses);
K
Kozlov Dmitry 已提交
1368
		if (!ses) {
1369 1370
			if (serv->opt_shared == 0)
				ipoe_drop_sessions(serv, NULL);
K
Kozlov Dmitry 已提交
1371 1372 1373 1374 1375 1376
			else if (opt82_ses) {
				if (conf_verbose)
					log_ppp_warn("mac change detected\n");

				triton_context_call(&opt82_ses->ctx, (triton_event_func)__ipoe_session_terminate, &opt82_ses->ses);
			}
1377

D
Dmitry Kozlov 已提交
1378 1379 1380 1381 1382 1383 1384 1385 1386
			offer_delay = get_offer_delay();
			if (offer_delay == -1)
				goto out;

			if (offer_delay && !force) {
				ipoe_serv_add_disc(serv, pack, offer_delay);
				goto out;
			}

1387
			ses = ipoe_session_create_dhcpv4(serv, pack);
K
Kozlov Dmitry 已提交
1388 1389
			if (ses) {
				dhcpv4_packet_ref(pack);
K
Kozlov Dmitry 已提交
1390

K
Kozlov Dmitry 已提交
1391 1392 1393 1394 1395
				if (conf_verbose) {
					log_switch(dhcpv4->ctx, &ses->ses);
					log_ppp_info2("recv ");
					dhcpv4_print_packet(pack, 0, log_ppp_info2);
				}
K
Kozlov Dmitry 已提交
1396 1397
			}
		}	else {
K
Kozlov Dmitry 已提交
1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409
			if ((opt82_ses && ses != opt82_ses) || (!opt82_ses && pack->relay_agent)) {
				if (conf_verbose) {
					log_switch(dhcpv4->ctx, &ses->ses);
					log_ppp_info2("recv ");
					dhcpv4_print_packet(pack, 0, log_ppp_info2);
					log_ppp_warn("port change detected\n");
				}

				triton_context_call(&ses->ctx, (triton_event_func)__ipoe_session_terminate, &ses->ses);
				goto out;
			}

K
Kozlov Dmitry 已提交
1410 1411 1412 1413
			log_switch(dhcpv4->ctx, &ses->ses);

			if (conf_verbose) {
				log_ppp_info2("recv ");
K
Kozlov Dmitry 已提交
1414
				dhcpv4_print_packet(pack, 0, log_ppp_info2);
K
Kozlov Dmitry 已提交
1415 1416
			}

1417 1418
			if (ses->yiaddr)
				dhcpv4_send_reply(DHCPOFFER, dhcpv4, pack, ses->yiaddr, ses->siaddr, ses->router, ses->mask, ses->lease_time, ses->dhcpv4_relay_reply);
K
Kozlov Dmitry 已提交
1419 1420
		}
	} else if (pack->msg_type == DHCPREQUEST) {
D
Dmitry Kozlov 已提交
1421 1422
		ipoe_serv_check_disc(serv, pack);
		
K
Kozlov Dmitry 已提交
1423
		ses = ipoe_session_lookup(serv, pack, &opt82_ses);
K
Kozlov Dmitry 已提交
1424 1425 1426

		if (!ses) {
			if (conf_verbose) {
1427
				log_debug("%s: recv ", serv->ifname);
D
Dmitry Kozlov 已提交
1428
				dhcpv4_print_packet(pack, 0, log_debug);
K
Kozlov Dmitry 已提交
1429
			}
D
Dmitry Kozlov 已提交
1430

1431 1432 1433 1434
			if (!pack->server_id)
				dhcpv4_send_nak(dhcpv4, pack);

			if (serv->opt_shared == 0)
1435
				ipoe_drop_sessions(serv, NULL);
1436
			else if (opt82_ses) {
K
Kozlov Dmitry 已提交
1437 1438 1439 1440 1441 1442
				if (conf_verbose) {
					log_switch(dhcpv4->ctx, &opt82_ses->ses);
					log_ppp_warn("mac change detected\n");
				}
				
				triton_context_call(&opt82_ses->ctx, (triton_event_func)__ipoe_session_terminate, &opt82_ses->ses);
1443 1444
			} else if (list_empty(&conf_offer_delay) || ipoe_serv_request_check(serv, pack->hdr->xid))
				dhcpv4_send_nak(dhcpv4, pack);
K
Kozlov Dmitry 已提交
1445
		} else {
D
Dmitry Kozlov 已提交
1446 1447
			ses->xid = pack->hdr->xid;

1448
			if ((pack->server_id && (pack->server_id != ses->siaddr || pack->request_ip != ses->yiaddr)) ||
K
Kozlov Dmitry 已提交
1449 1450
				(pack->hdr->ciaddr && (pack->hdr->xid != ses->xid || pack->hdr->ciaddr != ses->yiaddr)) ||
				(opt82_ses && ses != opt82_ses) || (!opt82_ses && pack->relay_agent)) {
K
Kozlov Dmitry 已提交
1451

K
Kozlov Dmitry 已提交
1452
				if (conf_verbose) {
K
Kozlov Dmitry 已提交
1453 1454
					log_switch(dhcpv4->ctx, &ses->ses);
					log_ppp_info2("recv ");
1455
					dhcpv4_print_packet(pack, 0, log_ppp_info2);
K
Kozlov Dmitry 已提交
1456 1457
					if ((opt82_ses && ses != opt82_ses) || (!opt82_ses && pack->relay_agent))
						log_ppp_warn("port change detected\n");
K
Kozlov Dmitry 已提交
1458 1459
				}

K
Kozlov Dmitry 已提交
1460
				if (pack->server_id == ses->siaddr)
K
Kozlov Dmitry 已提交
1461
					dhcpv4_send_nak(dhcpv4, pack);
D
Dmitry Kozlov 已提交
1462 1463

				if (ses->serv->dhcpv4_relay)
1464
					dhcpv4_relay_send(ses->serv->dhcpv4_relay, pack, 0, ses->serv->ifname, conf_agent_remote_id);
K
Kozlov Dmitry 已提交
1465 1466
				
				triton_context_call(&ses->ctx, (triton_event_func)__ipoe_session_terminate, &ses->ses);
K
Kozlov Dmitry 已提交
1467 1468 1469 1470
			} else {
				if (conf_verbose) {
					log_switch(dhcpv4->ctx, &ses->ses);
					log_ppp_info2("recv ");
K
Kozlov Dmitry 已提交
1471
					dhcpv4_print_packet(pack, 0, log_ppp_info2);
K
Kozlov Dmitry 已提交
1472 1473
				}

K
Kozlov Dmitry 已提交
1474
				if (serv->opt_shared == 0)
K
Kozlov Dmitry 已提交
1475 1476
					ipoe_drop_sessions(serv, ses);

1477
				if (ses->ses.state == AP_STATE_STARTING && ses->yiaddr) {
K
Kozlov Dmitry 已提交
1478
					dhcpv4_packet_ref(pack);
1479
					triton_context_call(&ses->ctx, (triton_event_func)ipoe_session_activate, pack);
K
Kozlov Dmitry 已提交
1480 1481 1482
				} else if (ses->ses.state == AP_STATE_ACTIVE) {
					dhcpv4_packet_ref(pack);
					triton_context_call(&ses->ctx, (triton_event_func)ipoe_session_keepalive, pack);
K
Kozlov Dmitry 已提交
1483 1484 1485 1486
				}
			}
		}
	} else if (pack->msg_type == DHCPDECLINE || pack->msg_type == DHCPRELEASE) {
K
Kozlov Dmitry 已提交
1487
		ses = ipoe_session_lookup(serv, pack, &opt82_ses);
K
Kozlov Dmitry 已提交
1488
		if (ses) {
D
Dmitry Kozlov 已提交
1489
			ses->xid = pack->hdr->xid;
K
Kozlov Dmitry 已提交
1490 1491
			dhcpv4_packet_ref(pack);
			triton_context_call(&ses->ctx, (triton_event_func)ipoe_session_decline, pack);
K
Kozlov Dmitry 已提交
1492
		}
K
Kozlov Dmitry 已提交
1493
	}
K
Kozlov Dmitry 已提交
1494 1495

out:
K
Kozlov Dmitry 已提交
1496 1497 1498
	pthread_mutex_unlock(&serv->lock);
}

D
Dmitry Kozlov 已提交
1499 1500 1501 1502 1503
static void ipoe_recv_dhcpv4(struct dhcpv4_serv *dhcpv4, struct dhcpv4_packet *pack)
{
	__ipoe_recv_dhcpv4(dhcpv4, pack, 0);
}

K
Kozlov Dmitry 已提交
1504 1505 1506 1507 1508 1509 1510 1511 1512
static int parse_dhcpv4_mask(uint32_t mask)
{
	int i;

	for (i = 31; i >= 0 && (mask & (1 << i)); i--);

	return 32 - (i + 1);
}

1513
static void ipoe_ses_recv_dhcpv4_relay(struct dhcpv4_packet *pack)
K
Kozlov Dmitry 已提交
1514
{
1515
	struct ipoe_session *ses = container_of(triton_context_self(), typeof(*ses), ctx);
K
Kozlov Dmitry 已提交
1516 1517
	struct dhcpv4_option *opt;

1518 1519 1520
	if (ses->dhcpv4_relay_reply)
		dhcpv4_packet_free(ses->dhcpv4_relay_reply);
	
1521 1522 1523 1524 1525
	if (!ses->dhcpv4_request) {
		ses->dhcpv4_relay_reply = NULL;
		return;
	}

1526 1527
	ses->dhcpv4_relay_reply = pack;

K
Kozlov Dmitry 已提交
1528 1529 1530 1531 1532
	if (conf_verbose) {
		log_ppp_info2("recv ");
		dhcpv4_print_packet(pack, 1, log_ppp_info2);
	}

1533 1534 1535
	opt = dhcpv4_packet_find_opt(pack, 51);
	if (opt)
		ses->lease_time = ntohl(*(uint32_t *)opt->data);
K
Kozlov Dmitry 已提交
1536

1537 1538 1539
	opt = dhcpv4_packet_find_opt(pack, 1);
	if (opt)
		ses->mask = parse_dhcpv4_mask(ntohl(*(uint32_t *)opt->data));
K
Kozlov Dmitry 已提交
1540

1541 1542 1543 1544
	opt = dhcpv4_packet_find_opt(pack, 3);
	if (opt)
		ses->router = *(uint32_t *)opt->data;

1545 1546 1547
	if (pack->msg_type == DHCPOFFER) {
		if (ses->ses.state == AP_STATE_STARTING) {
			triton_timer_del(&ses->timer);
K
Kozlov Dmitry 已提交
1548

1549 1550 1551 1552 1553 1554 1555 1556 1557 1558
			ses->relay_server_id = pack->server_id;

			if (!ses->yiaddr) {
				ses->yiaddr = pack->hdr->yiaddr;
				ses->relay_addr = 1;
			}

			__ipoe_session_start(ses);
		} else
			dhcpv4_send_reply(DHCPOFFER, ses->serv->dhcpv4, ses->dhcpv4_request, ses->yiaddr, ses->siaddr, ses->router, ses->mask, ses->lease_time, ses->dhcpv4_relay_reply);
K
Kozlov Dmitry 已提交
1559 1560 1561 1562
	} else if (pack->msg_type == DHCPACK) {
		if (ses->ses.state == AP_STATE_STARTING)
			__ipoe_session_activate(ses);
		else
1563
			dhcpv4_send_reply(DHCPACK, ses->serv->dhcpv4, ses->dhcpv4_request, ses->yiaddr, ses->siaddr, ses->router, ses->mask, ses->lease_time, ses->dhcpv4_relay_reply);
K
Kozlov Dmitry 已提交
1564 1565 1566 1567 1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582

	} else if (pack->msg_type == DHCPNAK) {
		dhcpv4_send_nak(ses->serv->dhcpv4, ses->dhcpv4_request);
		ap_session_terminate(&ses->ses, TERM_NAS_REQUEST, 0);
		return;
	}
		
	dhcpv4_packet_free(ses->dhcpv4_relay_reply);
	ses->dhcpv4_relay_reply = NULL;
}

static void ipoe_recv_dhcpv4_relay(struct dhcpv4_packet *pack)
{
	struct ipoe_serv *serv = container_of(triton_context_self(), typeof(*serv), ctx);
	struct ipoe_session *ses;
	int found = 0;
	//struct dhcpv4_packet *reply;

	if (ap_shutdown) {
K
Kozlov Dmitry 已提交
1583
		dhcpv4_packet_free(pack);
K
Kozlov Dmitry 已提交
1584 1585 1586 1587 1588 1589 1590 1591 1592 1593 1594 1595
		return;
	}

	pthread_mutex_lock(&serv->lock);
	list_for_each_entry(ses, &serv->sessions, entry) {
		if (ses->xid != pack->hdr->xid)
			continue;
		if (memcmp(ses->hwaddr, pack->hdr->chaddr, 6))
			continue;

		found = 1;
		break;
K
Kozlov Dmitry 已提交
1596
	}
K
Kozlov Dmitry 已提交
1597
	
1598 1599
	if (found) {
		triton_context_call(&ses->ctx, (triton_event_func)ipoe_ses_recv_dhcpv4_relay, pack);
K
Kozlov Dmitry 已提交
1600 1601 1602
	} else
		dhcpv4_packet_free(pack);

K
Kozlov Dmitry 已提交
1603 1604 1605
	pthread_mutex_unlock(&serv->lock);
}

K
Kozlov Dmitry 已提交
1606

1607 1608 1609 1610
static struct ipoe_session *ipoe_session_create_up(struct ipoe_serv *serv, struct ethhdr *eth, struct iphdr *iph)
{
	struct ipoe_session *ses;

1611 1612
	if (ap_shutdown)
		return NULL;
1613 1614 1615 1616
	
	if (l4_redirect_list_check(iph->saddr))
		return NULL;
	
1617 1618
	ses = ipoe_session_alloc();
	if (!ses)
1619 1620 1621 1622
		return NULL;

	ses->serv = serv;
	memcpy(ses->hwaddr, eth->h_source, 6);
1623
	ses->yiaddr = iph->saddr;
K
Kozlov Dmitry 已提交
1624

1625
	ses->ctrl.calling_station_id = _malloc(17);
1626
	ses->ctrl.called_station_id = _strdup(serv->ifname);
1627 1628

	u_inet_ntoa(iph->saddr, ses->ctrl.calling_station_id);
1629 1630
	
	ses->ses.chan_name = ses->ctrl.calling_station_id;
1631
	
1632 1633 1634
	if (conf_ip_pool)
		ses->ses.ipv4_pool_name = _strdup(conf_ip_pool);
	
1635 1636 1637 1638 1639 1640 1641 1642
	triton_context_register(&ses->ctx, &ses->ses);

	triton_context_wakeup(&ses->ctx);

	//pthread_mutex_lock(&serv->lock);
	list_add_tail(&ses->entry, &serv->sessions);
	//pthread_mutex_unlock(&serv->lock);

D
Dmitry Kozlov 已提交
1643 1644 1645
	if (serv->timer.tpd)
		triton_timer_del(&serv->timer);

1646 1647 1648 1649 1650
	triton_context_call(&ses->ctx, (triton_event_func)ipoe_session_start, ses);

	return ses;
}

1651 1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664 1665 1666 1667 1668 1669 1670 1671 1672 1673 1674 1675 1676
struct ipoe_session *ipoe_session_alloc(void)
{
	struct ipoe_session *ses;

	ses = mempool_alloc(ses_pool);
	if (!ses) {
		log_emerg("out of memery\n");
		return NULL;
	}

	memset(ses, 0, sizeof(*ses));

	ap_session_init(&ses->ses);

	ses->ifindex = -1;
	
	ses->ctx.before_switch = log_switch;
	ses->ctx.close = ipoe_session_close;
	ses->ctrl.ctx = &ses->ctx;
	ses->ctrl.started = ipoe_session_started;
	ses->ctrl.finished = ipoe_session_finished;
	ses->ctrl.terminate = ipoe_session_terminate;
	ses->ctrl.type = CTRL_TYPE_IPOE;
	ses->ctrl.name = "ipoe";

	ses->ses.ctrl = &ses->ctrl;
1677
	
1678 1679 1680
	return ses;
}

1681 1682 1683 1684 1685 1686 1687 1688
void ipoe_recv_up(int ifindex, struct ethhdr *eth, struct iphdr *iph)
{
	struct ipoe_serv *serv;
	struct ipoe_session *ses;

	list_for_each_entry(serv, &serv_list, entry) {
		if (serv->ifindex != ifindex)
			continue;
K
Kozlov Dmitry 已提交
1689 1690 1691

		if (!serv->opt_up)
			return;
1692 1693 1694
		
		pthread_mutex_lock(&serv->lock);
		list_for_each_entry(ses, &serv->sessions, entry) {
1695
			if (ses->yiaddr == iph->saddr) {
1696 1697 1698 1699 1700 1701 1702
				pthread_mutex_unlock(&serv->lock);
				return;
			}
		}
		pthread_mutex_unlock(&serv->lock);
		
		ipoe_session_create_up(serv, eth, iph);
1703 1704

		break;
1705 1706 1707
	}
}

1708 1709 1710 1711 1712 1713 1714 1715 1716 1717 1718 1719 1720
#ifdef RADIUS
static void ev_radius_access_accept(struct ev_radius_t *ev)
{
	struct ipoe_session *ses = container_of(ev->ses, typeof(*ses), ses);
	struct rad_attr_t *attr;

	if (ev->ses->ctrl->type != CTRL_TYPE_IPOE)
		return;

	list_for_each_entry(attr, &ev->reply->attrs, entry) {
		if (attr->attr->id == conf_attr_dhcp_client_ip)
			ses->yiaddr = attr->val.ipaddr;
		else if (attr->attr->id == conf_attr_dhcp_router_ip)
1721
			ses->router = attr->val.ipaddr;
1722
		else if (attr->attr->id == conf_attr_dhcp_mask) {
1723 1724 1725 1726 1727 1728 1729 1730 1731 1732
			if (attr->attr->type == ATTR_TYPE_INTEGER) {
				if (attr->val.integer > 0 && attr->val.integer < 31)
					ses->mask = attr->val.integer;
			} else if (attr->attr->type == ATTR_TYPE_IPADDR) {
#if __BYTE_ORDER == __LITTLE_ENDIAN
				ses->mask = ffs(~attr->val.ipaddr) - 1;
#else
				ses->mask = ffs(~htole32(attr->val.ipaddr)) - 1;
#endif
			}
1733 1734 1735 1736 1737 1738
		} else if (attr->attr->id == conf_attr_l4_redirect) {
			if (attr->attr->type == ATTR_TYPE_STRING) {
				if (attr->len && attr->val.string[0] != '0')
					ses->l4_redirect = 1;
			} else if (attr->val.integer != 0)
				ses->l4_redirect = 1;
1739 1740
		} else if (attr->attr->id == conf_attr_dhcp_lease_time)
			ses->lease_time = attr->val.integer;
1741 1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752 1753 1754 1755 1756 1757 1758 1759 1760 1761 1762 1763
	}
}

static void ev_radius_coa(struct ev_radius_t *ev)
{
	struct ipoe_session *ses = container_of(ev->ses, typeof(*ses), ses);
	struct rad_attr_t *attr;
	int l4_redirect;
	
	if (ev->ses->ctrl->type != CTRL_TYPE_IPOE)
		return;
	
	l4_redirect = ses->l4_redirect;

	list_for_each_entry(attr, &ev->request->attrs, entry) {
		if (attr->attr->id == conf_attr_l4_redirect) {
			if (attr->attr->type == ATTR_TYPE_STRING)
				ses->l4_redirect = attr->len && attr->val.string[0] != '0';
			else
				ses->l4_redirect = ((unsigned int)attr->val.integer) > 0;
		} else if (strcmp(attr->attr->name, "Framed-IP-Address") == 0) {
			if (ses->ses.ipv4 && ses->ses.ipv4->peer_addr != attr->val.ipaddr)
				ipoe_change_addr(ses, attr->val.ipaddr);
1764 1765
		} else if (attr->attr->id == conf_attr_dhcp_lease_time)
			ses->lease_time = attr->val.integer;
1766 1767 1768
	}

	//if (l4_redirect && !ses->l4_redirect) || (!l4_redirect && ses->l4_redirect))
K
Kozlov Dmitry 已提交
1769
	if (l4_redirect != ses->l4_redirect && ev->ses->state == AP_STATE_ACTIVE)
1770 1771
		ipoe_change_l4_redirect(ses, l4_redirect);
}
1772 1773 1774 1775 1776 1777 1778 1779 1780 1781 1782

static int ipoe_rad_send_request(struct rad_plugin_t *rad, struct rad_packet_t *pack)
{
	struct ipoe_session *ses = container_of(rad, typeof(*ses), radius);

	if (!ses->relay_agent)
		return 0;
	
	return rad_packet_add_octets(pack, NULL, conf_attr_dhcp_opt82, ses->relay_agent->data, ses->relay_agent->len); 
}

1783 1784
#endif

D
Dmitry Kozlov 已提交
1785
static void ipoe_serv_release(struct ipoe_serv *serv)
K
Kozlov Dmitry 已提交
1786
{
1787 1788 1789 1790 1791 1792
	pthread_mutex_lock(&serv->lock);
	if (!list_empty(&serv->sessions)) {
		pthread_mutex_unlock(&serv->lock);
		return;
	}
	pthread_mutex_unlock(&serv->lock);
D
Dmitry Kozlov 已提交
1793

D
Dmitry Kozlov 已提交
1794
	if (serv->vid && !serv->need_close && !ap_shutdown) {
D
Dmitry Kozlov 已提交
1795 1796 1797 1798 1799 1800 1801 1802
		if (serv->timer.tpd)
			triton_timer_mod(&serv->timer, 0);
		else
			triton_timer_add(&serv->ctx, &serv->timer, 0);

		return;
	}
	
D
Dmitry Kozlov 已提交
1803 1804 1805 1806 1807
	log_info2("ipoe: stop interface %s\n", serv->ifname);

	pthread_mutex_lock(&serv_lock);
	list_del(&serv->entry);
	pthread_mutex_unlock(&serv_lock);
1808

K
Kozlov Dmitry 已提交
1809 1810
	if (serv->dhcpv4)
		dhcpv4_free(serv->dhcpv4);
K
Kozlov Dmitry 已提交
1811 1812
	
	if (serv->dhcpv4_relay) {
1813
		ipoe_serv_del_addr(serv, serv->dhcpv4_relay->giaddr, 0);
K
Kozlov Dmitry 已提交
1814 1815
		dhcpv4_relay_free(serv->dhcpv4_relay, &serv->ctx);
	}
K
Kozlov Dmitry 已提交
1816

1817 1818 1819
	if (serv->arp)
		arpd_stop(serv->arp);

D
Dmitry Kozlov 已提交
1820 1821 1822 1823 1824 1825 1826
	while (!list_empty(&serv->disc_list)) {
		struct disc_item *d = list_entry(serv->disc_list.next, typeof(*d), entry);
		list_del(&d->entry);
		dhcpv4_packet_free(d->pack);
		mempool_free(d);
		__sync_sub_and_fetch(&stat_delayed_offer, 1);
	}
1827 1828 1829 1830 1831 1832
	
	while (!list_empty(&serv->req_list)) {
		struct request_item *r = list_first_entry(&serv->req_list, typeof(*r), entry);
		list_del(&r->entry);
		mempool_free(r);
	}
D
Dmitry Kozlov 已提交
1833 1834 1835

	if (serv->disc_timer.tpd)
		triton_timer_del(&serv->disc_timer);
D
Dmitry Kozlov 已提交
1836 1837 1838 1839 1840 1841 1842 1843 1844
	
	if (serv->timer.tpd)
		triton_timer_del(&serv->timer);

	if (serv->vid) {
		log_info2("ipoe: remove vlan %s\n", serv->ifname);
		iplink_vlan_del(serv->ifindex);
		ipoe_nl_add_vlan_mon_vid(serv->parent_ifindex, serv->vid);
	}
D
Dmitry Kozlov 已提交
1845

D
Dmitry Kozlov 已提交
1846
	triton_context_unregister(&serv->ctx);
K
Kozlov Dmitry 已提交
1847 1848 1849 1850 1851

	_free(serv->ifname);
	_free(serv);
}

D
Dmitry Kozlov 已提交
1852 1853 1854 1855 1856 1857 1858 1859 1860 1861 1862 1863 1864 1865 1866
static void ipoe_serv_close(struct triton_context_t *ctx)
{
	struct ipoe_serv *serv = container_of(ctx, typeof(*serv), ctx);

	pthread_mutex_lock(&serv->lock);
	if (!list_empty(&serv->sessions)) {
		serv->need_close = 1;
		pthread_mutex_unlock(&serv->lock);
		return;
	}
	pthread_mutex_unlock(&serv->lock);

	ipoe_serv_release(serv);
}

1867 1868 1869 1870 1871 1872 1873 1874
static void l4_redirect_ctx_close(struct triton_context_t *ctx)
{
	struct l4_redirect *n;

	pthread_rwlock_wrlock(&l4_list_lock);
	while (!list_empty(&l4_redirect_list)) {
		n = list_entry(l4_redirect_list.next, typeof(*n), entry);
		list_del(&n->entry);
1875 1876 1877 1878 1879 1880 1881

		if (conf_l4_redirect_table)
			iprule_del(n->addr, conf_l4_redirect_table);
		
		if (conf_l4_redirect_ipset)
			ipset_del(conf_l4_redirect_ipset, n->addr);
		
1882
		ipoe_nl_del_exclude(n->addr);
1883
		
1884 1885 1886 1887 1888 1889 1890 1891 1892 1893
		_free(n);
	}
	pthread_rwlock_unlock(&l4_list_lock);

	if (l4_redirect_timer.tpd)
		triton_timer_del(&l4_redirect_timer);
	
	triton_context_unregister(&l4_redirect_ctx);
}

K
Kozlov Dmitry 已提交
1894 1895 1896 1897 1898
static int show_stat_exec(const char *cmd, char * const *fields, int fields_cnt, void *client)
{
	cli_send(client, "ipoe:\r\n");
	cli_sendv(client,"  starting: %u\r\n", stat_starting);
	cli_sendv(client,"  active: %u\r\n", stat_active);
D
Dmitry Kozlov 已提交
1899
	cli_sendv(client,"  delayed: %u\r\n", stat_delayed_offer);
K
Kozlov Dmitry 已提交
1900 1901 1902 1903 1904 1905 1906 1907 1908 1909

	return CLI_CMD_OK;
}

void __export ipoe_get_stat(unsigned int **starting, unsigned int **active)
{
	*starting = &stat_starting;
	*active = &stat_active;
}

K
Kozlov Dmitry 已提交
1910 1911 1912 1913 1914 1915
static void __terminate(struct ap_session *ses)
{
	ap_session_terminate(ses, TERM_NAS_REQUEST, 0);
}

static void ipoe_drop_sessions(struct ipoe_serv *serv, struct ipoe_session *skip)
K
Kozlov Dmitry 已提交
1916
{
K
Kozlov Dmitry 已提交
1917 1918 1919 1920 1921 1922
	struct ipoe_session *ses;

	list_for_each_entry(ses, &serv->sessions, entry) {
		if (ses == skip)
			continue;

1923 1924
		ses->terminating = 1;
		if (ses->ifcfg) {
D
Dmitry Kozlov 已提交
1925
			ipoe_ifcfg_del(ses, 0);
1926 1927 1928
			ses->ifcfg = 0;
		}

K
Kozlov Dmitry 已提交
1929 1930
		if (ses->ses.state == AP_STATE_ACTIVE)
			ap_session_ifdown(&ses->ses);
K
Kozlov Dmitry 已提交
1931

K
Kozlov Dmitry 已提交
1932 1933
		triton_context_call(&ses->ctx, (triton_event_func)__terminate, &ses->ses);
	}
K
Kozlov Dmitry 已提交
1934 1935
}

1936 1937 1938 1939 1940 1941 1942 1943 1944 1945 1946 1947
struct ipoe_serv *ipoe_find_serv(const char *ifname)
{
	struct ipoe_serv *serv;

	list_for_each_entry(serv, &serv_list, entry) {
		if (strcmp(serv->ifname, ifname) == 0)
			return serv;
	}

	return NULL;
}

D
Dmitry Kozlov 已提交
1948 1949 1950 1951 1952 1953 1954 1955 1956 1957 1958 1959 1960 1961 1962 1963 1964 1965
static int get_offer_delay()
{
	struct delay *r, *prev = NULL;

	list_for_each_entry(r, &conf_offer_delay, entry) {
		if (!prev || stat_active >= r->conn_cnt) {
			prev = r;
			continue;
		}
		break;
	}

	if (prev)
		return prev->delay;
	
	return 0;
}

1966 1967 1968 1969 1970 1971 1972 1973 1974 1975 1976 1977 1978 1979 1980 1981 1982 1983 1984 1985 1986 1987 1988 1989 1990 1991
static int make_vlan_name(const char *parent, int vid, char *name)
{
	char *ptr1 = name, *endptr = name + IFNAMSIZ - 1;
	const char *ptr2 = conf_vlan_name;
	char num[5], *ptr3 = num;

	sprintf(num, "%i", vid);

	while (ptr1 < endptr && *ptr2) {
		if (ptr2[0] == '%' && ptr2[1] == 'I') {
			while (ptr1 < endptr && *parent)
				*ptr1++ = *parent++;
			ptr2 += 2;
		} else if (ptr2[0] == '%' && ptr2[1] == 'N') {
			while (ptr1 < endptr && *ptr3)
				*ptr1++ = *ptr3++;
			ptr2 += 2;
		} else
			*ptr1++ = *ptr2++;
	}

	*ptr1 = 0;

	return ptr1 == endptr;
}

D
Dmitry Kozlov 已提交
1992 1993 1994 1995 1996 1997 1998 1999 2000 2001 2002
void ipoe_vlan_notify(int ifindex, int vid)
{
	struct conf_sect_t *sect = conf_get_section("ipoe");
	struct conf_option_t *opt;
	struct ifreq ifr;
	char *ptr;
	int len, r;
	pcre *re = NULL;
	const char *pcre_err;
	char *pattern;
	int pcre_offset;
2003
	char ifname[IFNAMSIZ];
D
Dmitry Kozlov 已提交
2004 2005 2006 2007 2008 2009 2010 2011 2012 2013 2014

	if (!sect)
		return;

	memset(&ifr, 0, sizeof(ifr));
	ifr.ifr_ifindex = ifindex;
	if (ioctl(sock_fd, SIOCGIFNAME, &ifr, sizeof(ifr))) {
		log_error("ipoe: vlan-mon: failed to get interface name, ifindex=%i\n", ifindex);
		return;
	}
	
2015
	if (make_vlan_name(ifr.ifr_name, vid, ifname)) {
D
Dmitry Kozlov 已提交
2016 2017 2018
		log_error("ipoe: vlan-mon: %s.%i: interface name is too long\n", ifr.ifr_name, vid);
		return;
	}
D
Dmitry Kozlov 已提交
2019 2020
	
	log_info2("ipoe: create vlan %s parent %s\n", ifname, ifr.ifr_name);
2021 2022

	strcpy(ifr.ifr_name, ifname);
D
Dmitry Kozlov 已提交
2023 2024
	len = strlen(ifr.ifr_name);

D
Dmitry Kozlov 已提交
2025
	if (iplink_vlan_add(ifr.ifr_name, ifindex, vid)) {
D
Dmitry Kozlov 已提交
2026
		log_warn("ipoe: vlan-mon: %s: failed to add vlan\n", ifr.ifr_name);
D
Dmitry Kozlov 已提交
2027 2028
		return;
	}
D
Dmitry Kozlov 已提交
2029
	
D
Dmitry Kozlov 已提交
2030 2031 2032 2033
	ioctl(sock_fd, SIOCGIFFLAGS, &ifr, sizeof(ifr));
	ifr.ifr_flags |= IFF_UP;
	ioctl(sock_fd, SIOCSIFFLAGS, &ifr, sizeof(ifr));
	
D
Dmitry Kozlov 已提交
2034 2035 2036 2037 2038 2039 2040 2041 2042 2043 2044 2045 2046 2047 2048 2049 2050 2051 2052 2053 2054 2055 2056 2057 2058 2059 2060 2061 2062 2063 2064 2065 2066 2067 2068 2069 2070 2071 2072 2073 2074 2075 2076
	if (ioctl(sock_fd, SIOCGIFINDEX, &ifr, sizeof(ifr))) {
		log_error("ipoe: vlan-mon: %s: failed to get interface index\n", ifr.ifr_name);
		return;
	}

	list_for_each_entry(opt, &sect->items, entry) {
		if (strcmp(opt->name, "interface"))
			continue;
		if (!opt->val)
			continue;
		
		ptr = strchr(opt->val, ',');
		if (!ptr)
			ptr = strchr(opt->val, 0);

		if (ptr - opt->val > 3 && memcmp(opt->val, "re:", 3) == 0) {
			pattern = _malloc(ptr - (opt->val + 3) + 1);
			memcpy(pattern, opt->val + 3, ptr - (opt->val + 3));
			pattern[ptr - (opt->val + 3)] = 0;
			
			re = pcre_compile2(pattern, 0, NULL, &pcre_err, &pcre_offset, NULL);
			
			_free(pattern);
				
			if (!re)
				continue;

			r = pcre_exec(re, NULL, ifr.ifr_name, len, 0, 0, NULL, 0);
			pcre_free(re);
			
			if (r < 0)
				continue;
			
			add_interface(ifr.ifr_name, ifr.ifr_ifindex, opt->val, ifindex, vid);
		} else if (ptr - opt->val == len && memcmp(opt->val, ifr.ifr_name, len) == 0)
			add_interface(ifr.ifr_name, ifr.ifr_ifindex, opt->val, ifindex, vid);
	}
}

static void ipoe_serv_timeout(struct triton_timer_t *t)
{
	struct ipoe_serv *serv = container_of(t, typeof(*serv), timer);

D
Dmitry Kozlov 已提交
2077 2078 2079
	serv->need_close = 1;
	
	ipoe_serv_release(serv);
D
Dmitry Kozlov 已提交
2080 2081 2082
}

static void add_interface(const char *ifname, int ifindex, const char *opt, int parent_ifindex, int vid)
K
Kozlov Dmitry 已提交
2083
{
K
Kozlov Dmitry 已提交
2084
	char *str0 = NULL, *str, *ptr1, *ptr2;
K
Kozlov Dmitry 已提交
2085
	int end;
K
Kozlov Dmitry 已提交
2086
	struct ipoe_serv *serv;
K
Kozlov Dmitry 已提交
2087 2088 2089 2090
	int opt_shared = conf_shared;
	int opt_dhcpv4 = 0;
	int opt_up = 0;
	int opt_mode = conf_mode;
2091
	int opt_ifcfg = conf_ifcfg;
2092
	int opt_nat = conf_nat;
2093
	int opt_username = conf_username;
2094
	int opt_ipv6 = conf_ipv6;
2095 2096 2097
#ifdef USE_LUA
	char *opt_lua_username_func = NULL;
#endif
K
Kozlov Dmitry 已提交
2098
	const char *opt_relay = conf_relay;
2099 2100
	in_addr_t relay_addr = conf_relay ? inet_addr(conf_relay) : 0;
	in_addr_t opt_giaddr = 0;
2101
	in_addr_t opt_src = conf_src;
2102 2103
	int opt_arp = conf_arp;
	struct ifreq ifr;
K
Kozlov Dmitry 已提交
2104 2105 2106 2107 2108 2109 2110 2111

	str0 = strchr(opt, ',');
	if (str0) {
		str0 = _strdup(str0 + 1);
		str = str0;
	
		while (1) {
			for (ptr1 = str + 1; *ptr1 && *ptr1 != '='; ptr1++);
K
Kozlov Dmitry 已提交
2112

K
Kozlov Dmitry 已提交
2113 2114 2115 2116 2117 2118 2119 2120 2121 2122 2123 2124 2125 2126 2127 2128 2129 2130 2131 2132 2133 2134 2135 2136 2137 2138 2139 2140 2141 2142 2143
			if (!*ptr1)
				goto parse_err;
		
			*ptr1 = 0;

			for (ptr2 = ++ptr1; *ptr2 && *ptr2 != ','; ptr2++);

			end = *ptr2 == 0;

			if (!end)
				*ptr2 = 0;

			if (ptr2 == ptr1)
				goto parse_err;

			if (strcmp(str, "start") == 0) {
				if (!strcmp(ptr1, "up"))
					opt_up = 1;
				else if (!strcmp(ptr1, "dhcpv4"))
					opt_dhcpv4 = 1;
				else
					goto parse_err;
			} else if (strcmp(str, "shared") == 0) {
				opt_shared = atoi(ptr1);
			} else if (strcmp(str, "mode") == 0) {
				if (!strcmp(ptr1, "L2"))
					opt_mode = MODE_L2;
				else if (!strcmp(ptr1, "L3"))
					opt_mode = MODE_L3;
				else
					goto parse_err;
2144 2145
			} else if (strcmp(str, "ifcfg") == 0) {
				opt_ifcfg = atoi(ptr1);
K
Kozlov Dmitry 已提交
2146 2147 2148 2149
			} else if (strcmp(str, "relay") == 0) {
				opt_relay = ptr1;
				relay_addr = inet_addr(ptr1);
			} else if (strcmp(str, "giaddr") == 0) {
2150
				opt_giaddr = inet_addr(ptr1);
2151 2152
			} else if (strcmp(str, "nat") == 0) {
				opt_nat = atoi(ptr1);
2153 2154
			} else if (strcmp(str, "src") == 0) {
				opt_src = inet_addr(ptr1);
2155 2156
			} else if (strcmp(str, "proxy-arp") == 0) {
				opt_arp = atoi(ptr1);
2157 2158
			} else if (strcmp(str, "ipv6") == 0) {
				opt_ipv6 = atoi(ptr1);
2159 2160 2161 2162 2163 2164 2165 2166 2167 2168 2169
			} else if (strcmp(str, "username") == 0) {
				if (strcmp(ptr1, "ifname") == 0)
					opt_username = USERNAME_IFNAME;
#ifdef USE_LUA
				else if (strlen(ptr1) > 4 && memcmp(ptr1, "lua:", 4) == 0) {
					opt_username = USERNAME_LUA;
					opt_lua_username_func = _strdup(ptr1 + 4);
				} 
#endif
				else
					log_error("ipoe: unknown username value '%s'\n", ptr1);
2170
			}
K
Kozlov Dmitry 已提交
2171 2172 2173 2174 2175 2176

			if (end)
				break;

			str = ptr2 + 1;
		}
D
Dmitry Kozlov 已提交
2177
	}
K
Kozlov Dmitry 已提交
2178 2179 2180 2181 2182 2183

	if (!opt_up && !opt_dhcpv4) {
		opt_up = conf_up;
		opt_dhcpv4 = conf_dhcpv4;
	}

2184 2185 2186 2187 2188 2189 2190 2191 2192 2193 2194 2195 2196 2197 2198 2199 2200 2201 2202 2203 2204 2205 2206
	if (opt_relay && !opt_giaddr && opt_dhcpv4) {
		struct sockaddr_in addr;
		int sock;
		socklen_t len = sizeof(addr);

		memset(&addr, 0, sizeof(addr));
		addr.sin_family = AF_INET;
		addr.sin_addr.s_addr = relay_addr;
		addr.sin_port = htons(DHCP_SERV_PORT);
		
		sock = socket(PF_INET, SOCK_DGRAM, IPPROTO_UDP);
		
		if (connect(sock, &addr, sizeof(addr))) {
			log_error("dhcpv4: relay: %s: connect: %s\n", opt_relay, strerror(errno));
			goto out_err;
		}
		
		getsockname(sock, &addr, &len);
		opt_giaddr = addr.sin_addr.s_addr;

		close(sock);
	}

2207 2208 2209
	if (opt_up)
		ipoe_nl_add_interface(ifindex);

D
Dmitry Kozlov 已提交
2210
	pthread_mutex_lock(&serv_lock);
K
Kozlov Dmitry 已提交
2211
	list_for_each_entry(serv, &serv_list, entry) {
2212
		if (strcmp(ifname, serv->ifname))
K
Kozlov Dmitry 已提交
2213 2214 2215 2216 2217 2218 2219 2220
			continue;

		serv->active = 1;
		serv->ifindex = ifindex;
		
		if ((opt_shared && !serv->opt_shared) || (!opt_shared && serv->opt_shared)) {
			ipoe_drop_sessions(serv, NULL);
			serv->opt_shared = opt_shared;
K
Kozlov Dmitry 已提交
2221
		}
K
Kozlov Dmitry 已提交
2222 2223

		if (opt_dhcpv4 && !serv->dhcpv4) {
2224
			serv->dhcpv4 = dhcpv4_create(&serv->ctx, serv->ifname, opt);
K
Kozlov Dmitry 已提交
2225 2226 2227 2228 2229 2230 2231
			if (serv->dhcpv4)
				serv->dhcpv4->recv = ipoe_recv_dhcpv4;
		} else if (!opt_dhcpv4 && serv->dhcpv4) {
			dhcpv4_free(serv->dhcpv4);
			serv->dhcpv4 = NULL;
		}

2232 2233
		if (serv->dhcpv4_relay &&  
				(serv->dhcpv4_relay->addr != relay_addr || serv->dhcpv4_relay->giaddr != opt_giaddr)) {
2234
			if (serv->opt_ifcfg)
2235
				ipoe_serv_del_addr(serv, serv->dhcpv4_relay->giaddr, 0);
K
Kozlov Dmitry 已提交
2236 2237 2238 2239
			dhcpv4_relay_free(serv->dhcpv4_relay, &serv->ctx);
			serv->dhcpv4_relay = NULL;
		}

2240
		if (!serv->dhcpv4_relay && serv->opt_dhcpv4 && opt_relay) {
2241
			if (opt_ifcfg)
2242
				ipoe_serv_add_addr(serv, opt_giaddr, 32);
K
Kozlov Dmitry 已提交
2243
			serv->dhcpv4_relay = dhcpv4_relay_create(opt_relay, opt_giaddr, &serv->ctx, (triton_event_func)ipoe_recv_dhcpv4_relay);
K
Kozlov Dmitry 已提交
2244
		}
2245 2246 2247 2248 2249 2250

		if (serv->arp && !conf_arp) {
			arpd_stop(serv->arp);
			serv->arp = NULL;
		} else if (!serv->arp && conf_arp)
			serv->arp = arpd_start(serv);
2251 2252 2253 2254
		
		serv->opt_up = opt_up;
		serv->opt_mode = opt_mode;
		serv->opt_ifcfg = opt_ifcfg;
2255
		serv->opt_nat = opt_nat;
2256
		serv->opt_src = opt_src;
2257
		serv->opt_arp = opt_arp;
2258
		serv->opt_username = opt_username;
2259
		serv->opt_ipv6 = opt_ipv6;
2260 2261 2262 2263 2264 2265 2266 2267 2268 2269 2270
#ifdef USE_LUA
		if (serv->opt_lua_username_func && (!opt_lua_username_func || strcmp(serv->opt_lua_username_func, opt_lua_username_func))) {
			_free(serv->opt_lua_username_func);
			serv->opt_lua_username_func = NULL;
		}
		
		if (!serv->opt_lua_username_func && opt_lua_username_func)
			serv->opt_lua_username_func = opt_lua_username_func;
		else if (opt_lua_username_func)
			_free(opt_lua_username_func);
#endif
K
Kozlov Dmitry 已提交
2271 2272 2273 2274

		if (str0)
			_free(str0);

D
Dmitry Kozlov 已提交
2275
		pthread_mutex_unlock(&serv_lock);
K
Kozlov Dmitry 已提交
2276
		return;
K
Kozlov Dmitry 已提交
2277
	}
D
Dmitry Kozlov 已提交
2278
	pthread_mutex_unlock(&serv_lock);
K
Kozlov Dmitry 已提交
2279

2280 2281 2282 2283 2284
	opt = strchr(opt, ',');
	if (opt)
		opt++;

	log_info2("ipoe: start interface %s (%s)\n", ifname, opt ? opt : "");
D
Dmitry Kozlov 已提交
2285

2286 2287 2288 2289 2290 2291 2292
	memset(&ifr, 0, sizeof(ifr));
	strcpy(ifr.ifr_name, ifname);
	
	if (ioctl(sock_fd, SIOCGIFHWADDR, &ifr)) {
		log_error("ipoe: '%s': ioctl(SIOCGIFHWADDR): %s\n", ifname, strerror(errno));
		return;
	}
D
Dmitry Kozlov 已提交
2293 2294 2295 2296 2297 2298 2299 2300
	
	ioctl(sock_fd, SIOCGIFFLAGS, &ifr);
		
	if (!(ifr.ifr_flags & IFF_UP)) {
		ifr.ifr_flags |= IFF_UP;

		ioctl(sock_fd, SIOCSIFFLAGS, &ifr);
	}
2301

K
Kozlov Dmitry 已提交
2302 2303
	serv = _malloc(sizeof(*serv));
	memset(serv, 0, sizeof(*serv));
2304
	serv->ctx.close = ipoe_serv_close;
2305
	serv->ctx.before_switch = log_switch;
D
Dmitry Kozlov 已提交
2306
	pthread_mutex_init(&serv->lock, NULL);
K
Kozlov Dmitry 已提交
2307 2308
	serv->ifname = _strdup(ifname);
	serv->ifindex = ifindex;
K
Kozlov Dmitry 已提交
2309 2310 2311 2312
	serv->opt_shared = opt_shared;
	serv->opt_dhcpv4 = opt_dhcpv4;
	serv->opt_up = opt_up;
	serv->opt_mode = opt_mode;
2313
	serv->opt_ifcfg = opt_ifcfg;
2314
	serv->opt_nat = opt_nat;
2315
	serv->opt_src = opt_src;
2316
	serv->opt_arp = opt_arp;
2317
	serv->opt_username = opt_username;
2318
	serv->opt_ipv6 = opt_ipv6;
2319 2320 2321
#ifdef USE_LUA
	serv->opt_lua_username_func = opt_lua_username_func;
#endif
D
Dmitry Kozlov 已提交
2322 2323
	serv->parent_ifindex = parent_ifindex = parent_ifindex;
	serv->vid = vid;
2324
	serv->active = 1;
K
Kozlov Dmitry 已提交
2325
	INIT_LIST_HEAD(&serv->sessions);
2326
	INIT_LIST_HEAD(&serv->addr_list);
D
Dmitry Kozlov 已提交
2327
	INIT_LIST_HEAD(&serv->disc_list);
2328
	INIT_LIST_HEAD(&serv->req_list);
2329
	memcpy(serv->hwaddr, ifr.ifr_hwaddr.sa_data, ETH_ALEN);
D
Dmitry Kozlov 已提交
2330
	serv->disc_timer.expire = ipoe_serv_disc_timer;
D
Dmitry Kozlov 已提交
2331
	
K
Kozlov Dmitry 已提交
2332 2333 2334
	triton_context_register(&serv->ctx, NULL);

	if (serv->opt_dhcpv4) {
2335
		serv->dhcpv4 = dhcpv4_create(&serv->ctx, serv->ifname, opt);
K
Kozlov Dmitry 已提交
2336
		if (serv->dhcpv4)
2337
			serv->dhcpv4->recv = ipoe_recv_dhcpv4;
K
Kozlov Dmitry 已提交
2338
	
2339
		if (opt_relay) {
2340
			if (opt_ifcfg)
2341
				ipoe_serv_add_addr(serv, opt_giaddr, 32);
K
Kozlov Dmitry 已提交
2342 2343
			serv->dhcpv4_relay = dhcpv4_relay_create(opt_relay, opt_giaddr, &serv->ctx, (triton_event_func)ipoe_recv_dhcpv4_relay);
		}
K
Kozlov Dmitry 已提交
2344 2345
	}

2346 2347
	if (serv->opt_arp)
		serv->arp = arpd_start(serv);
D
Dmitry Kozlov 已提交
2348 2349 2350 2351 2352 2353
	
	if (vid) {
		serv->timer.expire = ipoe_serv_timeout;
		serv->timer.expire_tv.tv_sec = conf_vlan_timeout;
		triton_timer_add(&serv->ctx, &serv->timer, 0);
	}
2354

K
Kozlov Dmitry 已提交
2355 2356
	triton_context_wakeup(&serv->ctx);

D
Dmitry Kozlov 已提交
2357
	pthread_mutex_lock(&serv_lock);
2358
	list_add_tail(&serv->entry, &serv_list);
D
Dmitry Kozlov 已提交
2359
	pthread_mutex_unlock(&serv_lock);
2360

K
Kozlov Dmitry 已提交
2361 2362 2363
	if (str0)
		_free(str0);

K
Kozlov Dmitry 已提交
2364 2365
	return;

K
Kozlov Dmitry 已提交
2366
parse_err:
K
Kozlov Dmitry 已提交
2367
	log_error("ipoe: failed to parse '%s'\n", opt);
2368
out_err:
K
Kozlov Dmitry 已提交
2369
	_free(str0);
K
Kozlov Dmitry 已提交
2370 2371 2372 2373 2374 2375 2376 2377 2378 2379 2380 2381 2382 2383 2384 2385 2386 2387 2388
}

static void load_interface(const char *opt)
{
	const char *ptr;
	struct ifreq ifr;

	for (ptr = opt; *ptr && *ptr != ','; ptr++);

	if (ptr - opt >= sizeof(ifr.ifr_name))
		return;

	memcpy(ifr.ifr_name, opt, ptr - opt);
	ifr.ifr_name[ptr - opt] = 0;
	
	if (ioctl(sock_fd, SIOCGIFINDEX, &ifr)) {
		log_error("ipoe: '%s': ioctl(SIOCGIFINDEX): %s\n", ifr.ifr_name, strerror(errno));
		return;
	}
2389
	
D
Dmitry Kozlov 已提交
2390
	add_interface(ifr.ifr_name, ifr.ifr_ifindex, opt, 0, 0);
K
Kozlov Dmitry 已提交
2391 2392 2393 2394 2395 2396
}

static int __load_interface_re(int index, int flags, const char *name, struct iplink_arg *arg)
{
	if (pcre_exec(arg->re, NULL, name, strlen(name), 0, 0, NULL, 0) < 0)
		return 0;
2397

D
Dmitry Kozlov 已提交
2398
	add_interface(name, index, arg->opt, 0, 0);
K
Kozlov Dmitry 已提交
2399 2400 2401 2402 2403 2404 2405 2406 2407 2408 2409 2410 2411 2412 2413 2414 2415 2416 2417 2418 2419 2420

	return 0;
}

static void load_interface_re(const char *opt)
{
	pcre *re = NULL;
	const char *pcre_err;
	char *pattern;
	const char *ptr;
	int pcre_offset;
	struct iplink_arg arg;

	for (ptr = opt; *ptr && *ptr != ','; ptr++);
	
	pattern = _malloc(ptr - (opt + 3) + 1);
	memcpy(pattern, opt + 3, ptr - (opt + 3));
	pattern[ptr - (opt + 3)] = 0;
	
	re = pcre_compile2(pattern, 0, NULL, &pcre_err, &pcre_offset, NULL);
		
	if (!re) {
D
Dmitry Kozlov 已提交
2421
		log_error("ipoe: '%s': %s at %i\r\n", pattern, pcre_err, pcre_offset);
K
Kozlov Dmitry 已提交
2422 2423 2424 2425 2426 2427 2428 2429 2430 2431 2432 2433 2434 2435 2436 2437 2438
		return;
	}

	arg.re = re;
	arg.opt = opt;

	iplink_list((iplink_list_func)__load_interface_re, &arg);

	pcre_free(re);
	_free(pattern);
}

static void load_interfaces(struct conf_sect_t *sect)
{
	struct ipoe_serv *serv;
	struct conf_option_t *opt;

2439 2440
	ipoe_nl_delete_interfaces();

K
Kozlov Dmitry 已提交
2441 2442 2443 2444 2445 2446 2447 2448 2449 2450 2451 2452 2453 2454 2455
	list_for_each_entry(serv, &serv_list, entry)
		serv->active = 0;

	list_for_each_entry(opt, &sect->items, entry) {
		if (strcmp(opt->name, "interface"))
			continue;
		if (!opt->val)
			continue;

		if (strlen(opt->val) > 3 && memcmp(opt->val, "re:", 3) == 0)
			load_interface_re(opt->val);
		else
			load_interface(opt->val);
	}
	
D
Dmitry Kozlov 已提交
2456
	list_for_each_entry(serv, &serv_list, entry) {
D
Dmitry Kozlov 已提交
2457
		if (!serv->active && !serv->vid) {
2458
			ipoe_drop_sessions(serv, NULL);
D
Dmitry Kozlov 已提交
2459
			triton_context_call(&serv->ctx, (triton_event_func)ipoe_serv_release, serv);
K
Kozlov Dmitry 已提交
2460 2461 2462 2463
		}
	}
}

2464 2465 2466 2467 2468 2469 2470 2471 2472 2473 2474 2475 2476 2477 2478 2479 2480 2481 2482 2483 2484 2485 2486 2487 2488
static void parse_local_net(const char *opt)
{
	const char *ptr;
	char str[17];
	in_addr_t addr;
	int mask;
	char *endptr;

	ptr = strchr(opt, '/');
	if (ptr) {
		memcpy(str, opt, ptr - opt);
		str[ptr - opt] = 0;
		addr = inet_addr(str);
		if (addr == INADDR_NONE)
			goto out_err;
		mask = strtoul(ptr + 1, &endptr, 10);
		if (mask > 32)
			goto out_err;
	} else {
		addr = inet_addr(opt);
		if (addr == INADDR_NONE)
			goto out_err;
		mask = 24;
	}

2489
	ipoe_nl_add_net(addr, mask);
2490 2491 2492 2493 2494 2495 2496 2497 2498 2499 2500 2501 2502 2503 2504 2505 2506 2507 2508 2509 2510 2511

	return;

out_err:
	log_error("ipoe: failed to parse 'local-net=%s'\n", opt);
}

static void load_local_nets(struct conf_sect_t *sect)
{
	struct conf_option_t *opt;

	ipoe_nl_delete_nets();

	list_for_each_entry(opt, &sect->items, entry) {
		if (strcmp(opt->name, "local-net"))
			continue;
		if (!opt->val)
			continue;
		parse_local_net(opt->val);
	}
}

2512 2513 2514 2515 2516 2517 2518 2519 2520 2521 2522 2523 2524 2525 2526 2527 2528 2529 2530 2531 2532 2533 2534 2535 2536 2537 2538 2539 2540 2541 2542 2543 2544 2545 2546 2547
static void load_gw_addr(struct conf_sect_t *sect)
{
	struct conf_option_t *opt;
	struct gw_addr *a;
	char addr[17];
	char *ptr;

	while (!list_empty(&conf_gw_addr)) {
		a = list_entry(conf_gw_addr.next, typeof(*a), entry);
		list_del(&a->entry);
		_free(a);
	}

	list_for_each_entry(opt, &sect->items, entry) {
		if (strcmp(opt->name, "gw-ip-address"))
			continue;
		if (!opt->val)
			continue;

		a = _malloc(sizeof(*a));
		ptr = strchr(opt->val, '/');
		if (ptr) {
			memcpy(addr, opt->val, ptr - opt->val);
			addr[ptr - opt->val] = 0;
			a->addr = inet_addr(addr);
			a->mask = atoi(ptr + 1);
		} else {
			a->addr = inet_addr(opt->val);
			a->mask = 32;
		}

		if (a->addr == 0xffffffff || a->mask < 1 || a->mask > 32) {
			log_error("ipoe: failed to parse '%s=%s'\n", opt->name, opt->val);
			_free(a);
			continue;
		}
2548 2549

		a->mask1 = ((1 << a->mask) - 1) << (32 - a->mask);
2550 2551 2552 2553
		list_add_tail(&a->entry, &conf_gw_addr);
	}
}

2554 2555 2556 2557 2558 2559 2560 2561 2562 2563 2564 2565 2566 2567 2568 2569 2570 2571 2572 2573
#ifdef RADIUS
static void parse_conf_rad_attr(const char *opt, int *val)
{
	struct rad_dict_attr_t *attr;

	opt = conf_get_opt("ipoe", opt);

	if (opt) {
		if (atoi(opt) > 0)
			*val = atoi(opt);
		else {
			attr = rad_dict_find_attr(opt);
			if (attr)
				*val = attr->id;
			else
				log_emerg("ipoe: couldn't find '%s' in dictionary\n", opt);
		}
	} else
		*val = -1;
}
K
Kozlov Dmitry 已提交
2574

2575 2576 2577 2578 2579
static void load_radius_attrs(void)
{
	parse_conf_rad_attr("attr-dhcp-client-ip", &conf_attr_dhcp_client_ip);
	parse_conf_rad_attr("attr-dhcp-router-ip", &conf_attr_dhcp_router_ip);
	parse_conf_rad_attr("attr-dhcp-mask", &conf_attr_dhcp_mask);
2580
	parse_conf_rad_attr("attr-dhcp-lease-time", &conf_attr_dhcp_lease_time);
2581
	parse_conf_rad_attr("attr-l4-redirect", &conf_attr_l4_redirect);
2582
	conf_attr_dhcp_opt82 = conf_get_opt("ipoe", "attr-dhcp-opt82");
2583 2584 2585
}
#endif

D
Dmitry Kozlov 已提交
2586 2587 2588 2589 2590 2591 2592 2593 2594 2595 2596 2597 2598 2599 2600 2601 2602 2603 2604 2605 2606 2607 2608 2609 2610 2611 2612 2613 2614 2615 2616 2617 2618 2619 2620 2621 2622 2623 2624 2625 2626 2627 2628 2629 2630 2631 2632 2633 2634 2635 2636 2637 2638 2639 2640 2641 2642 2643 2644 2645 2646 2647 2648 2649 2650 2651 2652 2653 2654 2655 2656 2657 2658 2659 2660
static void strip(char *str)
{
	char *ptr = str;
	char *endptr = strchr(str, 0);
	while (1) {
		ptr = strchr(ptr, ' ');
		if (ptr)
			memmove(ptr, ptr + 1, endptr - ptr - 1);
		else
			break;
	}
}

int parse_offer_delay(const char *str)
{
	char *str1;
	char *ptr1, *ptr2, *ptr3, *endptr;
	struct delay *r;

	while (!list_empty(&conf_offer_delay)) {
		r = list_entry(conf_offer_delay.next, typeof(*r), entry);
		list_del(&r->entry);
		_free(r);
	}

	if (!str)
		return 0;

	str1 = _strdup(str);
	strip(str1);

	ptr1 = str1;

	while (1) {
		ptr2 = strchr(ptr1, ',');
		if (ptr2)
			*ptr2 = 0;
		ptr3 = strchr(ptr1, ':');
		if (ptr3)
			*ptr3 = 0;

		r = _malloc(sizeof(*r));
		memset(r, 0, sizeof(*r));

		r->delay = strtol(ptr1, &endptr, 10);
		if (*endptr)
			goto out_err;

		if (list_empty(&conf_offer_delay))
			r->conn_cnt = 0;
		else {
			if (!ptr3)
				goto out_err;
			r->conn_cnt = strtol(ptr3 + 1, &endptr, 10);
			if (*endptr)
				goto out_err;
		}

		list_add_tail(&r->entry, &conf_offer_delay);

		if (!ptr2)
			break;

		ptr1 = ptr2 + 1;
	}

	_free(str1);
	return 0;

out_err:
	_free(str1);
	log_error("ipoe: failed to parse offer-delay\n");
	return -1;
}

D
Dmitry Kozlov 已提交
2661 2662 2663 2664 2665 2666 2667 2668 2669 2670
static int parse_vlan_mon(const char *opt, long *mask)
{
	char *ptr, *ptr2;
	int vid, vid2;

	ptr = strchr(opt, ',');
	if (!ptr)
		ptr = strchr(opt, 0);

	if (*ptr == ',')
D
Dmitry Kozlov 已提交
2671
		memset(mask, 0xff, 4096/8);
D
Dmitry Kozlov 已提交
2672
	else if (*ptr == 0) {
D
Dmitry Kozlov 已提交
2673
		memset(mask, 0, 4096/8);
D
Dmitry Kozlov 已提交
2674 2675 2676 2677 2678 2679 2680 2681 2682 2683 2684 2685 2686 2687 2688 2689 2690 2691 2692
		return 0;
	} else
		goto out_err;

	while (1) {
		vid = strtol(ptr + 1, &ptr2, 10);
		if (vid <= 0 || vid >= 4096) {
			log_error("ipoe: vlan-mon=%s: invalid vlan %i\n", opt, vid);
			return -1;
		}

		if (*ptr2 == '-') {
			vid2 = strtol(ptr2 + 1, &ptr2, 10);
			if (vid2 <= 0 || vid2 >= 4096) {
				log_error("ipoe: vlan-mon=%s: invalid vlan %i\n", opt, vid2);
				return -1;
			}
			
			for (; vid < vid2; vid++)
D
Dmitry Kozlov 已提交
2693
				mask[vid / (8*sizeof(long))] &= ~(1lu << (vid % (8*sizeof(long))));
D
Dmitry Kozlov 已提交
2694 2695
		}
			
D
Dmitry Kozlov 已提交
2696
		mask[vid / (8*sizeof(long))] &= ~(1lu << (vid % (8*sizeof(long))));
D
Dmitry Kozlov 已提交
2697 2698 2699 2700 2701 2702 2703 2704 2705 2706 2707 2708 2709 2710 2711 2712 2713

		if (*ptr2 == 0)
			break;

		if (*ptr2 != ',')
			goto out_err;

		ptr = ptr2;
	}

	return 0;
		
out_err:
	log_error("ipoe: vlan-mon=%s: failed to parse\n", opt);
	return -1;
}

D
Dmitry Kozlov 已提交
2714
static void add_vlan_mon(const char *opt, long *mask)
D
Dmitry Kozlov 已提交
2715 2716 2717 2718
{
	const char *ptr;
	struct ifreq ifr;
	int ifindex;
D
Dmitry Kozlov 已提交
2719 2720
	long mask1[4096/8/sizeof(long)];
	struct ipoe_serv *serv;
D
Dmitry Kozlov 已提交
2721 2722 2723 2724 2725 2726 2727 2728 2729 2730 2731 2732 2733 2734 2735 2736 2737 2738 2739 2740 2741 2742 2743 2744 2745 2746 2747 2748
	
	for (ptr = opt; *ptr && *ptr != ','; ptr++);
	
	if (ptr - opt >= sizeof(ifr.ifr_name)) {
		log_error("ipoe: vlan-mon=%s: interface name is too long\n", opt);
		return;
	}

	memset(&ifr, 0, sizeof(ifr));
	
	memcpy(ifr.ifr_name, opt, ptr - opt);
	ifr.ifr_name[ptr - opt] = 0;

	if (ioctl(sock_fd, SIOCGIFINDEX, &ifr)) {
		log_error("ipoe: '%s': ioctl(SIOCGIFINDEX): %s\n", ifr.ifr_name, strerror(errno));
		return;
	}

	ifindex = ifr.ifr_ifindex;
	
	ioctl(sock_fd, SIOCGIFFLAGS, &ifr);
	
	if (!(ifr.ifr_flags & IFF_UP)) {
		ifr.ifr_flags |= IFF_UP;

		ioctl(sock_fd, SIOCSIFFLAGS, &ifr);
	}

D
Dmitry Kozlov 已提交
2749 2750 2751 2752 2753 2754 2755
	memcpy(mask1, mask, sizeof(mask1));
	list_for_each_entry(serv, &serv_list, entry) {
		if (serv->vid && serv->parent_ifindex == ifindex)
			mask1[serv->vid / (8*sizeof(long))] |= 1lu << (serv->vid % (8*sizeof(long)));
	}

	ipoe_nl_add_vlan_mon(ifindex, mask1, sizeof(mask1));
D
Dmitry Kozlov 已提交
2756 2757 2758 2759 2760
}

static int __load_vlan_mon_re(int index, int flags, const char *name, struct iplink_arg *arg)
{
	struct ifreq ifr;
D
Dmitry Kozlov 已提交
2761 2762
	long mask1[4096/8/sizeof(long)];
	struct ipoe_serv *serv;
D
Dmitry Kozlov 已提交
2763 2764 2765 2766 2767 2768 2769 2770 2771 2772 2773 2774 2775 2776

	if (pcre_exec(arg->re, NULL, name, strlen(name), 0, 0, NULL, 0) < 0)
		return 0;

	memset(&ifr, 0, sizeof(ifr));
	strcpy(ifr.ifr_name, name);
	
	ioctl(sock_fd, SIOCGIFFLAGS, &ifr);
	
	if (!(ifr.ifr_flags & IFF_UP)) {
		ifr.ifr_flags |= IFF_UP;

		ioctl(sock_fd, SIOCSIFFLAGS, &ifr);
	}
D
Dmitry Kozlov 已提交
2777 2778 2779 2780 2781 2782
	
	memcpy(mask1, arg->arg1, sizeof(mask1));
	list_for_each_entry(serv, &serv_list, entry) {
		if (serv->vid && serv->parent_ifindex == index)
			mask1[serv->vid / (8*sizeof(long))] |= 1lu << (serv->vid % (8*sizeof(long)));
	}
D
Dmitry Kozlov 已提交
2783

D
Dmitry Kozlov 已提交
2784
	ipoe_nl_add_vlan_mon(index, mask1, sizeof(mask1));
D
Dmitry Kozlov 已提交
2785 2786 2787 2788 2789 2790 2791 2792 2793 2794 2795 2796 2797 2798 2799 2800 2801 2802 2803 2804 2805 2806 2807 2808 2809 2810 2811 2812 2813 2814 2815 2816 2817 2818 2819 2820 2821 2822 2823 2824 2825 2826 2827 2828 2829 2830 2831 2832 2833 2834 2835 2836 2837 2838 2839 2840 2841

	return 0;
}

static void load_vlan_mon_re(const char *opt, long *mask, int len)
{
	pcre *re = NULL;
	const char *pcre_err;
	char *pattern;
	const char *ptr;
	int pcre_offset;
	struct iplink_arg arg;

	for (ptr = opt; *ptr && *ptr != ','; ptr++);
	
	pattern = _malloc(ptr - (opt + 3) + 1);
	memcpy(pattern, opt + 3, ptr - (opt + 3));
	pattern[ptr - (opt + 3)] = 0;
	
	re = pcre_compile2(pattern, 0, NULL, &pcre_err, &pcre_offset, NULL);
		
	if (!re) {
		log_error("ipoe: '%s': %s at %i\r\n", pattern, pcre_err, pcre_offset);
		return;
	}

	arg.re = re;
	arg.opt = opt;
	arg.arg1 = mask;

	iplink_list((iplink_list_func)__load_vlan_mon_re, &arg);

	pcre_free(re);
	_free(pattern);

}

static void load_vlan_mon(struct conf_sect_t *sect)
{
	struct conf_option_t *opt;
	long mask[4096/8/sizeof(long)];

	ipoe_nl_del_vlan_mon(-1);

	list_for_each_entry(opt, &sect->items, entry) {
		if (strcmp(opt->name, "vlan-mon"))
			continue;

		if (!opt->val)
			continue;
	
		if (parse_vlan_mon(opt->val, mask))
			continue;

		if (strlen(opt->val) > 3 && !memcmp(opt->val, "re:", 3))
			load_vlan_mon_re(opt->val, mask, sizeof(mask));
		else
D
Dmitry Kozlov 已提交
2842
			add_vlan_mon(opt->val, mask);
D
Dmitry Kozlov 已提交
2843 2844 2845 2846
	}
}


K
Kozlov Dmitry 已提交
2847 2848 2849 2850
static void load_config(void)
{
	const char *opt;
	struct conf_sect_t *s = conf_get_section("ipoe");
K
Kozlov Dmitry 已提交
2851
	struct conf_option_t *opt1;
K
Kozlov Dmitry 已提交
2852 2853 2854 2855 2856 2857 2858 2859 2860 2861 2862 2863

	if (!s)
		return;

	opt = conf_get_opt("ipoe", "username");
	if (opt) {
		if (strcmp(opt, "ifname") == 0)
			conf_username = USERNAME_IFNAME;
#ifdef USE_LUA
		else if (strlen(opt) > 4 && memcmp(opt, "lua:", 4) == 0) {
			conf_username = USERNAME_LUA;
			conf_lua_username_func = opt + 4;
K
Kozlov Dmitry 已提交
2864
		}
K
Kozlov Dmitry 已提交
2865
#endif
K
Kozlov Dmitry 已提交
2866
		else
K
Kozlov Dmitry 已提交
2867
			log_emerg("ipoe: unknown username value '%s'\n", opt);
2868 2869
	} else
		conf_username = USERNAME_UNSET;
2870 2871 2872 2873 2874 2875 2876 2877 2878 2879 2880
	
	opt = conf_get_opt("ipoe", "password");
	if (opt) {
		if (!strcmp(opt, "username"))
			conf_password = NULL;
		else if (!strcmp(opt, "empty"))
			conf_password = "";
		else
			conf_password = opt;
	} else
		conf_password = NULL;
K
Kozlov Dmitry 已提交
2881 2882 2883 2884 2885 2886 2887 2888 2889 2890 2891 2892 2893 2894

	opt = conf_get_opt("ipoe", "netmask");
	if (opt) {
		conf_netmask = atoi(opt);
		if (conf_netmask <= 0 || conf_netmask > 32) {
			log_error("ipoe: invalid netmask %s\n", opt);
			conf_netmask = 0;
		}
	} else
		conf_netmask = 0;
	
	opt = conf_get_opt("ipoe", "verbose");
	if (opt)
		conf_verbose = atoi(opt);
K
Kozlov Dmitry 已提交
2895 2896 2897 2898

	opt = conf_get_opt("ipoe", "lease-time");
	if (opt)
		conf_lease_time = atoi(opt);
K
Kozlov Dmitry 已提交
2899 2900
	else
		conf_lease_time = 600;
K
Kozlov Dmitry 已提交
2901
	
K
Kozlov Dmitry 已提交
2902
	opt = conf_get_opt("ipoe", "max-lease-time");
K
Kozlov Dmitry 已提交
2903 2904
	if (opt)
		conf_lease_timeout = atoi(opt);
K
Kozlov Dmitry 已提交
2905 2906
	else
		conf_lease_timeout = 660;
K
Kozlov Dmitry 已提交
2907
	
K
Kozlov Dmitry 已提交
2908 2909 2910 2911
	opt = conf_get_opt("ipoe", "unit-cache");
	if (opt)
		conf_unit_cache = atoi(opt);
	
2912
	opt = conf_get_opt("ipoe", "l4-redirect-table");
2913
	if (opt && atoi(opt) > 0)
2914 2915
		conf_l4_redirect_table = atoi(opt);
	else
2916 2917 2918
		conf_l4_redirect_table = 0;
	
	conf_l4_redirect_ipset = conf_get_opt("ipoe", "l4-redirect-ipset");
2919 2920 2921 2922 2923 2924 2925 2926 2927 2928 2929 2930
	
	opt = conf_get_opt("ipoe", "l4-redirect-on-reject");
	if (opt) {
		conf_l4_redirect_on_reject = atoi(opt);
	} else
		conf_l4_redirect_on_reject = 0;
		
	if (conf_l4_redirect_on_reject) {
		l4_redirect_timer.period = conf_l4_redirect_on_reject / 10 * 1000;
		if (l4_redirect_timer.tpd)
			triton_timer_mod(&l4_redirect_timer, 0);
	}
2931
	
K
Kozlov Dmitry 已提交
2932 2933 2934 2935 2936 2937
	opt = conf_get_opt("ipoe", "shared");
	if (opt)
		conf_shared = atoi(opt);
	else
		conf_shared = 1;
	
2938 2939 2940 2941 2942 2943
	opt = conf_get_opt("ipoe", "ifcfg");
	if (opt)
		conf_ifcfg = atoi(opt);
	else
		conf_ifcfg = 1;
	
2944 2945 2946 2947 2948
	opt = conf_get_opt("ipoe", "nat");
	if (opt)
		conf_nat = atoi(opt);
	else
		conf_nat = 0;
2949 2950 2951 2952 2953 2954

	opt = conf_get_opt("ipoe", "src");
	if (opt)
		conf_src = inet_addr(opt);
	else
		conf_src = 0;
2955 2956 2957 2958 2959 2960 2961 2962 2963 2964 2965

	opt = conf_get_opt("ipoe", "proxy-arp");
	if (opt)
		conf_arp = atoi(opt);
	else
		conf_arp = 0;
	
	if (conf_arp < 0 || conf_arp > 2) {
		log_error("ipoe: arp=%s: invalid value\n", opt);
		conf_arp = 0;
	}
2966
	
K
Kozlov Dmitry 已提交
2967 2968 2969 2970 2971 2972 2973 2974 2975 2976
	opt = conf_get_opt("ipoe", "mode");
	if (opt) {
		if (!strcmp(opt, "L2"))
			conf_mode = MODE_L2;
		else if (!strcmp(opt, "L3"))
			conf_mode = MODE_L3;
		else
			log_emerg("ipoe: failed to parse 'mode=%s'\n", opt);
	} else
		conf_mode = MODE_L2;
K
Kozlov Dmitry 已提交
2977 2978
	
	conf_relay = conf_get_opt("ipoe", "relay");
2979 2980 2981 2982 2983 2984 2985 2986 2987 2988 2989 2990

	opt = conf_get_opt("ipoe", "relay-timeout");
	if (opt && atoi(opt) > 0)
		conf_relay_timeout = atoi(opt);
	else
		conf_relay_timeout = 3;
	
	opt = conf_get_opt("ipoe", "relay-retransmit");
	if (opt && atoi(opt) > 0)
		conf_relay_retransmit = atoi(opt);
	else
		conf_relay_retransmit = 3;
2991 2992 2993 2994 2995 2996
	
	opt = conf_get_opt("ipoe", "agent-remote-id");
	if (opt)
		conf_agent_remote_id = opt;
	else
		conf_agent_remote_id = "accel-pppd";
K
Kozlov Dmitry 已提交
2997
	
2998 2999 3000 3001 3002 3003
	opt = conf_get_opt("ipoe", "ipv6");
	if (opt)
		conf_ipv6 = atoi(opt);
	else
		conf_ipv6 = 0;
	
K
Kozlov Dmitry 已提交
3004 3005 3006 3007 3008
	opt = conf_get_opt("ipoe", "noauth");
	if (opt)
		conf_noauth = atoi(opt);
	else
		conf_noauth = 0;
K
Kozlov Dmitry 已提交
3009 3010 3011 3012 3013 3014 3015 3016 3017 3018 3019 3020 3021 3022 3023 3024

	conf_dhcpv4 = 0;
	conf_up = 0;

	list_for_each_entry(opt1, &s->items, entry) {
		if (strcmp(opt1->name, "start"))
			continue;
		if (!strcmp(opt1->val, "dhcpv4"))
			conf_dhcpv4 = 1;
		else if (!strcmp(opt1->val, "up"))
			conf_up = 1;
	}

	if (!conf_dhcpv4 && !conf_up)
		conf_dhcpv4 = 1;
	
3025 3026 3027 3028
	opt = conf_get_opt("ipoe", "proto");
	if (opt && atoi(opt) > 0)
		conf_proto = atoi(opt);
	else
3029
		conf_proto = 3;
3030
	
D
Dmitry Kozlov 已提交
3031 3032 3033 3034 3035 3036
	opt = conf_get_opt("ipoe", "vlan-timeout");
	if (opt && atoi(opt) > 0)
		conf_vlan_timeout = atoi(opt);
	else
		conf_vlan_timeout = 60;
	
3037 3038 3039 3040 3041 3042
	opt = conf_get_opt("ipoe", "offer-timeout");
	if (opt && atoi(opt) > 0)
		conf_offer_timeout = atoi(opt);
	else
		conf_offer_timeout = 10;
	
3043
	conf_ip_pool = conf_get_opt("ipoe", "ip-pool");
3044 3045 3046 3047

	conf_vlan_name = conf_get_opt("ipoe", "vlan-name");
	if (!conf_vlan_name)
		conf_vlan_name = "%I.%N";
3048
	
3049 3050 3051 3052 3053 3054
	opt = conf_get_opt("ipoe", "ip-unnumbered");
	if (opt)
		conf_ip_unnumbered = atoi(opt);
	else
		conf_ip_unnumbered = 1;
	
3055 3056 3057 3058
#ifdef RADIUS
	if (triton_module_loaded("radius"))
		load_radius_attrs();
#endif
D
Dmitry Kozlov 已提交
3059 3060

	parse_offer_delay(conf_get_opt("ipoe", "offer-delay"));
3061
	
K
Kozlov Dmitry 已提交
3062 3063
	load_interfaces(s);
	load_local_nets(s);
D
Dmitry Kozlov 已提交
3064
	load_vlan_mon(s);
3065
	load_gw_addr(s);
K
Kozlov Dmitry 已提交
3066 3067
}

3068 3069 3070 3071 3072 3073 3074 3075
static struct triton_context_t l4_redirect_ctx = {
	.close = l4_redirect_ctx_close,
};

static struct triton_timer_t l4_redirect_timer = {
	.expire = l4_redirect_list_timer,
};

K
Kozlov Dmitry 已提交
3076 3077 3078
static void ipoe_init(void)
{
	ses_pool = mempool_create(sizeof(struct ipoe_session));
D
Dmitry Kozlov 已提交
3079
	disc_item_pool = mempool_create(sizeof(struct disc_item));
3080
	req_item_pool = mempool_create(sizeof(struct request_item));
K
Kozlov Dmitry 已提交
3081
	uc_pool = mempool_create(sizeof(struct unit_cache));
3082

3083 3084 3085
	triton_context_register(&l4_redirect_ctx, NULL);
	triton_context_wakeup(&l4_redirect_ctx);

K
Kozlov Dmitry 已提交
3086 3087
	load_config();

3088 3089 3090
	if (conf_l4_redirect_ipset)
		ipset_flush(conf_l4_redirect_ipset);

K
Kozlov Dmitry 已提交
3091 3092 3093
	cli_register_simple_cmd2(show_stat_exec, NULL, 2, "show", "stat");
	
	triton_event_register_handler(EV_CONFIG_RELOAD, (triton_event_func)load_config);
3094 3095

#ifdef RADIUS
3096
	if (triton_module_loaded("radius")) {
3097 3098
		triton_event_register_handler(EV_RADIUS_ACCESS_ACCEPT, (triton_event_func)ev_radius_access_accept);
		triton_event_register_handler(EV_RADIUS_COA, (triton_event_func)ev_radius_coa);
3099
	}
3100
#endif
3101 3102
	
	connlimit_loaded = triton_module_loaded("connlimit");
3103
	radius_loaded = triton_module_loaded("radius");
K
Kozlov Dmitry 已提交
3104 3105
}

3106
DEFINE_INIT(52, ipoe_init);