Discovery Service

#include <dev/board.h>
#include <sys/timer.h>
 
#include <stdio.h>
#include <io.h>
 
#include <netinet/in.h>
#include <arpa/inet.h>
 
#include <pro/dhcp.h>
#include <pro/discover.h>
 
static NutDiscoveryCallback default_handler;
static int MyHandler(uint32_t ip, uint16_t port, DISCOVERY_TELE * dist, int len);
 
int main(void)
{
    u_long baud = 115200;
 
    NutRegisterDevice(&DEV_DEBUG, 0, 0);
    freopen(DEV_DEBUG_NAME, "w", stdout);
    _ioctl(_fileno(stdout), UART_SETSPEED, &baud);
    puts("Discovery Service Sample");
 
    if (NutRegisterDevice(&DEV_ETHER, 0, 0)) {
        puts("Registering " DEV_ETHER_NAME " failed.");
    }
    else if (NutDhcpIfConfig(DEV_ETHER_NAME, NULL, 0)) {
        uint8_t initial_mac[6] = { 0x00, 0x06, 0x98, 0x00, 0x00, 0x00 };
 
        if (NutDhcpIfConfig(DEV_ETHER_NAME, initial_mac, 0)) {
            u_long initial_ip_addr = inet_addr("192.0.0.192");
            u_long initial_ip_mask = inet_addr("255.255.255.0");
 
            NutNetIfConfig(DEV_ETHER_NAME, initial_mac, initial_ip_addr, initial_ip_mask);
        }
    }
    if (NutRegisterDiscovery(INADDR_BROADCAST, 0, DISF_INITAL_ANN)) {
        printf("Discover Service failed");
    } else {
        default_handler = NutRegisterDiscoveryCallback(MyHandler);
    }
    for (;;) {
        NutSleep(1000);
    }
    return 0;
}

static int MyHandler(uint32_t ip, uint16_t port, DISCOVERY_TELE * dist, int len)
{
    char * tt;
 
    switch (dist->dist_type) {
    case DIST_REQUEST:
        tt = "request";
        break;
    case DIST_ANNOUNCE:
        tt = "announce";
        break;
    case DIST_APPLY:
        tt = "apply";
        break;
    default:
        tt = "telegram";
        break;
    }
    printf("Discovery %s from %s\n", tt, inet_ntoa(ip));
    return (*default_handler)(ip, port, dist, len);
}

Category: Code Snippets