Khoa Bui Anh
Renesas GR PEACH Contest 2017
Dependencies: GR-PEACH_video GraphicsFramework HttpServer_snapshot_mbed-os LWIPBP3595Interface_STA_for_mbed-os R_BSP RomRamBlockDevice mbed-rpc
Diff: main.cpp
- Revision:
- 0:1bccf2cddb03
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp Sat Sep 30 08:37:08 2017 +0000
@@ -0,0 +1,736 @@
+#include "mbed.h"
+#include "DisplayBace.h"
+#include "rtos.h"
+#include "JPEG_Converter.h"
+#include "HTTPServer.h"
+#include "mbed_rpc.h"
+#include "FATFileSystem.h"
+#include "RomRamBlockDevice.h"
+#include "file_table.h" //Binary data of web pages
+#include "i2c_setting.h"
+#include "Thread.h"
+#include "string.h"
+#include <stdlib.h>
+#include <math.h>
+
+/* Define Value **********************************************/
+#define MAX_DAMGE 25
+#define MAX_HP 100
+#define stop_pos 21
+#define pass_pos 8
+
+#define Encrypt_mode 1
+
+/* Peripheral Import *****************************************/
+Serial Serial_Com(D9,D8); // USART through Pin D0, D1
+Serial pc(USBTX, USBRX);
+
+/* Variables Import ******************************************/
+char buffer[50] ="";
+int pos = 0;
+int CurrentID; // ID of Sent Wearable device
+uint8_t PercentageDamge; // Damge deal
+char Amount; // Amount of RSSI found (just found wearble device)
+int *ID = new int[3];
+int *RSSI = new int[3];
+float hp[2] = {MAX_HP, MAX_HP};
+char mode = 0;
+
+/* Function Define *******************************************/
+void Encrypt(char []);
+void calculate();
+float damge_real(int, int);
+
+void callback(){
+ //Serial_Com.scanf("%s", &buffer);
+ buffer[pos] = Serial_Com.getc();
+ pos ++;
+ pc.putc(buffer[pos - 1]);
+ if (pos == 30) pos = 0;
+ if ((buffer[pos - 1] == '\n'))
+ {
+ if ((buffer[0] == 'C') &&
+ (buffer[1] == 'U') &&
+ (buffer[2] == '+') &&
+ (buffer[3] == 'R') &&
+ (buffer[4] == 'E') &&
+ (buffer[5] == 'C') &&
+ (buffer[6] == 'V') &&
+ (buffer[7] == '+'))
+ {
+ //pc.printf("got recv\n");
+ mode = Encrypt_mode;
+ Encrypt(buffer);
+ }
+ pos = 0;
+ strcpy(buffer,"");
+ }
+}
+
+#define VIDEO_CVBS (0) /* Analog Video Signal */
+#define VIDEO_CMOS_CAMERA (1) /* Digital Video Signal */
+#define VIDEO_YCBCR422 (0)
+#define VIDEO_RGB888 (1)
+#define VIDEO_RGB565 (2)
+
+/**** User Selection *********/
+/** Network setting **/
+#define USE_DHCP (1) /* Select 0(static configuration) or 1(use DHCP) */
+#if (USE_DHCP == 0)
+ #define IP_ADDRESS ("192.168.0.2") /* IP address */
+ #define SUBNET_MASK ("255.255.255.0") /* Subnet mask */
+ #define DEFAULT_GATEWAY ("192.168.0.3") /* Default gateway */
+#endif
+#define NETWORK_TYPE (0) /* Select 0(EthernetInterface) or 1(GR_PEACH_WlanBP3595) */
+#if (NETWORK_TYPE == 1)
+ #define SCAN_NETWORK (1) /* Select 0(Use WLAN_SSID, WLAN_PSK, WLAN_SECURITY) or 1(To select a network using the terminal.) */
+ #define WLAN_SSID ("SSIDofYourAP") /* SSID */
+ #define WLAN_PSK ("PSKofYourAP") /* PSK(Pre-Shared Key) */
+ #define WLAN_SECURITY NSAPI_SECURITY_WPA_WPA2 /* NSAPI_SECURITY_NONE, NSAPI_SECURITY_WEP, NSAPI_SECURITY_WPA, NSAPI_SECURITY_WPA2 or NSAPI_SECURITY_WPA_WPA2 */
+#endif
+/** Camera setting **/
+#define VIDEO_INPUT_METHOD (VIDEO_CMOS_CAMERA) /* Select VIDEO_CVBS or VIDEO_CMOS_CAMERA */
+#define VIDEO_INPUT_FORMAT (VIDEO_YCBCR422) /* Select VIDEO_YCBCR422 or VIDEO_RGB888 or VIDEO_RGB565 */
+#define USE_VIDEO_CH (0) /* Select 0 or 1 If selecting VIDEO_CMOS_CAMERA, should be 0.) */
+#define VIDEO_PAL (0) /* Select 0(NTSC) or 1(PAL) If selecting VIDEO_CVBS, this parameter is not referenced.) */
+/*****************************/
+
+#if USE_VIDEO_CH == (0)
+#define VIDEO_INPUT_CH (DisplayBase::VIDEO_INPUT_CHANNEL_0)
+#define VIDEO_INT_TYPE (DisplayBase::INT_TYPE_S0_VFIELD)
+#else
+#define VIDEO_INPUT_CH (DisplayBase::VIDEO_INPUT_CHANNEL_1)
+#define VIDEO_INT_TYPE (DisplayBase::INT_TYPE_S1_VFIELD)
+#endif
+
+#if ( VIDEO_INPUT_FORMAT == VIDEO_YCBCR422 || VIDEO_INPUT_FORMAT == VIDEO_RGB565 )
+#define DATA_SIZE_PER_PIC (2u)
+#else
+#define DATA_SIZE_PER_PIC (4u)
+#endif
+
+/*! Frame buffer stride: Frame buffer stride should be set to a multiple of 32 or 128
+ in accordance with the frame buffer burst transfer mode. */
+#define PIXEL_HW (320u) /* QVGA */
+#define PIXEL_VW (240u) /* QVGA */
+
+#define VIDEO_BUFFER_STRIDE (((PIXEL_HW * DATA_SIZE_PER_PIC) + 31u) & ~31u)
+#define VIDEO_BUFFER_HEIGHT (PIXEL_VW)
+
+#if (NETWORK_TYPE == 0)
+ #include "EthernetInterface.h"
+ EthernetInterface network;
+#elif (NETWORK_TYPE == 1)
+ #include "LWIPBP3595Interface.h"
+ LWIPBP3595Interface network;
+ DigitalOut usb1en(P3_8);
+#else
+ #error NETWORK_TYPE error
+#endif /* NETWORK_TYPE */
+FATFileSystem fs("storage");
+RomRamBlockDevice romram_bd(512000, 512);
+
+
+#if defined(__ICCARM__)
+#pragma data_alignment=16
+static uint8_t FrameBuffer_Video[VIDEO_BUFFER_STRIDE * VIDEO_BUFFER_HEIGHT]@ ".mirrorram"; //16 bytes aligned!;
+#pragma data_alignment=4
+#else
+static uint8_t FrameBuffer_Video[VIDEO_BUFFER_STRIDE * VIDEO_BUFFER_HEIGHT]__attribute((section("NC_BSS"),aligned(16))); //16 bytes aligned!;
+#endif
+static volatile int32_t vsync_count = 0;
+#if VIDEO_INPUT_METHOD == VIDEO_CVBS
+static volatile int32_t vfield_count = 1;
+#endif
+#if defined(__ICCARM__)
+#pragma data_alignment=8
+static uint8_t JpegBuffer[2][1024 * 50]@ ".mirrorram"; //8 bytes aligned!;
+#pragma data_alignment=4
+#else
+static uint8_t JpegBuffer[2][1024 * 50]__attribute((section("NC_BSS"),aligned(8))); //8 bytes aligned!;
+#endif
+static size_t jcu_encode_size[2];
+static int image_change = 0;
+JPEG_Converter Jcu;
+static int jcu_buf_index_write = 0;
+static int jcu_buf_index_write_done = 0;
+static int jcu_buf_index_read = 0;
+static int jcu_encoding = 0;
+static char i2c_setting_str_buf[I2C_SETTING_STR_BUF_SIZE];
+
+static void JcuEncodeCallBackFunc(JPEG_Converter::jpeg_conv_error_t err_code) {
+ jcu_buf_index_write_done = jcu_buf_index_write;
+ image_change = 1;
+ jcu_encoding = 0;
+}
+
+static void IntCallbackFunc_Vfield(DisplayBase::int_type_t int_type) {
+ //Interrupt callback function
+#if VIDEO_INPUT_METHOD == VIDEO_CVBS
+ if (vfield_count != 0) {
+ vfield_count = 0;
+ } else {
+ vfield_count = 1;
+#else
+ {
+#endif
+ JPEG_Converter::bitmap_buff_info_t bitmap_buff_info;
+ JPEG_Converter::encode_options_t encode_options;
+
+ bitmap_buff_info.width = PIXEL_HW;
+ bitmap_buff_info.height = PIXEL_VW;
+ bitmap_buff_info.format = JPEG_Converter::WR_RD_YCbCr422;
+ bitmap_buff_info.buffer_address = (void *)FrameBuffer_Video;
+
+ encode_options.encode_buff_size = sizeof(JpegBuffer[0]);
+ encode_options.p_EncodeCallBackFunc = &JcuEncodeCallBackFunc;
+
+ jcu_encoding = 1;
+ if (jcu_buf_index_read == jcu_buf_index_write) {
+ if (jcu_buf_index_write != 0) {
+ jcu_buf_index_write = 0;
+ } else {
+ jcu_buf_index_write = 1;
+ }
+ }
+ jcu_encode_size[jcu_buf_index_write] = 0;
+ if (Jcu.encode(&bitmap_buff_info, JpegBuffer[jcu_buf_index_write], &jcu_encode_size[jcu_buf_index_write], &encode_options) != JPEG_Converter::JPEG_CONV_OK) {
+ jcu_encode_size[jcu_buf_index_write] = 0;
+ jcu_encoding = 0;
+ }
+ }
+}
+
+static void IntCallbackFunc_Vsync(DisplayBase::int_type_t int_type) {
+ //Interrupt callback function for Vsync interruption
+ if (vsync_count > 0) {
+ vsync_count--;
+ }
+}
+
+static void WaitVsync(const int32_t wait_count) {
+ //Wait for the specified number of times Vsync occurs
+ vsync_count = wait_count;
+ while (vsync_count > 0) {
+ /* Do nothing */
+ }
+}
+
+static void camera_start(void) {
+ DisplayBase::graphics_error_t error;
+
+#if VIDEO_INPUT_METHOD == VIDEO_CMOS_CAMERA
+ DisplayBase::video_ext_in_config_t ext_in_config;
+ PinName cmos_camera_pin[11] = {
+ /* data pin */
+ P2_7, P2_6, P2_5, P2_4, P2_3, P2_2, P2_1, P2_0,
+ /* control pin */
+ P10_0, /* DV0_CLK */
+ P1_0, /* DV0_Vsync */
+ P1_1 /* DV0_Hsync */
+ };
+#endif
+
+ /* Create DisplayBase object */
+ DisplayBase Display;
+
+ /* Graphics initialization process */
+ error = Display.Graphics_init(NULL);
+ if (error != DisplayBase::GRAPHICS_OK) {
+ printf("Line %d, error %d\n", __LINE__, error);
+ while (1);
+ }
+
+#if VIDEO_INPUT_METHOD == VIDEO_CVBS
+ error = Display.Graphics_Video_init( DisplayBase::INPUT_SEL_VDEC, NULL);
+ if( error != DisplayBase::GRAPHICS_OK ) {
+ printf("Line %d, error %d\n", __LINE__, error);
+ while(1);
+ }
+
+#elif VIDEO_INPUT_METHOD == VIDEO_CMOS_CAMERA
+ /* MT9V111 camera input config */
+ ext_in_config.inp_format = DisplayBase::VIDEO_EXTIN_FORMAT_BT601; /* BT601 8bit YCbCr format */
+ ext_in_config.inp_pxd_edge = DisplayBase::EDGE_RISING; /* Clock edge select for capturing data */
+ ext_in_config.inp_vs_edge = DisplayBase::EDGE_RISING; /* Clock edge select for capturing Vsync signals */
+ ext_in_config.inp_hs_edge = DisplayBase::EDGE_RISING; /* Clock edge select for capturing Hsync signals */
+ ext_in_config.inp_endian_on = DisplayBase::OFF; /* External input bit endian change on/off */
+ ext_in_config.inp_swap_on = DisplayBase::OFF; /* External input B/R signal swap on/off */
+ ext_in_config.inp_vs_inv = DisplayBase::SIG_POL_NOT_INVERTED; /* External input DV_VSYNC inversion control */
+ ext_in_config.inp_hs_inv = DisplayBase::SIG_POL_INVERTED; /* External input DV_HSYNC inversion control */
+ ext_in_config.inp_f525_625 = DisplayBase::EXTIN_LINE_525; /* Number of lines for BT.656 external input */
+ ext_in_config.inp_h_pos = DisplayBase::EXTIN_H_POS_CRYCBY; /* Y/Cb/Y/Cr data string start timing to Hsync reference */
+ ext_in_config.cap_vs_pos = 6; /* Capture start position from Vsync */
+ ext_in_config.cap_hs_pos = 150; /* Capture start position form Hsync */
+ ext_in_config.cap_width = 640; /* Capture width */
+ ext_in_config.cap_height = 468u; /* Capture height Max 468[line]
+ Due to CMOS(MT9V111) output signal timing and VDC5 specification */
+ error = Display.Graphics_Video_init( DisplayBase::INPUT_SEL_EXT, &ext_in_config);
+ if( error != DisplayBase::GRAPHICS_OK ) {
+ printf("Line %d, error %d\n", __LINE__, error);
+ while(1);
+ }
+
+ /* MT9V111 camera input port setting */
+ error = Display.Graphics_Dvinput_Port_Init(cmos_camera_pin, 11);
+ if( error != DisplayBase::GRAPHICS_OK ) {
+ printf("Line %d, error %d\n", __LINE__, error);
+ while (1);
+ }
+#endif
+
+ /* Interrupt callback function setting (Vsync signal input to scaler 0) */
+ error = Display.Graphics_Irq_Handler_Set(DisplayBase::INT_TYPE_S0_VI_VSYNC, 0, IntCallbackFunc_Vsync);
+ if (error != DisplayBase::GRAPHICS_OK) {
+ printf("Line %d, error %d\n", __LINE__, error);
+ while (1);
+ }
+ /* Video capture setting (progressive form fixed) */
+ error = Display.Video_Write_Setting(
+ VIDEO_INPUT_CH,
+#if VIDEO_PAL == 0
+ DisplayBase::COL_SYS_NTSC_358,
+#else
+ DisplayBase::COL_SYS_PAL_443,
+#endif
+ FrameBuffer_Video,
+ VIDEO_BUFFER_STRIDE,
+#if VIDEO_INPUT_FORMAT == VIDEO_YCBCR422
+ DisplayBase::VIDEO_FORMAT_YCBCR422,
+ DisplayBase::WR_RD_WRSWA_NON,
+#elif VIDEO_INPUT_FORMAT == VIDEO_RGB565
+ DisplayBase::VIDEO_FORMAT_RGB565,
+ DisplayBase::WR_RD_WRSWA_32_16BIT,
+#else
+ DisplayBase::VIDEO_FORMAT_RGB888,
+ DisplayBase::WR_RD_WRSWA_32BIT,
+#endif
+ PIXEL_VW,
+ PIXEL_HW
+ );
+ if (error != DisplayBase::GRAPHICS_OK) {
+ printf("Line %d, error %d\n", __LINE__, error);
+ while (1);
+ }
+
+ /* Interrupt callback function setting (Field end signal for recording function in scaler 0) */
+ error = Display.Graphics_Irq_Handler_Set(VIDEO_INT_TYPE, 0, IntCallbackFunc_Vfield);
+ if (error != DisplayBase::GRAPHICS_OK) {
+ printf("Line %d, error %d\n", __LINE__, error);
+ while (1);
+ }
+
+ /* Video write process start */
+ error = Display.Video_Start (VIDEO_INPUT_CH);
+ if (error != DisplayBase::GRAPHICS_OK) {
+ printf("Line %d, error %d\n", __LINE__, error);
+ while (1);
+ }
+
+ /* Video write process stop */
+ error = Display.Video_Stop (VIDEO_INPUT_CH);
+ if (error != DisplayBase::GRAPHICS_OK) {
+ printf("Line %d, error %d\n", __LINE__, error);
+ while (1);
+ }
+
+ /* Video write process start */
+ error = Display.Video_Start (VIDEO_INPUT_CH);
+ if (error != DisplayBase::GRAPHICS_OK) {
+ printf("Line %d, error %d\n", __LINE__, error);
+ while (1);
+ }
+
+ /* Wait vsync to update resister */
+ WaitVsync(1);
+}
+
+static int snapshot_req(const char ** pp_data) {
+ int encode_size;
+
+ while ((jcu_encoding == 1) || (image_change == 0)) {
+ Thread::wait(1);
+ }
+ jcu_buf_index_read = jcu_buf_index_write_done;
+ image_change = 0;
+
+ *pp_data = (const char *)JpegBuffer[jcu_buf_index_read];
+ encode_size = (int)jcu_encode_size[jcu_buf_index_read];
+
+ return encode_size;
+}
+
+static void TerminalWrite(Arguments* arg, Reply* r) {
+ if ((arg != NULL) && (r != NULL)) {
+ for (int i = 0; i < arg->argc; i++) {
+ if (arg->argv[i] != NULL) {
+ printf("%s", arg->argv[i]);
+ }
+ }
+ printf("\n");
+ r->putData<const char*>("ok");
+ }
+}
+
+static void mount_romramfs(void) {
+ FILE * fp;
+
+ romram_bd.SetRomAddr(0x18000000, 0x1FFFFFFF);
+ fs.format(&romram_bd, 512);
+ fs.mount(&romram_bd);
+
+ //index.htm
+ fp = fopen("/storage/index.htm", "w");
+ fwrite(index_htm_tbl, sizeof(char), sizeof(index_htm_tbl), fp);
+ fclose(fp);
+
+ //camera.js
+ fp = fopen("/storage/camera.js", "w");
+ fwrite(camaera_js_tbl, sizeof(char), sizeof(camaera_js_tbl), fp);
+ fclose(fp);
+
+ //camera.htm
+ fp = fopen("/storage/camera.htm", "w");
+ fwrite(camera_htm_tbl, sizeof(char), sizeof(camera_htm_tbl), fp);
+ fclose(fp);
+
+ //mbedrpc.js
+ fp = fopen("/storage/mbedrpc.js", "w");
+ fwrite(mbedrpc_js_tbl, sizeof(char), sizeof(mbedrpc_js_tbl), fp);
+ fclose(fp);
+
+ //led.htm
+ fp = fopen("/storage/led.htm", "w");
+ fwrite(led_htm_tbl, sizeof(char), sizeof(led_htm_tbl), fp);
+ fclose(fp);
+
+ //i2c_set.htm
+ fp = fopen("/storage/i2c_set.htm", "w");
+ fwrite(i2c_set_htm_tbl, sizeof(char), sizeof(i2c_set_htm_tbl), fp);
+ fclose(fp);
+
+ //web_top.htm
+ fp = fopen("/storage/web_top.htm", "w");
+ fwrite(web_top_htm_tbl, sizeof(char), sizeof(web_top_htm_tbl), fp);
+ fclose(fp);
+
+ //menu.htm
+ fp = fopen("/storage/menu.htm", "w");
+ fwrite(menu_htm_tbl, sizeof(char), sizeof(menu_htm_tbl), fp);
+ fclose(fp);
+
+ //window.htm
+ fp = fopen("/storage/window.htm", "w");
+ fwrite(window_htm_tbl, sizeof(char), sizeof(window_htm_tbl), fp);
+ fclose(fp);
+
+ //show.js
+ fp = fopen("/storage/Show.js", "w");
+ fwrite(show_js_tbl, sizeof(char), sizeof(show_js_tbl), fp);
+ fclose(fp);
+}
+
+static void SetI2CfromWeb(Arguments* arg, Reply* r) {
+ int result = 0;
+
+ if (arg != NULL) {
+ if (arg->argc >= 2) {
+ if ((arg->argv[0] != NULL) && (arg->argv[1] != NULL)) {
+ sprintf(i2c_setting_str_buf, "%s,%s", arg->argv[0], arg->argv[1]);
+ result = 1;
+ }
+ } else if (arg->argc == 1) {
+ if (arg->argv[0] != NULL) {
+ sprintf(i2c_setting_str_buf, "%s", arg->argv[0]);
+ result = 1;
+ }
+ } else {
+ /* Do nothing */
+ }
+ /* command analysis and execute */
+ if (result != 0) {
+ if (i2c_setting_exe(i2c_setting_str_buf) != false) {
+ r->putData<const char*>(i2c_setting_str_buf);
+ }
+ }
+ }
+}
+
+#if (SCAN_NETWORK == 1)
+static const char *sec2str(nsapi_security_t sec) {
+ switch (sec) {
+ case NSAPI_SECURITY_NONE:
+ return "None";
+ case NSAPI_SECURITY_WEP:
+ return "WEP";
+ case NSAPI_SECURITY_WPA:
+ return "WPA";
+ case NSAPI_SECURITY_WPA2:
+ return "WPA2";
+ case NSAPI_SECURITY_WPA_WPA2:
+ return "WPA/WPA2";
+ case NSAPI_SECURITY_UNKNOWN:
+ default:
+ return "Unknown";
+ }
+}
+
+static bool scan_network(WiFiInterface *wifi) {
+ WiFiAccessPoint *ap;
+ bool ret = false;
+ int i;
+ int count = 8; /* Limit number of network arbitrary to 8 */
+
+ printf("Scan:\r\n");
+ ap = new WiFiAccessPoint[count];
+ count = wifi->scan(ap, count);
+ for (i = 0; i < count; i++) {
+ printf("No.%d Network: %s secured: %s BSSID: %hhX:%hhX:%hhX:%hhx:%hhx:%hhx RSSI: %hhd Ch: %hhd\r\n", i, ap[i].get_ssid(),
+ sec2str(ap[i].get_security()), ap[i].get_bssid()[0], ap[i].get_bssid()[1], ap[i].get_bssid()[2],
+ ap[i].get_bssid()[3], ap[i].get_bssid()[4], ap[i].get_bssid()[5], ap[i].get_rssi(), ap[i].get_channel());
+ }
+ printf("%d networks available.\r\n", count);
+
+ if (count > 0) {
+ char c;
+ char pass[64];
+ int select_no;
+ bool loop_break = false;;
+
+ printf("\nPlease enter the number of the network you want to connect.\r\n");
+ printf("Enter key:[0]-[%d], (If inputting the other key, it's scanned again.)\r\n", count - 1);
+ c = (uint8_t)pc.getc();
+ select_no = c - 0x30;
+ if ((select_no >= 0) && (select_no < count)) {
+ printf("[%s] is selected.\r\n", ap[select_no].get_ssid());
+ printf("Please enter the PSK.\r\n");
+ i = 0;
+ while (loop_break == false) {
+ c = (uint8_t)pc.getc();
+ switch (c) {
+ case 0x0D:
+ pass[i] = '\0';
+ pc.puts("\r\n");
+ loop_break = true;
+ break;
+ case 0x08:
+ if (i > 0) {
+ pc.puts("\b \b");
+ i--;
+ }
+ break;
+ case 0x0A:
+ break;
+ default:
+ if ((i + 1) < sizeof(pass)) {
+ pass[i] = c;
+ i++;
+ pc.putc(c);
+ }
+ break;
+ }
+ }
+ printf("connecting...\r\n");
+ wifi->set_credentials(ap[select_no].get_ssid(), pass, ap[select_no].get_security());
+ ret = true;
+ }
+ }
+
+ delete[] ap;
+
+ return ret;
+}
+#endif
+
+float Request = 80;
+RPCVariable<float> RPCRequest(&Request, "Request");
+Thread thread, thread_HTTP;
+
+void HTTP()
+{
+ HTTPServerStart(&network, 80);
+ while (true)
+ {
+ printf("HTTP thread\n");
+ Thread::wait(100);
+ }
+}
+
+void test()
+{
+ while (true)
+ {
+
+ //Request++;
+ //printf("abcd");
+ /*if (Request == 0)
+ {
+ printf("0");
+ Request = 1;
+ }
+ else if (Request == 1)
+ {
+ printf("1");
+ Request = 2;
+ }*/
+ if (mode == Encrypt_mode)
+ {
+ Encrypt(buffer);
+ mode = 0;
+ }
+ printf("thread test \n");
+ Thread::wait(100);
+ }
+}
+
+int main(void) {
+ pc.baud(115200);
+ Serial_Com.baud(115200);
+ //strcpy(buffer,"CU+RECV+#010000102-72\n");
+ Serial_Com.attach(&callback);
+ //pc.printf("go go \n");
+ //Serial_Com.printf("go go \n");
+ //Serial_Com.putc('a');
+ printf("********* PROGRAM START ***********\r\n");
+
+ /* Please enable this line when performing the setting from the Terminal side. */
+// Thread thread(SetI2CfromTerm, NULL, osPriorityBelowNormal, DEFAULT_STACK_SIZE);
+
+ mount_romramfs(); //RomRamFileSystem Mount
+ camera_start(); //Camera Start
+
+ RPC::add_rpc_class<RpcDigitalOut>();
+ RPC::construct<RpcDigitalOut, PinName, const char*>(LED1, "led1");
+ RPC::construct<RpcDigitalOut, PinName, const char*>(LED2, "led2");
+ RPC::construct<RpcDigitalOut, PinName, const char*>(LED3, "led3");
+
+ RPCFunction rpcFunc(TerminalWrite, "TerminalWrite");
+ RPCFunction rpcSetI2C(SetI2CfromWeb, "SetI2CfromWeb");
+
+#if (NETWORK_TYPE == 1)
+ //Audio Camera Shield USB1 enable for WlanBP3595
+ usb1en = 1; //Outputs high level
+ Thread::wait(5);
+ usb1en = 0; //Outputs low level
+ Thread::wait(5);
+#endif
+
+ printf("Network Setting up...\r\n");
+#if (USE_DHCP == 0)
+ network.set_dhcp(false);
+ if (network.set_network(IP_ADDRESS, SUBNET_MASK, DEFAULT_GATEWAY) != 0) { //for Static IP Address (IPAddress, NetMasks, Gateway)
+ printf("Network Set Network Error \r\n");
+ return -1;
+ }
+#endif
+#if (NETWORK_TYPE == 1)
+#if (SCAN_NETWORK == 1)
+ while (!scan_network(&network));
+#else
+ network.set_credentials(WLAN_SSID, WLAN_PSK, WLAN_SECURITY);
+#endif
+#endif
+ if (network.connect() != 0) {
+ printf("Network Connect Error \r\n");
+ return -1;
+ }
+ printf("MAC Address is %s\r\n", network.get_mac_address());
+ printf("IP Address is %s\r\n", network.get_ip_address());
+ printf("NetMask is %s\r\n", network.get_netmask());
+ printf("Gateway Address is %s\r\n", network.get_gateway());
+ printf("Network Setup OK\r\n");
+
+ thread.start(test);
+
+ SnapshotHandler::attach_req(&snapshot_req);
+ HTTPServerAddHandler<SnapshotHandler>("/camera"); //Camera
+ FSHandler::mount("/storage", "/");
+ HTTPServerAddHandler<FSHandler>("/");
+ HTTPServerAddHandler<RPCHandler>("/rpc");
+ printf("Network Setting up...\r\n");
+ HTTPServerStart(&network, 80);
+ thread_HTTP.start(HTTP);
+ printf("Network Setting up...\r\n");
+}
+
+void Encrypt(char s[])
+{
+ char *temp;
+ // Get Sent wearable device's ID
+ temp = new char[2];
+ strcpy(temp,"");
+ temp[0] = s[1 + pass_pos];
+ temp[1] = s[2 + pass_pos];
+ CurrentID = atoi(temp);
+ pc.printf("current id: %d \n", CurrentID);
+ delete temp;
+
+ // Get Damge deal in Percentage
+ temp = new char[3];
+ strcpy(temp,"");
+ temp[0] = s[3 + pass_pos];
+ temp[1] = s[4 + pass_pos];
+ temp[2] = s[5 + pass_pos];
+ PercentageDamge = atoi(temp);
+ pc.printf("percentage :%d \n", PercentageDamge);
+ delete temp;
+
+ // Read to amount, create new memory (ID, RSSI)
+ temp = new char[2];
+ strcpy(temp,"");
+ temp[0] = s[6 + pass_pos];
+ temp[1] = s[7 + pass_pos];
+ Amount = atoi(temp);
+ pc.printf("amount :%d \n", Amount);
+ delete temp;
+
+ //ID = new int[Amount]; // Create memory for ID
+ //RSSI = new int[Amount]; // Create memory for RSSI
+
+ // Read ID, RSSI with for loop based on Amount Read
+ for (int i=0; i < Amount; i++)
+ {
+ // Read ID
+ temp = new char[2];
+ strcpy(temp,"");
+ temp[0] = s[8 + (6*i) + pass_pos];
+ temp[1] = s[8 + (6*i) + 1 + pass_pos];
+ ID[i] = atoi(temp);
+ pc.printf("ID: %d \n", ID[i]);
+ delete temp;
+
+ //Read RSSI
+ temp = new char[3];
+ strcpy(temp,"");
+ temp[0] = s[10 + (6*i) + pass_pos];
+ temp[1] = s[10 + (6*i) +1 + pass_pos];
+ temp[2] = s[10 + (6*i) +2 + pass_pos];
+ //temp[3] = s[10 + (6*i) +3 + pass_pos];
+ RSSI[ID[i] - 1] = atoi(temp);
+ pc.printf("RSSI: %d \n", RSSI[ID[i] - 1]);
+ delete temp;
+ }
+ delete temp;
+ strcpy(buffer,"");
+
+ calculate();
+ // Delete memory (ID, RSSI)
+
+}
+
+void calculate()
+{
+ for (int i = 0; i < Amount; i++)
+ {
+ int temp = ID[i];
+ hp[temp - 1] -= damge_real(PercentageDamge, RSSI[temp - 1]);
+ pc.printf("damge: %f\n",damge_real(PercentageDamge, RSSI[temp - 1]));
+ pc.printf("ID:%d HP:%f\n", ID[i], hp[ID[i] - 1]);
+ Request = ID[i] * 100 + hp[ID[i] - 1];
+ }
+}
+
+float damge_real(int percentage, int RSSI)
+{
+ return ((float((MAX_DAMGE * percentage)) / 100) * (abs(float(RSSI))/100));
+}