mirror of
https://github.com/rvtr/TwlToolsRED.git
synced 2025-10-31 06:41:18 -04:00
460 lines
12 KiB
C
460 lines
12 KiB
C
/*---------------------------------------------------------------------------*
|
||
Project: TwlWiFi - demos - netconnect
|
||
File: netconnect.c
|
||
|
||
Copyright 2005,2006 Nintendo. All rights reserved.
|
||
|
||
These coded instructions, statements, and computer programs contain
|
||
proprietary information of Nintendo of America Inc. and/or Nintendo
|
||
Company Ltd., and are protected by Federal copyright law. They may
|
||
not be disclosed to third parties or copied or duplicated in any form,
|
||
in whole or in part, without the prior written consent of Nintendo.
|
||
|
||
$Date:: 2008-08-06#$
|
||
$Rev: 880 $
|
||
$Author: adachi_hiroaki $
|
||
*---------------------------------------------------------------------------*/
|
||
|
||
#include <nitro.h>
|
||
#include <nitroWiFi.h>
|
||
|
||
#include "sitedefs.h"
|
||
#include "wcm_control.h"
|
||
#include "netconnect.h"
|
||
#include "mywlan.h"
|
||
|
||
#include "text.h"
|
||
#include "mprintf.h"
|
||
#include "logprintf.h"
|
||
|
||
|
||
/*---------------------------------------------------------------------------*
|
||
<20>‰Šú‰»
|
||
*---------------------------------------------------------------------------*/
|
||
static void Heap_Setup(void);
|
||
#ifdef SDK_TWL
|
||
static void* myAlloc_SOCL(u32 size);
|
||
static void myFree_SOCL(void* ptr);
|
||
#endif // SDK_TWL
|
||
|
||
static int ncStartWiFi(void);
|
||
static void ncFinishWiFi(void);
|
||
|
||
static WcmControlApInfo apInfo;
|
||
static s32 previousAddr = 0;
|
||
static u8 g_deviceId = WCM_DEVICEID_DEFAULT;
|
||
static BOOL g_started = FALSE;
|
||
|
||
|
||
static int nc_error_code = 0;
|
||
|
||
|
||
/*---------------------------------------------------------------------------*
|
||
Name : NcGlobalInit
|
||
Description :
|
||
Arguments : ‚È‚µ<E2809A>B
|
||
Returns :
|
||
*---------------------------------------------------------------------------*/
|
||
void NcGlobalInit()
|
||
{
|
||
OS_Init();
|
||
OS_InitTick();
|
||
OS_InitAlarm();
|
||
RTC_Init();
|
||
Heap_Setup();
|
||
(void)OS_EnableIrq();
|
||
(void)OS_EnableInterrupts();
|
||
}
|
||
|
||
#if 0
|
||
typedef struct
|
||
{
|
||
BOOL use_dhcp; // if TRUE, use dhcp
|
||
struct
|
||
{
|
||
SOCLInAddr my_ip;
|
||
SOCLInAddr net_mask;
|
||
SOCLInAddr gateway_ip;
|
||
SOCLInAddr dns_ip[2];
|
||
} host_ip;
|
||
void* (*alloc) (u32);
|
||
void (*free) (void*);
|
||
|
||
u32 cmd_packet_max; // ƒRƒ}ƒ“ƒhƒpƒPƒbƒg‚Ì<E2809A>Å‘å<E28098>”
|
||
u32 lan_buffer_size; // 0 ‚È‚ç *alloc ‚ÅŽ©—ÍŠm•Û
|
||
void* lan_buffer; // 0 ‚È‚ç default(16384)<29>Ý’è
|
||
|
||
// CPS ƒXƒŒƒbƒh‚Ì—D<E28094>æ“x
|
||
// 0 ‚È‚ç SOCL_CPS_SOCKET_THREAD_PRIORITY
|
||
s32 cps_thread_prio;
|
||
|
||
// ’Ê<E28099>Mƒoƒbƒtƒ@ƒTƒCƒY
|
||
s32 mtu; //default 1500
|
||
s32 rwin;
|
||
} SOCLConfig;
|
||
|
||
#endif
|
||
|
||
static u32 endian_conv(u32 addr)
|
||
{
|
||
u32 temp = 0;
|
||
temp = ( addr >> 24 ) & 0xff;
|
||
temp |= ((( addr >> 16 ) & 0xff) << 8 );
|
||
temp |= ((( addr >> 8 ) & 0xff) << 16 );
|
||
temp |= (( addr & 0xff) << 24 );
|
||
return temp;
|
||
}
|
||
|
||
|
||
|
||
static int ncStartWiFi(void)
|
||
{
|
||
int result;
|
||
int timeout_counter;
|
||
SOCInAddr dns1;
|
||
SOCInAddr dns2;
|
||
|
||
if (previousAddr != 0)
|
||
{
|
||
/*
|
||
DHCPƒT<C692>[ƒo‚É‘O‰ñŽæ“¾‚µ‚½ƒAƒhƒŒƒX‚ð—v‹<76>‚·‚é‚悤‚É<E2809A>Ý’è‚·‚é<E2809A>B
|
||
ƒAƒhƒŒƒXƒv<C692>[ƒ‹‚ðŽg‚¢<E2809A>Ø‚ç‚È‚¢‚悤‚É‚·‚邽‚ß‚É•K—v<E28094>B
|
||
*/
|
||
SOCL_SetRequestedIP(SOC_NtoHl(previousAddr));
|
||
}
|
||
|
||
#ifdef SDK_TWL
|
||
if (OS_IsRunOnTwl())
|
||
{
|
||
static SOCLConfig socl_config;
|
||
|
||
|
||
MI_CpuClear8(&socl_config, sizeof(socl_config));
|
||
|
||
socl_config.alloc = myAlloc_SOCL;
|
||
socl_config.free = myFree_SOCL;
|
||
socl_config.use_dhcp = TRUE;
|
||
socl_config.cmd_packet_max = SOCL_CMDPACKET_MAX;
|
||
socl_config.lan_buffer_size = SOCL_LAN_BUFFER_SIZE_DEFAULT * 8;
|
||
socl_config.mtu = 1400;
|
||
socl_config.rwin = 65535;
|
||
|
||
|
||
|
||
|
||
socl_config.use_dhcp = GetDhcpMODE();
|
||
socl_config.host_ip.gateway_ip = GetGateway();
|
||
socl_config.host_ip.net_mask = GetNetmask();
|
||
socl_config.host_ip.my_ip = GetIPAddr();
|
||
socl_config.host_ip.dns_ip[0] = GetDNS1();
|
||
socl_config.host_ip.dns_ip[1] = GetDNS2();
|
||
OS_TPrintf("DNS1 0x%08x\n",GetDNS1());
|
||
OS_TPrintf("DNS2 0x%08x\n",GetDNS2());
|
||
|
||
OS_TPrintf("SOCL_Startup1....\n");
|
||
result = SOCL_Startup(&socl_config);
|
||
}
|
||
else
|
||
#endif // SDK_TWL
|
||
{
|
||
SOCConfig soc_config;
|
||
soc_config.alloc = NcAlloc;
|
||
soc_config.free = NcFree;
|
||
soc_config.flag = SOC_FLAG_DHCP;
|
||
soc_config.mtu = 0;
|
||
soc_config.rwin = 0;
|
||
|
||
OS_TPrintf("SOC_Startup2....\n");
|
||
result = SOC_Startup(&soc_config);
|
||
}
|
||
if (result < 0)
|
||
{
|
||
OS_TPrintf("SOC_Startup failed (%d)", result);
|
||
mprintf("SOC_Startup failed (%d)", result);
|
||
return -2;
|
||
}
|
||
g_started = TRUE;
|
||
OS_TPrintf("DHCP....\n");
|
||
|
||
timeout_counter = 0;
|
||
|
||
while (SOC_GetHostID() == 0)
|
||
{
|
||
s32 err_code = SOC_GetConfigError(NULL);
|
||
if( err_code == SOC_IP_ERR_DHCP_TIMEOUT ) {
|
||
mprintf("%s -dhcp timeout\n",__FUNCTION__);
|
||
return NC_ERROR_TIMEOUT;
|
||
}
|
||
else if(err_code == SOC_IP_ERR_LINK_DOWN ) {
|
||
mprintf("%s -link down\n",__FUNCTION__);
|
||
return NC_ERROR_LINKDOWN;
|
||
}
|
||
else {
|
||
OS_Sleep(100);
|
||
timeout_counter++;
|
||
if( timeout_counter > (60 * 1000 / 100) ) {
|
||
mprintf("%s -timeout\n",__FUNCTION__);
|
||
return NC_ERROR_TIMEOUT;
|
||
}
|
||
}
|
||
}
|
||
|
||
// int SOC_SetResolver(const SOCInAddr* dns1, const SOCInAddr* dns2)
|
||
if( GetDNS1() || GetDNS2()) {
|
||
dns1.addr = endian_conv(GetDNS1());
|
||
dns2.addr = endian_conv(GetDNS2());
|
||
(void)SOC_SetResolver(&dns1, &dns2);
|
||
}
|
||
|
||
OS_TPrintf("IP addr = %3d.%3d.%3d.%3d\n", CPS_CV_IPv4(CPSMyIp));
|
||
OS_TPrintf("NetMask = %3d.%3d.%3d.%3d\n", CPS_CV_IPv4(CPSNetMask));
|
||
OS_TPrintf("GW addr = %3d.%3d.%3d.%3d\n", CPS_CV_IPv4(CPSGatewayIp));
|
||
OS_TPrintf("DNS[0] = %3d.%3d.%3d.%3d\n", CPS_CV_IPv4(CPSDnsIp[0]));
|
||
OS_TPrintf("DNS[1] = %3d.%3d.%3d.%3d\n", CPS_CV_IPv4(CPSDnsIp[1]));
|
||
|
||
|
||
return 0;
|
||
}
|
||
|
||
static void ncFinishWiFi(void)
|
||
{
|
||
previousAddr = SOC_GetHostID();
|
||
if (g_started)
|
||
{
|
||
(void)SOC_Cleanup();
|
||
g_started = FALSE;
|
||
}
|
||
}
|
||
|
||
|
||
|
||
/*---------------------------------------------------------------------------*
|
||
Name : NcStart
|
||
Description :
|
||
Arguments : apClass - SitDefs‚É’è‹`‚³‚ê‚Ä‚¢‚éƒAƒNƒZƒXƒ|ƒCƒ“ƒg‚̃Nƒ‰ƒX–¼
|
||
Returns :
|
||
*---------------------------------------------------------------------------*/
|
||
int NcStart(const char* apClass)
|
||
{
|
||
int counter = 0;
|
||
s32 wcm_phase;
|
||
int len;
|
||
u8 key_bin_buf[MAX_KEY_BIN_BUF];
|
||
int timeout_counter;
|
||
int sec = 0;
|
||
|
||
SiteDefs_Init();
|
||
|
||
if( TRUE == GetKeyModeStr() ) {
|
||
if( FALSE == ENV_SetBinary("WiFi.LAN.1.AP.1.WEP.KEY", (void *)GetWlanKEYSTR()) ) {
|
||
OS_TPrintf("Error %s %d\n", __FUNCTION__,__LINE__);
|
||
}
|
||
}
|
||
else {
|
||
STD_MemSet((void *)key_bin_buf, 0, MAX_KEY_BIN_BUF );
|
||
len = GetWlanKEYBIN(key_bin_buf);
|
||
if( len ) {
|
||
if( FALSE == ENV_SetBinary2("WiFi.LAN.1.AP.1.WEP.KEY", (void *)key_bin_buf, (u32)len) ) {
|
||
OS_TPrintf("Error %s %d\n", __FUNCTION__,__LINE__);
|
||
}
|
||
}
|
||
}
|
||
|
||
if( FALSE == ENV_SetString("WiFi.LAN.1.AP.1.ESSID", GetWlanSSID()) ) {
|
||
OS_TPrintf("Error %s %d\n", __FUNCTION__,__LINE__);
|
||
}
|
||
|
||
if( FALSE == ENV_SetU8("WiFi.LAN.1.AP.1.WEP.MODE", (u8)GetWlanMode() ) ) {
|
||
OS_TPrintf("Error %s %d\n", __FUNCTION__,__LINE__);
|
||
}
|
||
|
||
if (!InitWcmApInfo(&apInfo, apClass)) {
|
||
mprintf("Invalid AP Class....");
|
||
OS_TPrintf("Invalid AP Class....");
|
||
return NC_ERROR_INVALID_AP_CLASS;
|
||
}
|
||
|
||
timeout_counter = 0;
|
||
while (1) {
|
||
wcm_phase = WCM_GetPhase();
|
||
if( wcm_phase == WCM_PHASE_NULL) {
|
||
break;
|
||
}
|
||
timeout_counter++;
|
||
if( timeout_counter > (60 * 1000 / 100) ) {
|
||
mprintf("%s -timeout\n",__FUNCTION__);
|
||
return NC_ERROR_TIMEOUT;
|
||
}
|
||
OS_Sleep(100);
|
||
|
||
}
|
||
|
||
InitWcmControlByApInfoEx(&apInfo, g_deviceId);
|
||
|
||
OS_TPrintf("LINK UP....\n");
|
||
mprintf("-LINK UP");
|
||
|
||
timeout_counter = 0;
|
||
|
||
|
||
while ( 1 ) {
|
||
wcm_phase = WCM_GetPhase();
|
||
if( wcm_phase == WCM_PHASE_DCF ) {
|
||
break;
|
||
}
|
||
#if 0
|
||
#define WCM_PHASE_NULL 0 // <20>‰Šú‰»‘O
|
||
#define WCM_PHASE_WAIT 1 // <20>‰Šú‰»’¼Œã‚Ì<E2809A>ó‘Ô( —v‹<76>‘Ò‚¿ )
|
||
#define WCM_PHASE_WAIT_TO_IDLE 2 // <20>‰Šú‰»’¼Œã‚Ì<E2809A>ó‘Ô ‚©‚ç –³<E28093>ü‹@”\‚Ì‹N“®ƒV<C692>[ƒPƒ“ƒX’†
|
||
#define WCM_PHASE_IDLE 3 // –³<E28093>ü‹@”\ƒAƒCƒhƒ‹<C692>ó‘Ô
|
||
#define WCM_PHASE_IDLE_TO_WAIT 4 // ƒAƒCƒhƒ‹<C692>ó‘Ô ‚©‚ç –³<E28093>ü‹@”\‚Ì’âŽ~ƒV<C692>[ƒPƒ“ƒX’†
|
||
#define WCM_PHASE_IDLE_TO_SEARCH 5 // ƒAƒCƒhƒ‹<C692>ó‘Ô ‚©‚ç AP Ž©“®’T<E28099>õ<EFBFBD>ó‘Ԃւ̈Ú<CB86>sƒV<C692>[ƒPƒ“ƒX’†
|
||
#define WCM_PHASE_SEARCH 6 // AP Ž©“®’T<E28099>õ<EFBFBD>ó‘Ô
|
||
#define WCM_PHASE_SEARCH_TO_IDLE 7 // AP Ž©“®’T<E28099>õ<EFBFBD>ó‘Ô ‚©‚ç ƒAƒCƒhƒ‹<C692>ó‘Ԃւ̈Ú<CB86>sƒV<C692>[ƒPƒ“ƒX’†
|
||
#define WCM_PHASE_IDLE_TO_DCF 8 // ƒAƒCƒhƒ‹<C692>ó‘Ô ‚©‚ç AP ‚Ö‚Ì–³<E28093>ü<EFBFBD>Ú‘±ƒV<C692>[ƒPƒ“ƒX’†
|
||
#define WCM_PHASE_DCF 9 // AP ‚Æ–³<E28093>ü<EFBFBD>Ú‘±‚³‚ꂽ DCF ’Ê<E28099>M‰Â”\<5C>ó‘Ô
|
||
#define WCM_PHASE_DCF_TO_IDLE 10 // DCF ’Ê<E28099>M<EFBFBD>ó‘Ô ‚©‚ç –³<E28093>ü<EFBFBD>Ú‘±‚ð<E2809A>Ø’f‚·‚éƒV<C692>[ƒPƒ“ƒX’†
|
||
#define WCM_PHASE_FATAL_ERROR 11 // •œ‹Œ•s‰Â”\‚ȃGƒ‰<C692>[‚ª”<E2809D>¶‚µ<E2809A>A‘S‚Ä‚Ì<E2809A>ˆ—<CB86>‚ªŽó‚¯•t‚¯‚ç‚ê‚È‚¢<E2809A>ó‘Ô
|
||
#define WCM_PHASE_IRREGULAR 12 // <20>ó‘Ô‘JˆÚƒV<C692>[ƒPƒ“ƒX‚Ì“r’†‚Å–â‘肪”<E2809D>¶‚µ‚½<E2809A>ó‘Ô
|
||
#define WCM_PHASE_TERMINATING 13 // WCM ƒ‰ƒCƒuƒ‰ƒŠ‚Ì‹<E280B9>§’âŽ~ƒV<C692>[ƒPƒ“ƒX’†
|
||
#endif
|
||
|
||
#define TIMEOUT_SEC 60
|
||
switch( counter ) {
|
||
case 0:
|
||
mprintf("\r-LINK UP. %02d/%02d",sec,TIMEOUT_SEC);
|
||
if( timeout_counter > (TIMEOUT_SEC * 1000 / 200) ) {
|
||
goto error_ret;
|
||
}
|
||
break;
|
||
case 1:
|
||
mprintf("\r-LINK UP.. %02d/%02d",sec,TIMEOUT_SEC);
|
||
if( timeout_counter > (TIMEOUT_SEC * 1000 / 200) ) {
|
||
goto error_ret;
|
||
}
|
||
break;
|
||
case 2:
|
||
mprintf("\r-LINK UP... %02d/%02d",sec,TIMEOUT_SEC);
|
||
if( timeout_counter > (TIMEOUT_SEC * 1000 / 200) ) {
|
||
goto error_ret;
|
||
}
|
||
break;
|
||
case 3:
|
||
mprintf("\r-LINK UP.... %02d/%02d",sec,TIMEOUT_SEC);
|
||
if( timeout_counter > (TIMEOUT_SEC * 1000 / 200) ) {
|
||
goto error_ret;
|
||
}
|
||
break;
|
||
case 5:
|
||
mprintf("\r-LINK UP..... %02d/%02d",sec,TIMEOUT_SEC);
|
||
if( timeout_counter > (TIMEOUT_SEC * 1000 / 200) ) {
|
||
goto error_ret;
|
||
}
|
||
break;
|
||
case 6:
|
||
mprintf("\r-LINK UP...... %02d/%02d",sec,TIMEOUT_SEC);
|
||
counter = -1;
|
||
if( timeout_counter > (TIMEOUT_SEC * 1000 / 200) ) {
|
||
goto error_ret;
|
||
}
|
||
break;
|
||
}
|
||
|
||
timeout_counter++;
|
||
|
||
sec = timeout_counter*200/1000;
|
||
|
||
OS_Sleep(200);
|
||
counter++;
|
||
}
|
||
|
||
m_set_palette(tc[0], M_TEXT_COLOR_GREEN );
|
||
mprintf(" OK.\n");
|
||
m_set_palette(tc[0], M_TEXT_COLOR_WHITE );
|
||
|
||
|
||
return ncStartWiFi();
|
||
|
||
error_ret:
|
||
m_set_palette(tc[0], M_TEXT_COLOR_RED );
|
||
mprintf(" NG.\n");
|
||
m_set_palette(tc[0], M_TEXT_COLOR_WHITE );
|
||
return NC_ERROR_TIMEOUT;
|
||
|
||
}
|
||
|
||
void NcFinish()
|
||
{
|
||
|
||
ncFinishWiFi();
|
||
}
|
||
|
||
void NcSetDevice(u8 deviceId)
|
||
{
|
||
g_deviceId = deviceId;
|
||
}
|
||
|
||
SDK_WEAK_SYMBOL void* NcAlloc(u32 name, s32 size)
|
||
{
|
||
#pragma unused(name)
|
||
OSIntrMode enable = OS_DisableInterrupts();
|
||
void* ptr = OS_Alloc((u32) size);
|
||
(void)OS_RestoreInterrupts(enable);
|
||
return ptr;
|
||
}
|
||
|
||
SDK_WEAK_SYMBOL void NcFree(u32 name, void* ptr, s32 size)
|
||
{
|
||
#pragma unused(name, size)
|
||
OSIntrMode enable = OS_DisableInterrupts();
|
||
OS_Free(ptr);
|
||
(void)OS_RestoreInterrupts(enable);
|
||
return;
|
||
}
|
||
|
||
/*---------------------------------------------------------------------------*
|
||
ƒq<C692>[ƒvŠÖ˜A
|
||
*---------------------------------------------------------------------------*/
|
||
|
||
// MainRAM ƒAƒŠ<C692>[ƒi‚ɑ΂µ‚Ä ƒ<>ƒ‚ƒŠŠ„‚è“–‚ăVƒXƒeƒ€<C692>‰Šú‰»
|
||
static void Heap_Setup(void)
|
||
{
|
||
void* nstart;
|
||
OSHeapHandle handle;
|
||
|
||
nstart = OS_InitAlloc(OS_ARENA_MAIN, OS_GetMainArenaLo(), OS_GetMainArenaHi(), 1);
|
||
OS_SetMainArenaLo(nstart);
|
||
handle = OS_CreateHeap(OS_ARENA_MAIN, OS_GetMainArenaLo(), OS_GetMainArenaHi());
|
||
(void)OS_SetCurrentHeap(OS_ARENA_MAIN, handle);
|
||
}
|
||
|
||
|
||
#ifdef SDK_TWL
|
||
static void* myAlloc_SOCL(u32 size)
|
||
{
|
||
s32 msize = (s32) (size + sizeof(s32));
|
||
s32* m = NcAlloc(0U, msize);
|
||
|
||
// ŒÄ‚Ñ<E2809A>o‚µ‚É•K—v‚ȃpƒ‰ƒ<E280B0><C692>[ƒ^‚ð—̈æ‚Ì<E2809A>擪‚ɉB‚µ‚Ä‚¨‚
|
||
if (m)
|
||
{
|
||
m[0] = (s32) msize;
|
||
m++;
|
||
}
|
||
|
||
return (void*)m;
|
||
}
|
||
|
||
static void myFree_SOCL(void* ptr)
|
||
{
|
||
s32* m = (s32*)ptr;
|
||
|
||
// ŒÄ‚Ñ<E2809A>o‚µ‚É•K—v‚ȃpƒ‰ƒ<E280B0><C692>[ƒ^‚ð—̈æ‚Ì<E2809A>擪‚©‚çŽæ‚è<E2809A>o‚·
|
||
if (m)
|
||
{
|
||
m--;
|
||
NcFree(0U, (void*)m, m[0]);
|
||
}
|
||
}
|
||
#endif // SDK_TWL
|