void wk_gateKeeper(DS::SocketHandle sockp)
{
GateKeeper_Private client;
client.m_crypt = 0;
s_clientMutex.lock();
client.m_sock = sockp;
s_clients.push_back(&client);
s_clientMutex.unlock();
try {
gate_init(client);
for ( ;; ) {
uint16_t msgId = DS::CryptRecvValue<uint16_t>(client.m_sock, client.m_crypt);
switch (msgId) {
case e_CliToGateKeeper_PingRequest:
cb_ping(client);
break;
case e_CliToGateKeeper_FileServIpAddressRequest:
cb_fileServIpAddress(client);
break;
case e_CliToGateKeeper_AuthServIpAddressRequest:
cb_authServIpAddress(client);
break;
default:
/* Invalid message */
fprintf(stderr, "[GateKeeper] Got invalid message ID %d from %s\n",
msgId, DS::SockIpAddress(client.m_sock).c_str());
DS::CloseSock(client.m_sock);
throw DS::SockHup();
}
}
} catch (const DS::SockHup&) {
// Socket closed...
} catch (const std::exception& ex) {
fprintf(stderr, "[GateKeeper] Error processing client message from %s: %s\n",
DS::SockIpAddress(sockp).c_str(), ex.what());
}
s_clientMutex.lock();
auto client_iter = s_clients.begin();
while (client_iter != s_clients.end()) {
if (*client_iter == &client)
client_iter = s_clients.erase(client_iter);
else
++client_iter;
}
s_clientMutex.unlock();
DS::CryptStateFree(client.m_crypt);
DS::FreeSock(client.m_sock);
}
void freq_main(void)
{
cli();
counter_init();
gate_init();
stop();
reset();
ff_clr();
key_init();
setup_timers();
setup_interrupts();
adc_init();
sti();
/*clear counter*/
TCNT2= 0;
TCNT0= 0;
TCNT1= 0xFF00;
T0_ovc = T1_ovc =0;
start();
//fast clear screen...
post_display(filter());//really result
while(1) {
key_process();
keep_live();
mode = read_adc_mode();
update_lcd_status();
if(is_stop()&&soft_stop){
calc_freq();
post_display(filter());//really result
c_live() ; //mark succeufull ..
if(loop>=(ST)){ //never clear
reset();
}
loop=0;
start();
}
}
}
/*
* Initialize the system to handle hardware interrupts properly.
*/
void
base_irq_init()
{
//assert((get_eflags() & EFL_IF) == 0);
/* Initialize the IDT vectors used for hardware interrupts */
gate_init(base_idt, base_irq_inittab, KERNEL_CS);
/* Program the PIC to our preferred location */
pic_init(BASE_IRQ_MASTER_BASE, BASE_IRQ_SLAVE_BASE);
irq_master_base = BASE_IRQ_MASTER_BASE;
irq_slave_base = BASE_IRQ_SLAVE_BASE;
/* Disable all the PIC's IRQ lines */
pic_disable_all();
}
void
sx_gate (u8 line)
{
u16 i;
if (button.flag.down)
{
display_symbol (LCD_ICON_BEEPER1, SEG_ON);
open_radio();
gate_init();
for(i=0;i<50;i++) {
GATE_Transmit(open, GATE_SETTING_PKTLEN);
Timer0_A4_Delay(CONV_MS_TO_TICKS(11));
}
close_radio();
display_symbol (LCD_ICON_BEEPER1, SEG_OFF);
}
else
{
}
}
int main (int argc, char**argv)
{
int ret = 0;
int heartbeat_usec = 50000; //20Hz is ok by default
uint64_t last_beat = 0;
Log_info ("cloudvpn starting");
Log (0, "You are using CloudVPN, which is Free software.");
Log (0, "For more information please see the GNU GPL license,");
Log (0, "which you should have received along with this program.");
setup_sighandler (kill_cloudvpn);
/*
* initialization
*/
if (!config_parse (argc, argv) ) {
Log_error ("failed to parse config, terminating.");
ret = 1;
goto failed_config;
}
if (!config_get_int ("heartbeat", heartbeat_usec) )
heartbeat_usec = 50000;
Log_info ("heartbeat is set to %d usec", heartbeat_usec);
timestamp_update(); //get initial timestamp
status_init();
route_init();
squeue_init();
network_init();
if (poll_init() ) {
Log_fatal ("poll initialization failed");
ret = 2;
goto failed_poll;
}
if (do_memlock() ) {
Log_fatal ("locking process to memory failed");
ret = 3;
goto failed_poll;
}
if (comm_load() ) {
Log_fatal ("failed to load comm data");
ret = 4;
goto failed_poll;
}
if (comm_init() ) {
Log_fatal ("communication initialization failed");
ret = 5;
goto failed_comm;
}
if (gate_init() ) {
Log_fatal ("gate initialization failed");
ret = 6;
goto failed_gate;
}
if (do_chroot() ) {
Log_fatal ("chrooting failed");
ret = 7;
goto failed_sec;
}
if (do_switch_user() ) {
Log_fatal ("user switch failed");
ret = 8;
goto failed_sec;
}
/*
* main loop
*/
Log_info ("initialization complete, entering main loop");
last_beat = 0; //update immediately.
while (!g_terminate) {
timestamp_update();
if ( (timestamp() - last_beat)
< (unsigned int) heartbeat_usec) {
//poll more stuff
poll_wait_for_event (heartbeat_usec
- timestamp()
+ last_beat);
//send the results
comm_flush_data();
gate_flush_data();
continue;
}
last_beat = timestamp();
gate_periodic_update();
comm_periodic_update();
route_periodic_update();
status_try_export();
}
/*
* deinitialization
*/
Log_info ("shutting down");
failed_sec:
gate_shutdown();
failed_gate:
comm_shutdown();
failed_comm:
if (poll_deinit() )
Log_warn ("poll_deinit somehow failed!");
failed_poll:
failed_config:
if (!ret) Log_info ("cloudvpn exiting gracefully");
else Log_error ("cloudvpn exiting with code %d", ret);
return ret;
}
int do_bootm (cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
{
ulong iflag;
ulong load_end = 0;
int ret = 0;
boot_os_fn *boot_fn;
AML_LOG_INIT("cmd_bootm");
AML_LOG_TE("cmd_bootm");
#ifdef TEST_UBOOT_BOOT_SPEND_TIME
bootm_start_time = get_utimer(0);
#endif
#ifdef CONFIG_NEEDS_MANUAL_RELOC
static int relocated = 0;
/* relocate boot function table */
if (!relocated) {
int i;
for (i = 0; i < ARRAY_SIZE(boot_os); i++)
if (boot_os[i] != NULL)
boot_os[i] += gd->reloc_off;
relocated = 1;
}
#endif
AML_LOG_TE("cmd_bootm");
#ifdef CONFIG_RESET_TO_SYSTEM
struct aml_pmu_driver *pmu_driver = NULL;
pmu_driver = aml_pmu_get_driver();
if (pmu_driver && pmu_driver->pmu_reset_flag_operation) {
pmu_driver->pmu_reset_flag_operation(RESET_FLAG_SET);
}
#endif
AML_LOG_TE("cmd_bootm");
#ifdef CONFIG_M6_SECU_BOOT
#ifdef CONFIG_MESON_TRUSTZONE
extern int meson_trustzone_boot_check(unsigned char *addr);
ret = meson_trustzone_boot_check((unsigned char*)load_addr);
#else
extern int aml_decrypt_kernel_image(void* kernel_image_address);
ret = aml_decrypt_kernel_image((void*)load_addr);
#endif
if(ret != 0)
{
printf("Error! Illegal kernel image, please check!\n");
return ret;
}
#endif //CONFIG_M6_SECU_BOOT
AML_LOG_TE("cmd_bootm");
#ifdef CONFIG_AML_SECU_BOOT_V2
#ifdef CONFIG_MESON_TRUSTZONE
extern int meson_trustzone_boot_check(unsigned char *addr);
if(!g_nIMGReadFlag)
ret = meson_trustzone_boot_check(aml_get_kernel_crypto_addr(argc < 2 ? NULL : argv[1]));
#else
extern int aml_sec_boot_check(unsigned char *pSRC);
if(!g_nIMGReadFlag)
ret = aml_sec_boot_check(aml_get_kernel_crypto_addr(argc < 2 ? NULL : argv[1]));
#endif
if(0 != ret)
return ret;
#endif //CONFIG_AML_SECU_BOOT_V2
AML_LOG_TE("cmd_bootm");
#ifdef CONFIG_AML_GATE_INIT
extern void gate_init(void);
gate_init();
#endif
/* determine if we have a sub command */
if (argc > 1) {
char *endp;
simple_strtoul(argv[1], &endp, 16);
/* endp pointing to NULL means that argv[1] was just a
* valid number, pass it along to the normal bootm processing
*
* If endp is ':' or '#' assume a FIT identifier so pass
* along for normal processing.
*
* Right now we assume the first arg should never be '-'
*/
if ((*endp != 0) && (*endp != ':') && (*endp != '#'))
return do_bootm_subcommand(cmdtp, flag, argc, argv);
}
AML_LOG_TE("cmd_bootm");
if (bootm_start(cmdtp, flag, argc, argv))
return 1;
AML_LOG_TE("cmd_bootm");
/*
* We have reached the point of no return: we are going to
* overwrite all exception vector code, so we cannot easily
* recover from any failures any more...
*/
iflag = disable_interrupts();
#if defined(CONFIG_CMD_USB)
/*
* turn off USB to prevent the host controller from writing to the
* SDRAM while Linux is booting. This could happen (at least for OHCI
* controller), because the HCCA (Host Controller Communication Area)
* lies within the SDRAM and the host controller writes continously to
* this area (as busmaster!). The HccaFrameNumber is for example
* updated every 1 ms within the HCCA structure in SDRAM! For more
* details see the OpenHCI specification.
*/
usb_stop();
#endif
AML_LOG_TE("cmd_bootm");
ret = bootm_load_os(images.os, &load_end, 1);
AML_LOG_TE("cmd_bootm");
if (ret < 0) {
if (ret == BOOTM_ERR_RESET)
do_reset (cmdtp, flag, argc, argv);
if (ret == BOOTM_ERR_OVERLAP) {
if (images.legacy_hdr_valid) {
if (image_get_type (&images.legacy_hdr_os_copy) == IH_TYPE_MULTI)
puts ("WARNING: legacy format multi component "
"image overwritten\n");
} else {
puts ("ERROR: new format image overwritten - "
"must RESET the board to recover\n");
show_boot_progress (-113);
do_reset (cmdtp, flag, argc, argv);
}
}
if (ret == BOOTM_ERR_UNIMPLEMENTED) {
if (iflag)
enable_interrupts();
show_boot_progress (-7);
return 1;
}
}
AML_LOG_TE("cmd_bootm");
lmb_reserve(&images.lmb, images.os.load, (load_end - images.os.load));
AML_LOG_TE("cmd_bootm");
if (images.os.type == IH_TYPE_STANDALONE) {
if (iflag)
enable_interrupts();
/* This may return when 'autostart' is 'no' */
bootm_start_standalone(iflag, argc, argv);
return 0;
}
show_boot_progress (8);
#if defined(CONFIG_SILENT_CONSOLE) && \
(defined(CONFIG_SILENT_CONSOLE_LINUX_QUIET) || defined(CONFIG_DEPRECATED_SILENT_LINUX_CONSOLE))
if (images.os.os == IH_OS_LINUX)
fixup_silent_linux();
#endif
AML_LOG_TE("cmd_bootm");
#ifdef CONFIG_AUTO_SET_BOOTARGS_MEM
mem_size_arg_process();
#endif
boot_fn = boot_os[images.os.os];
if (boot_fn == NULL) {
if (iflag)
enable_interrupts();
printf ("ERROR: booting os '%s' (%d) is not supported\n",
genimg_get_os_name(images.os.os), images.os.os);
show_boot_progress (-8);
return 1;
}
AML_LOG_TE("cmd_bootm");
arch_preboot_os();
#ifdef TEST_UBOOT_BOOT_SPEND_TIME
{ int boot_kernel_start;
boot_kernel_start = get_utimer(0);
printf("bootm start to prepare boot kernel time:%dus\n",boot_kernel_start-bootm_start_time);
printf("from main_loop start to kernel decompress finished time:%dus\n",boot_kernel_start-main_loop_start);
}
#endif
ulong temp_img_addr;
AML_LOG_TE("cmd_bootm");
/* use fprintf to always show this print even if console is silenced with GD_FLG_SILENT */
fprintf(stderr, "uboot time: %d us.\n", get_utimer(0));
boot_fn(0, argc, argv, &images);
show_boot_progress (-9);
#ifdef DEBUG
puts ("\n## Control returned to monitor - resetting...\n");
#endif
do_reset (cmdtp, flag, argc, argv);
return 1;
}
