3 * Add functionality "LAC" to l2tpns.
4 * Used to forward a ppp session to another "LNS".
10 #include <linux/rtnetlink.h>
11 #include <netinet/ip6.h>
22 /* sequence diagram: Client <--> LAC <--> LNS1 <--> LNS2
25 * Client <-------------------> LAC
26 * Challenge (CHAP/PAP)
27 * Client <-------------------> LAC
29 * LAC --------------------> LNS1 (Tunnel Open)
31 * LAC <-------------------- LNS1 (Tunnel Open)
33 * LAC --------------------> LNS1 (Tunnel Open)
35 * LAC <-------------------- LNS1 (Tunnel Open)
37 * LAC --------------------> LNS1 (Session Open)
39 * LAC <-------------------- LNS1 (Session Open)
41 * LAC --------------------> LNS1 (Session Open)
43 * LAC <-------------------- LNS1 (Session Open)
45 * Client <---------------------------------------------> LNS1
46 * Challenge (CHAP/PAP)
47 * Client <---------------------------------------------> LNS1
49 * LNS1 --------------------> LNS2 (Tunnel Open)
51 * LNS1 <-------------------- LNS2 (Tunnel Open)
53 * LNS1 --------------------> LNS2 (Tunnel Open)
55 * LNS1 <-------------------- LNS2 (Tunnel Open)
57 * LNS1 --------------------> LNS2 (Session Open)
59 * LNS1 <-------------------- LNS2 (Session Open)
61 * LNS1 --------------------> LNS2 (Session Open)
63 * LNS1 <-------------------- LNS2 (Session Open)
65 * Client <------------------------------------------------------------------------> LNS2
66 * PAP/CHAP Authentification
67 * Client <------------------------------------------------------------------------> LNS2
69 * Client <------------------------------------------------------------------------> LNS2
75 uint32_t tunnel_medium_type
;
76 in_addr_t tunnel_server_endpoint
; /* IP remote LNS */
77 char tunnel_password
[64]; /* l2tpsecret remote LNS */
78 char tunnel_assignment_id
[256];
81 // Max Radius Tunnels by remote LNS
82 #define MAXTAGTUNNEL 0x20
83 static tunnelrlnst ptunnelrlns
[MAXTAGTUNNEL
];
86 * Possible configrlns states
87 * CONFRLNSFREE -> CONFRLNSSET -> CONFRLNSFREE
91 CONFRLNSFREE
= 0, // Not in use
92 CONFRLNSSET
, // Config Set
93 CONFRLNSSETBYRADIUS
// Config Set
99 int state
; // conf state (tunnelstate enum)
100 in_addr_t ip
; // Ip for far end
101 uint16_t port
; // port for far end
102 hasht auth
; // request authenticator
103 char strmaskuser
[MAXUSER
];
104 char l2tp_secret
[64]; // L2TP shared secret
105 char tunnel_assignment_id
[256];
109 configrlns
*pconfigrlns
= NULL
;
111 // Init data structures
112 void lac_initremotelnsdata()
116 if ( !(pconfigrlns
= shared_malloc(sizeof(pconfigrlns
[0]) * MAXRLNSTUNNEL
)) )
118 LOG(0, 0, 0, "Error doing malloc for tunnels lac: %s\n", strerror(errno
));
122 memset(pconfigrlns
, 0, sizeof(pconfigrlns
[0]) * MAXRLNSTUNNEL
);
124 // Mark all the conf as free.
125 for (i
= 1; i
< MAXRLNSTUNNEL
; i
++)
126 pconfigrlns
[i
].state
= CONFRLNSFREE
; // mark it as not filled in.
128 config
->highest_rlnsid
= 0;
130 lac_reset_rad_tag_tunnel_ctxt();
133 // Reset Radius TAG tunnel context
134 void lac_reset_rad_tag_tunnel_ctxt()
136 memset(ptunnelrlns
, 0, sizeof(ptunnelrlns
[0]) * MAXTAGTUNNEL
);
139 // Add tunnel_type radius TAG tunnel to context
140 void lac_set_rad_tag_tunnel_type(uint8_t tag
, uint32_t tunnel_type
)
142 if (tag
< MAXTAGTUNNEL
)
143 ptunnelrlns
[tag
].tunnel_type
= tunnel_type
;
146 // Add tunnel_medium_type Radius TAG tunnel to context
147 void lac_set_rad_tag_tunnel_medium_type(uint8_t tag
, uint32_t tunnel_medium_type
)
149 if (tag
< MAXTAGTUNNEL
)
150 ptunnelrlns
[tag
].tunnel_medium_type
= tunnel_medium_type
;
153 // Add tunnel_server_endpoint Radius TAG tunnel to context
154 void lac_set_rad_tag_tunnel_serv_endpt(uint8_t tag
, char *tunnel_server_endpoint
)
156 if (tag
< MAXTAGTUNNEL
)
158 ptunnelrlns
[tag
].tunnel_server_endpoint
= ntohl(inet_addr(tunnel_server_endpoint
));
162 // Add tunnel_password Radius TAG tunnel to context
163 void lac_set_rad_tag_tunnel_password(uint8_t tag
, char *tunnel_password
)
165 if ((tag
< MAXTAGTUNNEL
) && (strlen(tunnel_password
) < 64))
167 strcpy(ptunnelrlns
[tag
].tunnel_password
, tunnel_password
);
171 // Add tunnel_assignment_id Radius TAG tunnel to context
172 void lac_set_rad_tag_tunnel_assignment_id(uint8_t tag
, char *tunnel_assignment_id
)
174 if ((tag
< MAXTAGTUNNEL
) && (strlen(tunnel_assignment_id
) < 256))
176 strcpy(ptunnelrlns
[tag
].tunnel_assignment_id
, tunnel_assignment_id
);
180 // Select a tunnel_assignment_id
181 int lac_rad_select_assignment_id(sessionidt s
, char *assignment_id
)
185 int bufidtag
[MAXTAGTUNNEL
];
187 for (idtag
= 0; idtag
< MAXTAGTUNNEL
; ++idtag
)
189 if (ptunnelrlns
[idtag
].tunnel_type
== 0)
191 else if (ptunnelrlns
[idtag
].tunnel_type
!= 3) // 3 == L2TP tunnel type
192 LOG(1, s
, session
[s
].tunnel
, "Error, Only L2TP tunnel type supported\n");
193 else if (ptunnelrlns
[idtag
].tunnel_medium_type
!= 1)
194 LOG(1, s
, session
[s
].tunnel
, "Error, Only IP tunnel medium type supported\n");
195 else if (ptunnelrlns
[idtag
].tunnel_server_endpoint
== 0)
196 LOG(1, s
, session
[s
].tunnel
, "Error, Bad IP tunnel server endpoint \n");
197 else if (strlen(ptunnelrlns
[idtag
].tunnel_assignment_id
) > 0)
199 bufidtag
[nbtagfound
] = idtag
;
206 // random between 0 and nbtagfound-1
207 idtag
= (rand() % nbtagfound
);
209 if (idtag
>= nbtagfound
)
210 idtag
= 0; //Sanity checks.
212 strcpy(assignment_id
, ptunnelrlns
[bufidtag
[idtag
]].tunnel_assignment_id
);
216 // Error no tunnel_assignment_id found
220 // Save the 'radius tag tunnels' context on global configuration
221 void lac_save_rad_tag_tunnels(sessionidt s
)
226 for (idtag
= 0; idtag
< MAXTAGTUNNEL
; ++idtag
)
228 if (ptunnelrlns
[idtag
].tunnel_type
== 0)
230 else if (ptunnelrlns
[idtag
].tunnel_type
!= 3) // 3 == L2TP tunnel type
231 LOG(1, s
, session
[s
].tunnel
, "Error, Only L2TP tunnel type supported\n");
232 else if (ptunnelrlns
[idtag
].tunnel_medium_type
!= 1)
233 LOG(1, s
, session
[s
].tunnel
, "Error, Only IP tunnel medium type supported\n");
234 else if (ptunnelrlns
[idtag
].tunnel_server_endpoint
== 0)
235 LOG(1, s
, session
[s
].tunnel
, "Error, Bad IP tunnel server endpoint \n");
236 else if (strlen(ptunnelrlns
[idtag
].tunnel_assignment_id
) <= 0)
237 LOG(1, s
, session
[s
].tunnel
, "Error, No tunnel_assignment_id \n");
238 else if (ptunnelrlns
[idtag
].tunnel_server_endpoint
== ntohl(config
->bind_address
))
239 LOG(0, s
, session
[s
].tunnel
, "Error, IP Remote LNS == IP local bind address (%s) !!!\n", fmtaddr(config
->bind_address
, 0));
242 for (idrlns
= 1; idrlns
< MAXRLNSTUNNEL
; ++idrlns
)
244 if (pconfigrlns
[idrlns
].state
== CONFRLNSFREE
)
246 pconfigrlns
[idrlns
].ip
= ptunnelrlns
[idtag
].tunnel_server_endpoint
;
247 pconfigrlns
[idrlns
].port
= L2TPPORT
; //Default L2TP port
248 strcpy(pconfigrlns
[idrlns
].l2tp_secret
, ptunnelrlns
[idtag
].tunnel_password
);
249 strcpy(pconfigrlns
[idrlns
].tunnel_assignment_id
, ptunnelrlns
[idtag
].tunnel_assignment_id
);
251 config
->highest_rlnsid
= idrlns
;
253 pconfigrlns
[idrlns
].state
= CONFRLNSSETBYRADIUS
;
257 else if (pconfigrlns
[idrlns
].state
== CONFRLNSSETBYRADIUS
)
259 if ( (pconfigrlns
[idrlns
].ip
== ptunnelrlns
[idtag
].tunnel_server_endpoint
) &&
260 (strcmp(pconfigrlns
[idrlns
].tunnel_assignment_id
, ptunnelrlns
[idtag
].tunnel_assignment_id
) == 0) )
262 // l2tp_secret may be changed
263 strcpy(pconfigrlns
[idrlns
].l2tp_secret
, ptunnelrlns
[idtag
].tunnel_password
);
264 pconfigrlns
[idrlns
].port
= L2TPPORT
; //Default L2TP poart
266 if (config
->highest_rlnsid
< idrlns
) config
->highest_rlnsid
= idrlns
;
273 if (idrlns
>= MAXRLNSTUNNEL
)
275 LOG(0, s
, session
[s
].tunnel
, "No more Remote LNS Conf Free\n");
282 // Create Remote LNS a Tunnel or Session
283 static int lac_create_tunnelsession(tunnelidt t
, sessionidt s
, confrlnsidt i_conf
, char * puser
)
287 if (main_quit
== QUIT_SHUTDOWN
) return 0;
290 if (!(t
= lac_new_tunnel()))
292 LOG(1, 0, 0, "No more tunnels\n");
293 STAT(tunnel_overflow
);
297 tunnel
[t
].ip
= pconfigrlns
[i_conf
].ip
;
298 tunnel
[t
].port
= pconfigrlns
[i_conf
].port
;
299 tunnel
[t
].window
= 4; // default window
300 tunnel
[t
].isremotelns
= i_conf
;
301 tunnel
[t
].indexudp
= config
->indexlacudpfd
;
302 STAT(tunnel_created
);
304 random_data(pconfigrlns
[i_conf
].auth
, sizeof(pconfigrlns
[i_conf
].auth
));
306 LOG(2, 0, t
, "Create New tunnel to REMOTE LNS %s for user %s\n", fmtaddr(htonl(tunnel
[t
].ip
), 0), puser
);
307 lac_send_SCCRQ(t
, pconfigrlns
[i_conf
].auth
, sizeof(pconfigrlns
[i_conf
].auth
));
309 else if (tunnel
[t
].state
== TUNNELOPEN
)
311 if (main_quit
!= QUIT_SHUTDOWN
)
314 /**********************/
315 /** Open New session **/
316 /**********************/
317 sessionidt new_sess
= sessionfree
;
319 sessionfree
= session
[new_sess
].next
;
320 memset(&session
[new_sess
], 0, sizeof(session
[new_sess
]));
322 if (new_sess
> config
->cluster_highest_sessionid
)
323 config
->cluster_highest_sessionid
= new_sess
;
325 session
[new_sess
].opened
= time_now
;
326 session
[new_sess
].tunnel
= t
;
327 session
[new_sess
].last_packet
= session
[s
].last_data
= time_now
;
329 session
[new_sess
].ppp
.phase
= Establish
;
330 session
[new_sess
].ppp
.lcp
= Starting
;
331 session
[s
].ppp
.phase
= Establish
;
333 LOG(2, 0, t
, "Open New session to REMOTE LNS %s for user: %s\n", fmtaddr(htonl(tunnel
[t
].ip
), 0), puser
);
334 // Sent ICRQ Incoming-call-request
335 lac_send_ICRQ(t
, new_sess
);
337 // Set session to forward to another LNS
338 session
[s
].forwardtosession
= new_sess
;
339 session
[new_sess
].forwardtosession
= s
;
340 strncpy(session
[s
].user
, puser
, sizeof(session
[s
].user
) - 1);
341 strncpy(session
[new_sess
].user
, puser
, sizeof(session
[new_sess
].user
) - 1);
343 STAT(session_created
);
347 lac_tunnelshutdown(t
, "Shutting down", 6, 0, 0);
353 LOG(1, 0, t
, "(REMOTE LNS) tunnel is not open\n");
358 // Check if session must be forwarded to another LNS
359 // return 1 if the session must be forwarded (and Creating a tunnel/session has been started)
361 // Note: check from the configuration read on the startup-config (see setforward)
362 int lac_conf_forwardtoremotelns(sessionidt s
, char * puser
)
367 for (i
= 1; i
<= config
->highest_rlnsid
; ++i
)
369 if ( (pconfigrlns
[i
].state
== CONFRLNSSET
) && (NULL
!= strstr(puser
, pconfigrlns
[i
].strmaskuser
)) )
372 for (j
= 0; j
<= config
->cluster_highest_tunnelid
; ++j
)
374 if ((tunnel
[j
].isremotelns
) &&
375 (tunnel
[j
].ip
== pconfigrlns
[i
].ip
) &&
376 (tunnel
[j
].port
== pconfigrlns
[i
].port
) &&
377 (tunnel
[j
].state
!= TUNNELDIE
))
380 if (tunnel
[t
].isremotelns
!= i
)
382 if ( (tunnel
[t
].state
== TUNNELOPEN
) || (tunnel
[t
].state
== TUNNELOPENING
) )
384 LOG(1, 0, t
, "Tunnel Remote LNS ID inconsistency (IP RLNS:%s)\n",
385 fmtaddr(htonl(pconfigrlns
[i
].ip
), 0));
387 tunnel
[t
].isremotelns
= i
;
395 return lac_create_tunnelsession(t
, s
, i
, puser
);
402 // return 1 if the session must be forwarded (and Creating a tunnel/session has been started)
404 // Note: Started from a radius response
405 int lac_rad_forwardtoremotelns(sessionidt s
, char *assignment_id
, char * puser
)
410 for (i
= 1; i
<= config
->highest_rlnsid
; ++i
)
412 if ((pconfigrlns
[i
].state
== CONFRLNSSETBYRADIUS
) &&
413 (strcmp(pconfigrlns
[i
].tunnel_assignment_id
, assignment_id
) == 0))
416 for (j
= 1; j
<= config
->cluster_highest_tunnelid
; ++j
)
418 if ((tunnel
[j
].isremotelns
== i
) &&
419 (tunnel
[j
].ip
== pconfigrlns
[i
].ip
) &&
420 (tunnel
[j
].port
== pconfigrlns
[i
].port
) &&
421 (tunnel
[j
].state
!= TUNNELDIE
))
423 if ( (tunnel
[j
].state
== TUNNELOPEN
) ||
424 (tunnel
[j
].state
== TUNNELOPENING
) )
427 LOG(3, 0, t
, "Tunnel Remote LNS already open(ing) (RLNS IP:%s)\n", fmtaddr(htonl(pconfigrlns
[i
].ip
), 0));
433 return lac_create_tunnelsession(t
, s
, i
, puser
);
440 // Calcul the remote LNS auth
441 void lac_calc_rlns_auth(tunnelidt t
, uint8_t id
, uint8_t *out
)
446 idrlns
= tunnel
[t
].isremotelns
;
449 MD5_Update(&ctx
, &id
, 1);
450 MD5_Update(&ctx
, pconfigrlns
[idrlns
].l2tp_secret
, strlen(pconfigrlns
[idrlns
].l2tp_secret
));
451 MD5_Update(&ctx
, pconfigrlns
[idrlns
].auth
, 16);
452 MD5_Final(out
, &ctx
);
455 // Forward session to LAC or Remote LNS
456 int lac_session_forward(uint8_t *buf
, int len
, sessionidt sess
, uint16_t proto
, in_addr_t s_addr
, int sin_port
, uint16_t indexudpfd
)
458 uint16_t t
= 0, s
= 0;
459 uint8_t *p
= buf
+ 2; // First word L2TP options
461 s
= session
[sess
].forwardtosession
;
462 if (session
[s
].forwardtosession
!= sess
)
464 LOG(0, sess
, session
[sess
].tunnel
, "Link Session (%u) broken\n", s
);
468 t
= session
[s
].tunnel
;
471 LOG(1, s
, t
, "Session with invalid tunnel ID\n");
475 if ((!tunnel
[t
].isremotelns
) && (!tunnel
[session
[sess
].tunnel
].isremotelns
))
477 LOG(0, sess
, session
[sess
].tunnel
, "Link Tunnel Session (%u/%u) broken\n", s
, t
);
481 if (!config
->cluster_iam_master
)
483 if ( (proto
== PPPIPCP
) || (proto
== PPPLCP
) ||
484 (proto
== PPPPAP
) || (proto
== PPPCHAP
) ||
485 (proto
== PPPIPV6CP
&& config
->ipv6_prefix
.s6_addr
[0]) ||
488 session
[sess
].last_packet
= time_now
;
489 master_forward_packet(buf
, len
, s_addr
, sin_port
, indexudpfd
);
494 if (t
== TUNNEL_ID_PPPOE
)
496 pppoe_forwardto_session_pppoe(buf
, len
, sess
, proto
);
505 *(uint16_t *) p
= htons(tunnel
[t
].far
); // tunnel
507 *(uint16_t *) p
= htons(session
[s
].far
); // session
512 *(uint16_t *) p
= htons(tunnel
[t
].ns
); // sequence
514 *(uint16_t *) p
= htons(tunnel
[t
].nr
); // sequence
518 if ((proto
== PPPIP
) || (proto
== PPPMP
) ||(proto
== PPPIPV6
&& config
->ipv6_prefix
.s6_addr
[0]))
520 session
[sess
].last_packet
= session
[sess
].last_data
= time_now
;
522 increment_counter(&session
[sess
].cin
, &session
[sess
].cin_wrap
, len
);
523 session
[sess
].cin_delta
+= len
;
525 sess_local
[sess
].cin
+= len
;
526 sess_local
[sess
].pin
++;
528 session
[s
].last_data
= time_now
;
530 increment_counter(&session
[s
].cout
, &session
[s
].cout_wrap
, len
); // byte count
531 session
[s
].cout_delta
+= len
;
533 sess_local
[s
].cout
+= len
;
534 sess_local
[s
].pout
++;
537 session
[sess
].last_packet
= time_now
;
539 tunnelsend(buf
, len
, t
); // send it...
544 // Add new Remote LNS from CLI
547 // 1 = New Remote LNS conf ADD
548 // 2 = Remote LNS Conf Updated
549 int lac_addremotelns(char *mask
, char *IP_RemoteLNS
, char *Port_RemoteLNS
, char *SecretRemoteLNS
)
553 for (idrlns
= 1; idrlns
< MAXRLNSTUNNEL
; ++idrlns
)
555 if (pconfigrlns
[idrlns
].state
== CONFRLNSFREE
)
557 snprintf((char *) pconfigrlns
[idrlns
].strmaskuser
, sizeof(pconfigrlns
[idrlns
].strmaskuser
), "%s", mask
);
558 pconfigrlns
[idrlns
].ip
= ntohl(inet_addr(IP_RemoteLNS
));
559 pconfigrlns
[idrlns
].port
= atoi(Port_RemoteLNS
);
560 snprintf((char *) pconfigrlns
[idrlns
].l2tp_secret
, sizeof(pconfigrlns
[idrlns
].l2tp_secret
), "%s", SecretRemoteLNS
);
562 config
->highest_rlnsid
= idrlns
;
564 pconfigrlns
[idrlns
].state
= CONFRLNSSET
;
568 else if ((pconfigrlns
[idrlns
].state
== CONFRLNSSET
) && (strcmp(pconfigrlns
[idrlns
].strmaskuser
, mask
) == 0))
570 if ( (pconfigrlns
[idrlns
].ip
!= ntohl(inet_addr(IP_RemoteLNS
))) ||
571 (pconfigrlns
[idrlns
].port
!= atoi(Port_RemoteLNS
)) ||
572 (strcmp(pconfigrlns
[idrlns
].l2tp_secret
, SecretRemoteLNS
) != 0) )
574 memset(&pconfigrlns
[idrlns
], 0, sizeof(pconfigrlns
[idrlns
]));
575 snprintf((char *) pconfigrlns
[idrlns
].strmaskuser
, sizeof(pconfigrlns
[idrlns
].strmaskuser
), "%s", mask
);
576 pconfigrlns
[idrlns
].ip
= ntohl(inet_addr(IP_RemoteLNS
));
577 pconfigrlns
[idrlns
].port
= atoi(Port_RemoteLNS
);
578 snprintf((char *) pconfigrlns
[idrlns
].l2tp_secret
, sizeof(pconfigrlns
[idrlns
].l2tp_secret
), "%s", SecretRemoteLNS
);
580 if (config
->highest_rlnsid
< idrlns
) config
->highest_rlnsid
= idrlns
;
582 pconfigrlns
[idrlns
].state
= CONFRLNSSET
;
583 // Conf Updated, the tunnel must be dropped
591 LOG(0, 0, 0, "No more Remote LNS Conf Free\n");
596 // Cli Show remote LNS defined
597 int lac_cli_show_remotelns(confrlnsidt idrlns
, char *strout
)
599 if (idrlns
> config
->highest_rlnsid
)
604 sprintf(strout
, "%15s %3s %-32s %-32s %11s %7s %10s",
614 tunnelidt t
, tfound
= 0;
619 strcpy(state
, "Close");
620 for (t
= 0; t
<= config
->cluster_highest_tunnelid
; ++t
)
622 if ((tunnel
[t
].isremotelns
== idrlns
) &&
623 (tunnel
[t
].ip
== pconfigrlns
[idrlns
].ip
) &&
624 (tunnel
[t
].port
== pconfigrlns
[idrlns
].port
) &&
625 (tunnel
[t
].state
!= TUNNELDIE
))
627 if (tunnel
[t
].state
== TUNNELOPENING
)
628 strcpy(state
, "Opening");
629 else if (tunnel
[t
].state
== TUNNELOPEN
)
630 strcpy(state
, "Open");
632 for (s
= 1; s
<= config
->cluster_highest_sessionid
; ++s
)
633 if (session
[s
].tunnel
== t
)
640 sprintf(strout
, "%15s %3u %-32s %-32s %11s %7s %10u",
641 fmtaddr(htonl(pconfigrlns
[idrlns
].ip
), 0),
643 pconfigrlns
[idrlns
].l2tp_secret
,
644 pconfigrlns
[idrlns
].tunnel_assignment_id
,
645 (pconfigrlns
[idrlns
].state
== CONFRLNSSET
?"File":(pconfigrlns
[idrlns
].state
== CONFRLNSSETBYRADIUS
?"Radius":"Free")),