build: W600-SDK importiert, Firmware-Build und Hello am EVK
Docker-Build mit gcc-arm-none-eabi 4.9-2014q4 (statt Homebrew-Cask) verwendet, Dockerfile/tools/docker.sh dafür aus Task 13 vorgezogen. cmake/sdk.cmake schont gcc 4.9 (kennt -fcommon/-Wno-error=... nicht). Zwei zusätzliche SDK-Stubs (EarlyInit, pre_gpio_config) in src/sys/sdk_stubs.c ergänzt, siehe sdk/PATCHES.md.
This commit is contained in:
Michael Sauer
@@ -0,0 +1,390 @@
|
||||
/**************************************************************************
|
||||
* File Name : dns_server.c
|
||||
* Author :
|
||||
* Version :
|
||||
* Date :
|
||||
* Description :
|
||||
*
|
||||
* Copyright (c) 2014 Winner Microelectronics Co., Ltd.
|
||||
* All rights reserved.
|
||||
*
|
||||
***************************************************************************/
|
||||
#ifndef WM_W600
|
||||
#include <assert.h>
|
||||
#else
|
||||
#ifndef assert
|
||||
#define assert(n)
|
||||
#endif
|
||||
#endif
|
||||
#include <stdlib.h>
|
||||
#include <stdio.h>
|
||||
#include <string.h>
|
||||
|
||||
#include "tls_common.h"
|
||||
#include "wm_mem.h"
|
||||
#include "wm_debug.h"
|
||||
#include "lwip/stats.h"
|
||||
#include "lwip/sys.h"
|
||||
#include "lwip/api.h"
|
||||
#include "lwip/tcpip.h"
|
||||
#include "lwip/memp.h"
|
||||
#include "lwip/udp.h"
|
||||
|
||||
#include "netif/ethernetif.h"
|
||||
|
||||
#include "dns_server.h"
|
||||
|
||||
#include "wm_wifi_oneshot.h"
|
||||
|
||||
#if TLS_CONFIG_AP
|
||||
static DNS_SERVER DnsServer;
|
||||
|
||||
static INT32S _DnsCompareName(INT8U * MyDns, INT8U * Query)
|
||||
{
|
||||
INT8U n;
|
||||
|
||||
if((strlen((const char *)Query) - 1) > 32)
|
||||
{
|
||||
return 1;
|
||||
}
|
||||
|
||||
do
|
||||
{
|
||||
n = *Query++;
|
||||
/* @see RFC 1035 - 4.1.4. Message compression. */
|
||||
if((n & 0xc0) == 0xc0)
|
||||
{
|
||||
/* Compressed name. */
|
||||
break;
|
||||
}
|
||||
else
|
||||
{
|
||||
/* Not compressed name. */
|
||||
while(n > 0)
|
||||
{
|
||||
if((*MyDns) != (*Query))
|
||||
{
|
||||
return 1;
|
||||
}
|
||||
++Query;
|
||||
++MyDns;
|
||||
--n;
|
||||
};
|
||||
++MyDns;
|
||||
}
|
||||
} while (*Query != 0);
|
||||
|
||||
return ((*(--MyDns) == 0) ? 0 : 1);
|
||||
}
|
||||
|
||||
static void _DNSNameErrGenAndSend(ip_addr_t *Addr, INT16U Port, PDNS_QUERY pDnsQuery, INT8U * QueryName, INT16U TansactionId)
|
||||
{
|
||||
INT32U Len;
|
||||
INT8U * Body;
|
||||
PDNS_HEADER pDnsHeader;
|
||||
struct pbuf * pDnsBuf;
|
||||
INT8U * pDnsReply;
|
||||
|
||||
Len = ((sizeof(DNS_HEADER) + (strlen((const char *)QueryName) + 1) + sizeof(DNS_QUERY) + 3) >> 2) << 2;
|
||||
pDnsReply = tls_mem_alloc(Len);
|
||||
if(pDnsReply == NULL)
|
||||
{
|
||||
return;
|
||||
}
|
||||
|
||||
pDnsHeader = (PDNS_HEADER)pDnsReply;
|
||||
Body = (INT8U *)(pDnsHeader + 1);
|
||||
Len = 0;
|
||||
|
||||
/* Header. */
|
||||
pDnsHeader->TansactionId = TansactionId;
|
||||
pDnsHeader->DnsFlag1 = DNS_FLAG1_RESPONSE;
|
||||
pDnsHeader->DnsFlag2 = DNS_FLAG2_ERR_NAME;
|
||||
pDnsHeader->Quentions = htons(1);
|
||||
pDnsHeader->AnswerRR = 0;
|
||||
pDnsHeader->AuthorityRR = 0;
|
||||
pDnsHeader->AdditionalRR = 0;
|
||||
Len += sizeof(DNS_HEADER);
|
||||
|
||||
/* Querry. */
|
||||
MEMCPY(Body, QueryName, strlen((const char *)QueryName) + 1);
|
||||
Body += strlen((const char *)QueryName) + 1;
|
||||
Len += strlen((const char *)QueryName) + 1;
|
||||
MEMCPY(Body, pDnsQuery, sizeof(DNS_QUERY));
|
||||
Len += sizeof(DNS_QUERY);
|
||||
|
||||
pDnsBuf = pbuf_alloc(PBUF_TRANSPORT, Len, PBUF_RAM);
|
||||
if(pDnsBuf == NULL)
|
||||
{
|
||||
tls_mem_free(pDnsReply);
|
||||
return;
|
||||
}
|
||||
pbuf_take(pDnsBuf, (const void *) pDnsReply, Len);
|
||||
|
||||
/* Send to the client. */
|
||||
udp_sendto(DnsServer.Socket, pDnsBuf, Addr, Port);
|
||||
pbuf_free(pDnsBuf);
|
||||
tls_mem_free(pDnsReply);
|
||||
}
|
||||
|
||||
static void _DNSAnswerGenAndSend(ip_addr_t *Addr, INT16U Port, PDNS_QUERY pDnsQuery, INT8U * QueryName, INT16U TansactionId)
|
||||
{
|
||||
INT32U Len;
|
||||
INT8U * Body;
|
||||
INT32U ServerIpAddr;
|
||||
PDNS_HEADER pDnsHeader;
|
||||
DNS_ANSWER DnsAnswer;
|
||||
struct pbuf * pDnsBuf;
|
||||
INT8U * pDnsReply;
|
||||
INT16U Tmp;
|
||||
|
||||
Len = ((sizeof(DNS_HEADER) + (strlen((const char *)QueryName) + 1) + sizeof(DNS_QUERY) + 2 + sizeof(DNS_ANSWER) + 2 + 4 + 3) >> 2) << 2;
|
||||
pDnsReply = tls_mem_alloc(Len);
|
||||
if(pDnsReply == NULL)
|
||||
{
|
||||
return;
|
||||
}
|
||||
|
||||
pDnsHeader = (PDNS_HEADER)pDnsReply;
|
||||
Body = (INT8U *)(pDnsHeader + 1);
|
||||
Len = 0;
|
||||
|
||||
/* Header. */
|
||||
pDnsHeader->TansactionId = TansactionId;
|
||||
pDnsHeader->DnsFlag1 = DNS_FLAG1_RESPONSE;
|
||||
pDnsHeader->DnsFlag2 = DNS_FLAG2_ERR_NONE;
|
||||
pDnsHeader->Quentions = htons(1);
|
||||
pDnsHeader->AnswerRR = htons(1);
|
||||
pDnsHeader->AuthorityRR = 0;
|
||||
pDnsHeader->AdditionalRR = 0;
|
||||
Len += sizeof(DNS_HEADER);
|
||||
|
||||
/* Querry. */
|
||||
MEMCPY(Body, QueryName, strlen((const char *)QueryName) + 1);
|
||||
Body += strlen((const char *)QueryName) + 1;
|
||||
Len += strlen((const char *)QueryName) + 1;
|
||||
MEMCPY(Body, pDnsQuery, sizeof(DNS_QUERY));
|
||||
Body += sizeof(DNS_QUERY);
|
||||
Len += sizeof(DNS_QUERY);
|
||||
|
||||
/* NAME: provided as offset to first occurence in response. */
|
||||
Tmp = DNS_NAME_OFFSET | sizeof(DNS_HEADER);
|
||||
Tmp = htons(Tmp);
|
||||
MEMCPY(Body, &Tmp, sizeof(INT16U));
|
||||
Body += sizeof(INT16U);
|
||||
Len += sizeof(INT16U);
|
||||
|
||||
/* Answer. */
|
||||
DnsAnswer.Type = htons(DNS_RRTYPE_A);
|
||||
DnsAnswer.Class = htons(DNS_RRCLASS_IN);
|
||||
DnsAnswer.Ttl = htonl(DNS_DEFAULT_TTL);
|
||||
MEMCPY(Body, &DnsAnswer, sizeof(DNS_ANSWER));
|
||||
Body += sizeof(DNS_ANSWER);
|
||||
Len += sizeof(DNS_ANSWER);
|
||||
|
||||
/* Length. */
|
||||
Tmp = htons(4);
|
||||
MEMCPY(Body, &Tmp, sizeof(INT16U));
|
||||
Body += sizeof(INT16U);
|
||||
Len += sizeof(INT16U);
|
||||
|
||||
/* IP Address. */
|
||||
ServerIpAddr = ip_addr_get_ip4_u32(&DnsServer.HostIp);
|
||||
MEMCPY(Body, &ServerIpAddr, 4);
|
||||
Body += 4;
|
||||
Len += 4;
|
||||
|
||||
pDnsBuf = pbuf_alloc(PBUF_TRANSPORT, Len, PBUF_RAM);
|
||||
if(pDnsBuf == NULL)
|
||||
{
|
||||
tls_mem_free(pDnsReply);
|
||||
return;
|
||||
}
|
||||
pbuf_take(pDnsBuf, (const void *) pDnsReply, Len);
|
||||
|
||||
/* Send to the client. */
|
||||
udp_sendto(DnsServer.Socket, pDnsBuf, Addr, Port);
|
||||
pbuf_free(pDnsBuf);
|
||||
tls_mem_free(pDnsReply);
|
||||
}
|
||||
|
||||
/* DNSS_RecvCb */
|
||||
/*-------------------------------------------------------------------------
|
||||
Description:
|
||||
When an incoming DNS message is to me, this function process it and trigger the state machine.
|
||||
|
||||
Arguments:
|
||||
Arg: Pointer to the user supplied argument.
|
||||
Pcb: Pointer to the udp_pcb which received data.
|
||||
P: Pointer to the packet buffer that was received.
|
||||
Addr: The remote IP address from which the packet was received.
|
||||
Port: The remote port from which the packet was received .
|
||||
|
||||
Return Value:
|
||||
None.
|
||||
|
||||
Note:
|
||||
|
||||
-------------------------------------------------------------------------*/
|
||||
void DNSS_RecvCb(void *Arg, struct udp_pcb *Pcb, struct pbuf *P, ip_addr_t *Addr, INT16U Port)
|
||||
{
|
||||
PDNS_HEADER pDnsHeader;
|
||||
DNS_QUERY DnsQuery;
|
||||
//INT16U nQuestions, nAnswers;
|
||||
INT8U * pDnsName;
|
||||
INT8U * pDnsMsg;
|
||||
|
||||
do
|
||||
{
|
||||
pDnsMsg = tls_mem_alloc(P->tot_len);
|
||||
if(pDnsMsg == NULL)
|
||||
{
|
||||
break;
|
||||
}
|
||||
pbuf_copy_partial(P, pDnsMsg, P->tot_len, 0);
|
||||
|
||||
pDnsHeader = (PDNS_HEADER)pDnsMsg;
|
||||
|
||||
/* Get the quention number and answer number. */
|
||||
//nQuestions = ntohs(pDnsHeader->Quentions);
|
||||
//nAnswers = ntohs(pDnsHeader->AnswerRR);
|
||||
|
||||
/* Filter out the response frame and the unstandard query frame. */
|
||||
if((pDnsHeader->DnsFlag1 & DNS_FLAG1_RESPONSE) || ((pDnsHeader->DnsFlag1 & (0xf << 3)) != DNS_FLAG1_OPCODE_STANDARD))
|
||||
{
|
||||
break;
|
||||
}
|
||||
|
||||
/* Locate the dns name. */
|
||||
pDnsName = (INT8U *)(pDnsHeader + 1);
|
||||
|
||||
/* Get the query class and type. */
|
||||
MEMCPY(&DnsQuery, (pDnsName + strlen((const char *)pDnsName) + 1), sizeof(DnsQuery));
|
||||
|
||||
/* Check the query class and type. */
|
||||
if((DnsQuery.Class != htons(DNS_RRCLASS_IN)) && (DnsQuery.Type != htons(DNS_RRTYPE_A)))
|
||||
{
|
||||
break;
|
||||
}
|
||||
|
||||
if ((_DnsCompareName(DnsServer.DnsName, pDnsName) != 0) &&
|
||||
!((1 == 0 /*tls_wifi_get_oneshot_flag()*/) &&
|
||||
(2 == 0 /*tls_wifi_get_oneshot_config_mode()*/)))
|
||||
{
|
||||
/* Not my dns name, so notify the client name error. */
|
||||
#if TLS_CONFIG_AP
|
||||
struct netif *netif = tls_get_netif();
|
||||
if (!netif_is_up(netif))
|
||||
#endif
|
||||
_DNSNameErrGenAndSend(Addr, Port, &DnsQuery, pDnsName, pDnsHeader->TansactionId);
|
||||
}
|
||||
else
|
||||
{
|
||||
/* My dns name, so send the answer to the client. */
|
||||
_DNSAnswerGenAndSend(Addr, Port, &DnsQuery, pDnsName, pDnsHeader->TansactionId);
|
||||
}
|
||||
}while(0);
|
||||
|
||||
if(pDnsMsg)
|
||||
{
|
||||
tls_mem_free(pDnsMsg);
|
||||
}
|
||||
pbuf_free(P);
|
||||
}
|
||||
|
||||
/* DNSS_Config */
|
||||
/*-------------------------------------------------------------------------
|
||||
Description:
|
||||
This function is used to updata the server's dns name.
|
||||
Arguments:
|
||||
DnsName : Pointer the server's dns name.
|
||||
|
||||
Return Value:
|
||||
The DNS Server error code:
|
||||
DNSS_ERR_SUCCESS - No error
|
||||
DNSS_ERR_PARAM - Input parameter error
|
||||
Note:
|
||||
The length of the DNS name must be less than 32.
|
||||
-------------------------------------------------------------------------*/
|
||||
INT8S DNSS_Config(INT8U * DnsName)
|
||||
{
|
||||
if((DnsName == NULL) || (strlen((const char *)DnsName) > 32))
|
||||
{
|
||||
/* The length of the DNS name must be less than 32. */
|
||||
return DNSS_ERR_PARAM;
|
||||
}
|
||||
|
||||
memset(DnsServer.DnsName, 0, 32);
|
||||
MEMCPY(DnsServer.DnsName, DnsName, strlen((const char *)DnsName));
|
||||
|
||||
return DNSS_ERR_SUCCESS;
|
||||
}
|
||||
|
||||
/* DNSS_Start */
|
||||
/*-------------------------------------------------------------------------
|
||||
Description:
|
||||
This function is used to start the dns server's service.
|
||||
Arguments:
|
||||
DnsName : Specify the server's dns name
|
||||
Netif: Pointer to the Lwip network interface.
|
||||
|
||||
Return Value:
|
||||
The DNS Server error code:
|
||||
DNSS_ERR_SUCCESS - No error
|
||||
DNSS_ERR_PARAM - Input parameter error
|
||||
DNSS_ERR_MEM - Out of memory
|
||||
DNSS_ERR_LINKDOWN - The NI is inactive
|
||||
Note:
|
||||
The dns server must be started after the network interface was actived.
|
||||
-------------------------------------------------------------------------*/
|
||||
INT8S DNSS_Start(struct netif *Netif, INT8U * DnsName)
|
||||
{
|
||||
if((Netif == NULL) || (strlen((const char *)DnsName) > 32))
|
||||
{
|
||||
return DNSS_ERR_PARAM;
|
||||
}
|
||||
|
||||
if(netif_is_up(Netif) == 0)
|
||||
{
|
||||
return DNSS_ERR_LINKDOWN;
|
||||
}
|
||||
|
||||
memset(&DnsServer, 0, sizeof(DnsServer));
|
||||
|
||||
MEMCPY(DnsServer.DnsName, DnsName, strlen((const char *)DnsName));
|
||||
ip_addr_set(&DnsServer.HostIp, &Netif->ip_addr);
|
||||
|
||||
DnsServer.Socket = udp_new();
|
||||
if(DnsServer.Socket == NULL)
|
||||
{
|
||||
return DNSS_ERR_MEM;
|
||||
}
|
||||
|
||||
/* Set up local and remote port for the pcb. */
|
||||
udp_bind(DnsServer.Socket, IP_ADDR_ANY, DNS_SERVER_PORT);
|
||||
|
||||
/* Set up the recv callback and argument. */
|
||||
udp_recv(DnsServer.Socket, (udp_recv_fn)DNSS_RecvCb, Netif);
|
||||
|
||||
return DNSS_ERR_SUCCESS;
|
||||
}
|
||||
|
||||
/* DNSS_Stop */
|
||||
/*-------------------------------------------------------------------------
|
||||
Description:
|
||||
This function is used to stop the dns server's service.
|
||||
Arguments:
|
||||
None.
|
||||
|
||||
Return Value:
|
||||
None.
|
||||
|
||||
Note:
|
||||
|
||||
-------------------------------------------------------------------------*/
|
||||
void DNSS_Stop(void)
|
||||
{
|
||||
if(DnsServer.Socket) udp_remove(DnsServer.Socket);
|
||||
}
|
||||
#endif
|
||||
|
||||
Reference in New Issue
Block a user