Renesas GR PEACH Contest 2017
Dependencies: GR-PEACH_video GraphicsFramework HttpServer_snapshot_mbed-os LWIPBP3595Interface_STA_for_mbed-os R_BSP RomRamBlockDevice mbed-rpc
main.cpp
- Committer:
- fxanhkhoa
- Date:
- 2017-09-30
- Revision:
- 0:1bccf2cddb03
File content as of revision 0:1bccf2cddb03:
#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)); }