308 lines
9.3 KiB
C
308 lines
9.3 KiB
C
/*********************************************************************
|
|
PicoTCP. Copyright (c) 2012-2017 Altran Intelligent Systems. Some rights reserved.
|
|
See COPYING, LICENSE.GPLv2 and LICENSE.GPLv3 for usage.
|
|
|
|
Authors: Bogdan Lupu
|
|
*********************************************************************/
|
|
#include "pico_slaacv4.h"
|
|
#include "pico_arp.h"
|
|
#include "pico_constants.h"
|
|
#include "pico_stack.h"
|
|
#include "pico_hotplug_detection.h"
|
|
|
|
#ifdef PICO_SUPPORT_SLAACV4
|
|
|
|
#ifdef DEBUG_SLAACV4
|
|
#define slaacv4_dbg dbg
|
|
#else
|
|
#define slaacv4_dbg(...) do {} while(0)
|
|
#endif
|
|
|
|
#define SLAACV4_NETWORK ((long_be(0xa9fe0000)))
|
|
#define SLAACV4_NETMASK ((long_be(0xFFFF0000)))
|
|
#define SLAACV4_MINRANGE (0x00000100) /* In host order */
|
|
#define SLAACV4_MAXRANGE (0x0000FDFF) /* In host order */
|
|
|
|
#define SLAACV4_CREATE_IPV4(seed) ((long_be((seed % SLAACV4_MAXRANGE) + SLAACV4_MINRANGE) & ~SLAACV4_NETMASK) | SLAACV4_NETWORK)
|
|
|
|
#define PROBE_WAIT 1 /* delay between two tries during claim */
|
|
#define PROBE_NB 3 /* number of probe packets during claim */
|
|
/* #define PROBE_MIN 1 */
|
|
/* #define PROBE_MAX 2 */
|
|
#define ANNOUNCE_WAIT 2 /* delay before start announcing */
|
|
#define ANNOUNCE_NB 2 /* number of announcement packets */
|
|
#define ANNOUNCE_INTERVAL 2 /* time between announcement packets */
|
|
#define MAX_CONFLICTS 10 /* max conflicts before rate limiting */
|
|
#define MAX_CONFLICTS_FAIL 20 /* max conflicts before declaring failure */
|
|
#define RATE_LIMIT_INTERVAL 60 /* time between successive attempts */
|
|
#define DEFEND_INTERVAL 10 /* minimum interval between defensive ARP */
|
|
|
|
enum slaacv4_state {
|
|
SLAACV4_RESET = 0,
|
|
SLAACV4_CLAIMING,
|
|
SLAACV4_CLAIMED,
|
|
SLAACV4_ANNOUNCING,
|
|
SLAACV4_ERROR
|
|
};
|
|
|
|
struct slaacv4_cookie {
|
|
enum slaacv4_state state;
|
|
uint8_t probe_try_nb;
|
|
uint8_t conflict_nb;
|
|
uint8_t announce_nb;
|
|
struct pico_ip4 ip;
|
|
struct pico_device *device;
|
|
uint32_t timer;
|
|
void (*cb)(struct pico_ip4 *ip, uint8_t code);
|
|
};
|
|
|
|
static void pico_slaacv4_hotplug_cb(struct pico_device *dev, int event);
|
|
|
|
static struct slaacv4_cookie slaacv4_local;
|
|
|
|
static uint32_t pico_slaacv4_getip(struct pico_device *dev, uint8_t rand)
|
|
{
|
|
uint32_t seed = 0;
|
|
if (dev->eth != NULL)
|
|
{
|
|
seed = pico_hash((const uint8_t *)dev->eth->mac.addr, PICO_SIZE_ETH);
|
|
}
|
|
|
|
if (rand)
|
|
{
|
|
seed += pico_rand();
|
|
}
|
|
|
|
return SLAACV4_CREATE_IPV4(seed);
|
|
}
|
|
|
|
static void pico_slaacv4_init_cookie(struct pico_ip4 *ip, struct pico_device *dev, struct slaacv4_cookie *ck, void (*cb)(struct pico_ip4 *ip, uint8_t code))
|
|
{
|
|
ck->state = SLAACV4_RESET;
|
|
ck->probe_try_nb = 0;
|
|
ck->conflict_nb = 0;
|
|
ck->announce_nb = 0;
|
|
ck->cb = cb;
|
|
ck->device = dev;
|
|
ck->ip.addr = ip->addr;
|
|
ck->timer = 0;
|
|
}
|
|
|
|
static void pico_slaacv4_cancel_timers(struct slaacv4_cookie *tmp)
|
|
{
|
|
pico_timer_cancel(tmp->timer);
|
|
tmp->timer = 0;
|
|
}
|
|
|
|
static void pico_slaacv4_send_announce_timer(pico_time now, void *arg)
|
|
{
|
|
struct slaacv4_cookie *tmp = (struct slaacv4_cookie *)arg;
|
|
struct pico_ip4 netmask = {
|
|
0
|
|
};
|
|
netmask.addr = long_be(0xFFFF0000);
|
|
|
|
(void)now;
|
|
|
|
if (tmp->announce_nb < ANNOUNCE_NB)
|
|
{
|
|
pico_arp_request(tmp->device, &tmp->ip, PICO_ARP_ANNOUNCE);
|
|
tmp->announce_nb++;
|
|
tmp->timer = pico_timer_add(ANNOUNCE_INTERVAL * 1000, pico_slaacv4_send_announce_timer, arg);
|
|
if (!tmp->timer) {
|
|
slaacv4_dbg("SLAACV4: Failed to start announce timer\n");
|
|
tmp->state = SLAACV4_ERROR;
|
|
if (tmp->cb != NULL)
|
|
tmp->cb(&tmp->ip, PICO_SLAACV4_ERROR);
|
|
}
|
|
}
|
|
else
|
|
{
|
|
tmp->state = SLAACV4_CLAIMED;
|
|
pico_ipv4_link_add(tmp->device, tmp->ip, netmask);
|
|
if (tmp->cb != NULL)
|
|
tmp->cb(&tmp->ip, PICO_SLAACV4_SUCCESS);
|
|
}
|
|
}
|
|
|
|
static void pico_slaacv4_send_probe_timer(pico_time now, void *arg)
|
|
{
|
|
struct slaacv4_cookie *tmp = (struct slaacv4_cookie *)arg;
|
|
(void)now;
|
|
|
|
if (tmp->probe_try_nb < PROBE_NB)
|
|
{
|
|
pico_arp_request(tmp->device, &tmp->ip, PICO_ARP_PROBE);
|
|
tmp->probe_try_nb++;
|
|
tmp->timer = pico_timer_add(PROBE_WAIT * 1000, pico_slaacv4_send_probe_timer, tmp);
|
|
if (!tmp->timer) {
|
|
slaacv4_dbg("SLAACV4: Failed to start probe timer\n");
|
|
tmp->state = SLAACV4_ERROR;
|
|
if (tmp->cb != NULL)
|
|
tmp->cb(&tmp->ip, PICO_SLAACV4_ERROR);
|
|
}
|
|
}
|
|
else
|
|
{
|
|
tmp->state = SLAACV4_ANNOUNCING;
|
|
tmp->timer = pico_timer_add(ANNOUNCE_WAIT * 1000, pico_slaacv4_send_announce_timer, arg);
|
|
if (!tmp->timer) {
|
|
slaacv4_dbg("SLAACV4: Failed to start announce timer\n");
|
|
tmp->state = SLAACV4_ERROR;
|
|
if (tmp->cb != NULL)
|
|
tmp->cb(&tmp->ip, PICO_SLAACV4_ERROR);
|
|
}
|
|
}
|
|
}
|
|
|
|
static void pico_slaacv4_receive_ipconflict(int reason)
|
|
{
|
|
struct slaacv4_cookie *tmp = &slaacv4_local;
|
|
|
|
tmp->conflict_nb++;
|
|
pico_slaacv4_cancel_timers(tmp);
|
|
|
|
if(tmp->state == SLAACV4_CLAIMED)
|
|
{
|
|
if(reason == PICO_ARP_CONFLICT_REASON_CONFLICT)
|
|
{
|
|
pico_ipv4_link_del(tmp->device, tmp->ip);
|
|
}
|
|
}
|
|
|
|
if (tmp->conflict_nb < MAX_CONFLICTS)
|
|
{
|
|
tmp->state = SLAACV4_CLAIMING;
|
|
tmp->probe_try_nb = 0;
|
|
tmp->announce_nb = 0;
|
|
tmp->ip.addr = pico_slaacv4_getip(tmp->device, (uint8_t)1);
|
|
pico_arp_register_ipconflict(&tmp->ip, &tmp->device->eth->mac, pico_slaacv4_receive_ipconflict);
|
|
pico_arp_request(tmp->device, &tmp->ip, PICO_ARP_PROBE);
|
|
tmp->probe_try_nb++;
|
|
tmp->timer = pico_timer_add(PROBE_WAIT * 1000, pico_slaacv4_send_probe_timer, tmp);
|
|
if (!tmp->timer) {
|
|
slaacv4_dbg("SLAACV4: Failed to start probe timer\n");
|
|
tmp->state = SLAACV4_ERROR;
|
|
if (tmp->cb != NULL)
|
|
tmp->cb(&tmp->ip, PICO_SLAACV4_ERROR);
|
|
}
|
|
}
|
|
else if (tmp->conflict_nb < MAX_CONFLICTS_FAIL)
|
|
{
|
|
tmp->state = SLAACV4_CLAIMING;
|
|
tmp->probe_try_nb = 0;
|
|
tmp->announce_nb = 0;
|
|
tmp->ip.addr = pico_slaacv4_getip(tmp->device, (uint8_t)1);
|
|
pico_arp_register_ipconflict(&tmp->ip, &tmp->device->eth->mac, pico_slaacv4_receive_ipconflict);
|
|
tmp->timer = pico_timer_add(RATE_LIMIT_INTERVAL * 1000, pico_slaacv4_send_probe_timer, tmp);
|
|
if (!tmp->timer) {
|
|
slaacv4_dbg("SLAACV4: Failed to start probe timer\n");
|
|
tmp->state = SLAACV4_ERROR;
|
|
if (tmp->cb != NULL)
|
|
tmp->cb(&tmp->ip, PICO_SLAACV4_ERROR);
|
|
}
|
|
}
|
|
else
|
|
{
|
|
if (tmp->cb != NULL)
|
|
{
|
|
pico_hotplug_deregister(tmp->device, &pico_slaacv4_hotplug_cb);
|
|
tmp->cb(&tmp->ip, PICO_SLAACV4_ERROR);
|
|
}
|
|
|
|
tmp->state = SLAACV4_ERROR;
|
|
}
|
|
|
|
}
|
|
|
|
static void pico_slaacv4_hotplug_cb(__attribute__((unused)) struct pico_device *dev, int event)
|
|
{
|
|
struct slaacv4_cookie *tmp = &slaacv4_local;
|
|
|
|
if (event == PICO_HOTPLUG_EVENT_UP )
|
|
{
|
|
slaacv4_local.state = SLAACV4_CLAIMING;
|
|
tmp->probe_try_nb = 0;
|
|
tmp->announce_nb = 0;
|
|
|
|
pico_arp_register_ipconflict(&tmp->ip, &tmp->device->eth->mac, pico_slaacv4_receive_ipconflict);
|
|
pico_arp_request(tmp->device, &tmp->ip, PICO_ARP_PROBE);
|
|
tmp->probe_try_nb++;
|
|
tmp->timer = pico_timer_add(PROBE_WAIT * 1000, pico_slaacv4_send_probe_timer, tmp);
|
|
if (!tmp->timer) {
|
|
slaacv4_dbg("SLAACV4: Failed to start probe timer\n");
|
|
tmp->state = SLAACV4_ERROR;
|
|
if (tmp->cb != NULL)
|
|
tmp->cb(&tmp->ip, PICO_SLAACV4_ERROR);
|
|
}
|
|
}
|
|
else
|
|
{
|
|
if (tmp->state == SLAACV4_CLAIMED )
|
|
pico_ipv4_link_del(tmp->device, tmp->ip);
|
|
|
|
pico_slaacv4_cancel_timers(tmp);
|
|
}
|
|
}
|
|
|
|
int pico_slaacv4_claimip(struct pico_device *dev, void (*cb)(struct pico_ip4 *ip, uint8_t code))
|
|
{
|
|
struct pico_ip4 ip;
|
|
|
|
if (!dev->eth) {
|
|
pico_err = PICO_ERR_EPROTONOSUPPORT;
|
|
return -1;
|
|
}
|
|
|
|
if( dev->link_state != NULL )
|
|
{
|
|
/* hotplug detect will work */
|
|
|
|
ip.addr = pico_slaacv4_getip(dev, 0);
|
|
pico_slaacv4_init_cookie(&ip, dev, &slaacv4_local, cb);
|
|
|
|
if (pico_hotplug_register(dev, &pico_slaacv4_hotplug_cb))
|
|
{
|
|
return -1;
|
|
}
|
|
}
|
|
else
|
|
{
|
|
ip.addr = pico_slaacv4_getip(dev, 0);
|
|
|
|
pico_slaacv4_init_cookie(&ip, dev, &slaacv4_local, cb);
|
|
pico_arp_register_ipconflict(&ip, &dev->eth->mac, pico_slaacv4_receive_ipconflict);
|
|
pico_arp_request(dev, &ip, PICO_ARP_PROBE);
|
|
slaacv4_local.state = SLAACV4_CLAIMING;
|
|
slaacv4_local.probe_try_nb++;
|
|
slaacv4_local.timer = pico_timer_add(PROBE_WAIT * 1000, pico_slaacv4_send_probe_timer, &slaacv4_local);
|
|
if (!slaacv4_local.timer) {
|
|
slaacv4_dbg("SLAACV4: Failed to start probe timer\n");
|
|
slaacv4_local.state = SLAACV4_ERROR;
|
|
return -1;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
void pico_slaacv4_unregisterip(void)
|
|
{
|
|
struct slaacv4_cookie *tmp = &slaacv4_local;
|
|
struct pico_ip4 empty = {
|
|
.addr = 0x00000000
|
|
};
|
|
|
|
if (tmp->state == SLAACV4_CLAIMED)
|
|
{
|
|
pico_ipv4_link_del(tmp->device, tmp->ip);
|
|
}
|
|
|
|
pico_slaacv4_cancel_timers(tmp);
|
|
pico_slaacv4_init_cookie(&empty, NULL, tmp, NULL);
|
|
pico_arp_register_ipconflict(&tmp->ip, NULL, NULL);
|
|
pico_hotplug_deregister(tmp->device, &pico_slaacv4_hotplug_cb);
|
|
}
|
|
|
|
#endif
|