Depot Pertamina
Program Kunci
Dependencies: BufferedSoftSerial Noritake iButton CRC16Modbus Displays Audio
Revision 0:0cd00ee4dd93, committed 2020-07-09
- Comitter:
- mauuuuul
- Date:
- Thu Jul 09 09:04:32 2020 +0000
- Commit message:
- Key Controller;
Changed in this revision
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/.gitignore Thu Jul 09 09:04:32 2020 +0000 @@ -0,0 +1,4 @@ +.build +.mbed +projectfiles +*.py*
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/Audio.lib Thu Jul 09 09:04:32 2020 +0000 @@ -0,0 +1,1 @@ +https://os.mbed.com/users/mauuuuul/code/Audio/#bd7a13e2ec12
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/BufferedSoftSerial.lib Thu Jul 09 09:04:32 2020 +0000 @@ -0,0 +1,1 @@ +https://os.mbed.com/users/Sissors/code/BufferedSoftSerial/#671a6724ce79
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/CRC16Modbus.lib Thu Jul 09 09:04:32 2020 +0000 @@ -0,0 +1,1 @@ +https://os.mbed.com/users/mauuuuul/code/CRC16Modbus/#ef7ff5eb7797
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/Displays.lib Thu Jul 09 09:04:32 2020 +0000 @@ -0,0 +1,1 @@ +https://os.mbed.com/users/mauuuuul/code/Displays/#19f104c32cb7
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/Noritake.lib Thu Jul 09 09:04:32 2020 +0000 @@ -0,0 +1,1 @@ +https://os.mbed.com/users/mauuuuul/code/Noritake/#2ffe7f6422a3
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/iButton.lib Thu Jul 09 09:04:32 2020 +0000 @@ -0,0 +1,1 @@ +https://os.mbed.com/users/mauuuuul/code/iButton/#1be414b74639
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp Thu Jul 09 09:04:32 2020 +0000
@@ -0,0 +1,1650 @@
+#include "mbed.h"
+#include "EthernetInterface.h"
+#include <string>
+#include <vector>
+#include "Audio.h"
+#include "iButton.h"
+#include <bitset>
+#include "CRC16Modbus.h"
+#include "BufferedSoftSerial.h"
+#include "Displays.h"
+#include <list>
+#include <algorithm>
+
+// Network interface
+TCPSocket socket;
+
+Thread thdFindConnection;
+Thread thd_Cek_Ibutton;
+Thread thd_RS485_Recv;
+Thread thd_Buzzer;
+Thread thd_LCD;
+
+MyAudio buzz(D7);
+Displays dsp(PTC8,PTC1);
+uint8_t LCD_Step = 0;
+uint8_t LCD_Step_4 = 0;
+
+#define IP "192.168.0.6"
+#define GATEWAY "192.168.0.1"
+#define MASK "255.255.255.0"
+
+char cmd_resets[] = "R00";
+char cek_con[] = "P";
+
+uint8_t Key_On_Process = 0;
+
+Serial dbg(USBTX,USBRX);
+BufferedSoftSerial dv(PTB19,PTB18);
+DigitalOut rede(PTC9,0);
+iButton ibutton(D4);
+
+bool tap = false;
+bool lasttap = false;
+
+uint8_t board_number;
+uint8_t baris;
+uint8_t kolom;
+uint8_t real_id;
+uint8_t real_blink_id_1 = 64;
+uint8_t real_blink_id_2 = 64;
+uint8_t real_blink_id_3 = 64;
+uint8_t real_blink_id_4 = 64;
+uint8_t real_blink_id_5 = 64;
+uint8_t blinking_now = 0;
+
+uint8_t ids;
+
+typedef uint8_t byte;
+//r0,r1,r2,r3,r4,r5,r6,r7
+byte Row_Board1_Last[8] = {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00};
+byte Row_Board2_Last[8] = {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00};
+byte Row_Board3_Last[8] = {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00};
+byte Row_Board4_Last[8] = {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00};
+byte Row_Board5_Last[8] = {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00};
+
+byte Row_Board1_Now[8] = {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00};
+byte Row_Board2_Now[8] = {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00};
+byte Row_Board3_Now[8] = {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00};
+byte Row_Board4_Now[8] = {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00};
+byte Row_Board5_Now[8] = {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00};
+
+byte Row_Board1_Predict[8] = {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00};
+byte Row_Board2_Predict[8] = {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00};
+byte Row_Board3_Predict[8] = {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00};
+byte Row_Board4_Predict[8] = {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00};
+byte Row_Board5_Predict[8] = {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00};
+
+uint8_t board_88[8][8]= {
+ {0,1,2,3,4,5,6,7},
+ {8,9,10,11,12,13,14,15},
+ {16,17,18,19,20,21,22,23},
+ {24,25,26,27,28,29,30,31},
+ {32,33,34,35,36,37,38,39},
+ {40,41,42,43,44,45,46,47},
+ {48,49,50,51,52,53,54,55},
+ {56,57,58,59,60,61,62,63}
+};
+
+string TCP_Cek_Data_Last_Sent;
+string TCP_Data_Last_Sent;
+string TCP_Ibutton_Last_Sent;
+
+unsigned char buffer_crc[2];
+unsigned short _crc;
+
+byte respon_from_slave_temp[17];
+
+bool intr_Done = false;
+uint8_t board_sum;
+
+struct frame_data {
+ string ids;
+ string key_on = "";
+ string key_off = "";
+}Frame_To_Send;
+
+struct Frame_Data_Received {
+ uint8_t ids;
+ string ibutton;
+ uint8_t _key_id;
+ uint8_t cmd_id;
+} frm_data_received;
+
+byte respon_from_slave[32];
+
+uint8_t step = 0;
+bool Done = false;
+bool isConnected = false;
+
+string salah_taruh1;
+string salah_ambil1;
+string salah_taruh2;
+string salah_ambil2;
+string salah_taruh3;
+string salah_ambil3;
+string salah_taruh4;
+string salah_ambil4;
+string salah_taruh5;
+string salah_ambil5;
+
+bool done_1 = true;
+bool done_2 = true;
+bool done_3 = true;
+bool done_4 = true;
+bool done_5 = true;
+
+vector<uint8_t> lst_salah;
+vector<uint8_t> lst_salah_hst;
+vector<uint8_t>::iterator it;
+vector<uint8_t> to_remove;
+
+string to_sends;
+string to_sends_cek;
+string salah_ambil_resultant;
+string salah_taruh_resultant;
+
+string ibutton_code;
+vector<string> split(const string str, const string separator)
+{
+ char *cstr = const_cast<char*>(str.c_str());
+ char *current;
+
+ std::vector<std::string>arr;
+ current = strtok(cstr, separator.c_str());
+ while(current != NULL) {
+ arr.push_back(current);
+ current = strtok(NULL, separator.c_str());
+ }
+ return arr;
+}
+bool waiting_resp = false;
+
+void Cek_Ibutton();
+void Cek_Salah_Buzzer();
+string Byte_to_StringBinary(byte data_byte);
+uint8_t StringBinary_to_Byte(string data_binary);
+uint8_t Get_Row(uint8_t key_id);
+unsigned short Get_CRC_Modbus(byte data_byte[]);
+void Send_RS485(uint8_t board,uint8_t key_id,uint8_t key_id_blinking,bool Cek_Respon);
+void Make_Prediction(uint8_t board_number,uint8_t baris, uint8_t kolom);
+void Cek_LCD_State();
+
+string First_Update();
+vector<string> temp_data;
+uint8_t res_cmp = 0;
+string bin_string_now;
+string bin_string_predict;
+uint8_t keys;
+bool First_Run = true;
+
+void FindingServer()
+{
+ printf("Finding Server.....\r\n\r\n");
+
+RECONNECT1:
+ EthernetInterface net;
+ net.set_network(IP,MASK,GATEWAY);
+ uint8_t stat1 = net.connect();
+ //printf("stat1 = %d\r\n",stat1);
+ if(stat1 != 0) {
+ goto RECONNECT1;
+ }
+ // Show the network address
+ const char *ip = net.get_ip_address();
+
+ while(1) {
+RECONNECT2:
+ // Open a socket on the network interface, and create a TCP connection to mbed.org
+ TCPSocket socket;
+ socket.open(&net);
+ socket.set_blocking(false);
+ uint8_t stat2 = socket.connect("192.168.0.89", 12345);
+ //printf("stat2 = %d\r\n",stat2);
+ wait(1);
+ if(stat2 != 0) {
+ socket.close();
+ goto RECONNECT2;
+ }
+
+ isConnected = true;
+ printf("Connected to Server....\r\n");
+
+ if(First_Run) {
+ printf("Process Start..\r\n");
+ //socket.send(cmd_resets, sizeof(cmd_resets));
+
+ string data_frame = First_Update();
+
+ socket.send(data_frame.c_str(), data_frame.length());
+ First_Run = false;
+ wait(0.05);
+ dsp.step0();
+ } else {
+ if(blinking_now == 0) {
+ //printf("Process Start..\r\n");
+ //socket.send(cmd_resets, sizeof(cmd_resets));
+
+ string data_frame = First_Update();
+ step = 0;
+ if(frm_data_received.ids == 3) {
+ dsp.step4(to_string(frm_data_received._key_id).c_str(),false);
+ } else if(frm_data_received.ids== 1) {
+ dsp.step0();
+ } else {
+ dsp.step0();
+ }
+ socket.send(data_frame.c_str(), data_frame.length());
+ } else {
+ dsp.step5(to_string(blinking_now).c_str(),true);
+ }
+ }
+
+ //printf("%s\r\n",data_frame.c_str());
+ while(isConnected) {
+
+ //TODO : CekData Locker Terkini
+
+ switch(step) {
+ case 0: {
+
+ uint8_t res_cek = socket.send(cek_con,sizeof(cek_con));
+
+ if(res_cek <= 0) {
+ printf("Server Has Been Closed..\r\n");
+ isConnected = false;
+ socket.close();
+ dsp.init();
+ continue;
+ }
+
+ for(uint8_t i = 0; i<board_sum; i++) {
+ wait_ms(50);
+ //printf("%d %d %d %d %d\r\n",real_blink_id_1,real_blink_id_2,real_blink_id_3,real_blink_id_4,real_blink_id_5);
+ if(i == 0) Send_RS485(i,64,real_blink_id_1,true);
+ else if(i == 1) Send_RS485(i,64,real_blink_id_2,true);
+ else if(i == 2) Send_RS485(i,64,real_blink_id_3,true);
+ else if(i == 3) Send_RS485(i,64,real_blink_id_4,true);
+ else if(i == 4) Send_RS485(i,64,real_blink_id_5,true);
+
+ for(uint8_t a = 4; a<12; a++) {
+ uint8_t temp_id = a;
+
+ switch(i) {
+ case 0: {
+ Row_Board1_Now[temp_id-4] = respon_from_slave[a];
+ //printf("Resp : %02X || BoardLast %d : %02X\r\n",respon_from_slave[a],i+1,Row_Board1_Last[temp_id-5]);
+ }
+ break;
+ case 1: {
+ Row_Board2_Now[temp_id-4] = respon_from_slave[a];
+ //printf("Resp : %02X || BoardLast %d : %02X\r\n",respon_from_slave[a],i+1,Row_Board2_Last[temp_id-5]);
+ }
+ break;
+ case 2: {
+ Row_Board3_Now[temp_id-4] = respon_from_slave[a];
+ //printf("Resp : %02X || BoardLast %d : %02X\r\n",respon_from_slave[a],i+1,Row_Board3_Last[temp_id-5]);
+ }
+ break;
+ case 3: {
+ Row_Board4_Now[temp_id-4] = respon_from_slave[a];
+ //printf("Resp : %02X || BoardLast %d : %02X\r\n",respon_from_slave[a],i+1,Row_Board4_Last[temp_id-5]);
+ }
+ break;
+ case 4: {
+ Row_Board5_Now[temp_id-4] = respon_from_slave[a];
+ //printf("Resp : %02X || BoardLast %d : %02X\r\n",respon_from_slave[a],i+1,Row_Board5_Last[temp_id-5]);
+ }
+ break;
+ }
+ }
+ }
+
+ salah_ambil1 = "";
+ salah_taruh1 = "";
+ salah_ambil2 = "";
+ salah_taruh2 = "";
+ salah_ambil3 = "";
+ salah_taruh3 = "";
+ salah_ambil4 = "";
+ salah_taruh4 = "";
+ salah_ambil5 = "";
+ salah_taruh5 = "";
+
+ lst_salah.clear();
+ to_remove.clear();
+ for(uint8_t i = 0; i<board_sum; i++) {
+ switch(i) {
+ case 0: {
+ res_cmp = 0;
+ res_cmp = memcmp(Row_Board1_Now,Row_Board1_Last, sizeof(Row_Board1_Now));
+ if(res_cmp != 0) {
+ for(uint8_t j = 0; j<8; j++) {
+ if(Row_Board1_Now[j] != Row_Board1_Last[j]) {
+ bin_string_now = "";
+ bin_string_predict = "";
+ keys = 0;
+ bin_string_now = Byte_to_StringBinary(Row_Board1_Now[j]);
+ bin_string_predict = Byte_to_StringBinary(Row_Board1_Last[j]);
+
+ for (uint8_t k = 0; k < 8; k++) {
+ if(bin_string_now[abs(k-7)] != bin_string_predict[abs(k-7)]) {
+ keys = (40*j)+k+(8*i)+1;
+ done_1 = false;
+ lst_salah.push_back(keys);
+
+ if(bin_string_predict[abs(k-7)] == '0') {
+ salah_taruh1 += to_string(keys)+"-";
+ } else {
+ salah_ambil1 += to_string(keys)+"-";
+ }
+ }
+ }
+ }
+ }
+ } else if (res_cmp == 0) {
+ real_blink_id_1 = 64;
+ salah_ambil1 = "";
+ salah_taruh1 = "";
+ done_1 = true;
+
+ //memcpy(Row_Board1_Last,Row_Board1_Now,sizeof(Row_Board1_Last));
+
+ Send_RS485(i,64,64,false);
+ }
+
+ }
+ break;
+ case 1: {
+ res_cmp = 0;
+ res_cmp = memcmp(Row_Board2_Now,Row_Board2_Last, sizeof(Row_Board2_Now));
+ if(res_cmp != 0) {
+ for(uint8_t j = 0; j<8; j++) {
+ if(Row_Board2_Now[j] != Row_Board2_Last[j]) {
+ bin_string_now = "";
+ bin_string_predict = "";
+ keys = 0;
+ bin_string_now = Byte_to_StringBinary(Row_Board2_Now[j]);
+ bin_string_predict = Byte_to_StringBinary(Row_Board2_Last[j]);
+
+ for (uint8_t k = 0; k < 8; k++) {
+ if(bin_string_now[abs(k-7)] != bin_string_predict[abs(k-7)]) {
+ keys = (40*j)+k+(8*i)+1;
+ lst_salah.push_back(keys);
+ done_2 = false;
+
+ if(bin_string_predict[abs(k-7)] == '0') {
+ salah_taruh2 += to_string(keys)+"-";
+ } else {
+ salah_ambil2 += to_string(keys)+"-";
+ }
+ }
+ }
+ }
+ }
+ } else if (res_cmp == 0) {
+ real_blink_id_2 = 64;
+ salah_ambil2 = "";
+ salah_taruh2 = "";
+ done_2 = true;
+
+ //memcpy(Row_Board2_Last,Row_Board2_Now,sizeof(Row_Board2_Last));
+
+ Send_RS485(i,64,64,false);
+ }
+ }
+ break;
+ case 2: {
+ res_cmp = 0;
+ res_cmp = memcmp(Row_Board3_Now,Row_Board3_Last, sizeof(Row_Board3_Now));
+ if(res_cmp != 0) {
+ for(uint8_t j = 0; j<8; j++) {
+ if(Row_Board3_Now[j] != Row_Board3_Last[j]) {
+ bin_string_now = "";
+ bin_string_predict = "";
+ keys = 0;
+ bin_string_now = Byte_to_StringBinary(Row_Board3_Now[j]);
+ bin_string_predict = Byte_to_StringBinary(Row_Board3_Last[j]);
+
+ for (uint8_t k = 0; k < 8; k++) {
+ if(bin_string_now[abs(k-7)] != bin_string_predict[abs(k-7)]) {
+ keys = (40*j)+k+(8*i)+1;
+ lst_salah.push_back(keys);
+ done_3 = false;
+
+ if(bin_string_predict[abs(k-7)] == '0') {
+ salah_taruh3 += to_string(keys)+"-";
+ } else {
+ salah_ambil3 += to_string(keys)+"-";
+ }
+ }
+ }
+ }
+ }
+ } else if (res_cmp == 0) {
+ real_blink_id_3 = 64;
+ salah_ambil3 = "";
+ salah_taruh3 = "";
+ done_3 = true;
+
+ //memcpy(Row_Board3_Last,Row_Board3_Now,sizeof(Row_Board3_Last));
+
+ Send_RS485(i,64,64,false);
+ }
+ }
+ break;
+ case 3: {
+ res_cmp = 0;
+ res_cmp = memcmp(Row_Board4_Now,Row_Board4_Last, sizeof(Row_Board4_Now));
+ if(res_cmp != 0) {
+ for(uint8_t j = 0; j<8; j++) {
+ if(Row_Board4_Now[j] != Row_Board4_Last[j]) {
+ bin_string_now = "";
+ bin_string_predict = "";
+ keys = 0;
+ bin_string_now = Byte_to_StringBinary(Row_Board4_Now[j]);
+ bin_string_predict = Byte_to_StringBinary(Row_Board4_Last[j]);
+
+ for (uint8_t k = 0; k < 8; k++) {
+ if(bin_string_now[abs(k-7)] != bin_string_predict[abs(k-7)]) {
+ keys = (40*j)+k+(8*i)+1;
+ lst_salah.push_back(keys);
+ done_4 = false;
+
+ if(bin_string_predict[abs(k-7)] == '0') {
+ salah_taruh4 += to_string(keys)+"-";
+ } else {
+ salah_ambil4 += to_string(keys)+"-";
+ }
+ }
+ }
+ }
+ }
+ } else if (res_cmp == 0) {
+ real_blink_id_4 = 64;
+ salah_ambil4 = "";
+ salah_taruh4 = "";
+ done_4 = true;
+
+ //memcpy(Row_Board3_Last,Row_Board3_Now,sizeof(Row_Board3_Last));
+
+ Send_RS485(i,64,64,false);
+ }
+ }
+ break;
+ case 4: {
+ res_cmp = 0;
+ res_cmp = memcmp(Row_Board5_Now,Row_Board5_Last, sizeof(Row_Board5_Now));
+ if(res_cmp != 0) {
+ for(uint8_t j = 0; j<8; j++) {
+ if(Row_Board5_Now[j] != Row_Board5_Last[j]) {
+ bin_string_now = "";
+ bin_string_predict = "";
+ keys = 0;
+ bin_string_now = Byte_to_StringBinary(Row_Board5_Now[j]);
+ bin_string_predict = Byte_to_StringBinary(Row_Board5_Last[j]);
+
+ for (uint8_t k = 0; k < 8; k++) {
+ if(bin_string_now[abs(k-7)] != bin_string_predict[abs(k-7)]) {
+ keys = (40*j)+k+(8*i)+1;
+ lst_salah.push_back(keys);
+ done_5 = false;
+
+ if(bin_string_predict[abs(k-7)] == '0') {
+ salah_taruh5 += to_string(keys)+"-";
+ } else {
+ salah_ambil5 += to_string(keys)+"-";
+ }
+ }
+ }
+ }
+ }
+ } else if (res_cmp == 0) {
+ real_blink_id_5 = 64;
+ salah_ambil5 = "";
+ salah_taruh5 = "";
+ done_5 = true;
+
+ //memcpy(Row_Board3_Last,Row_Board3_Now,sizeof(Row_Board3_Last));
+
+ Send_RS485(i,64,64,false);
+ }
+ }
+ break;
+ }
+ }
+
+ salah_ambil_resultant = "";
+ salah_taruh_resultant = "";
+
+ if(lst_salah.size() > 0) {
+
+ uint8_t blink_id = 64;
+
+ bool ada = false;
+
+ if(lst_salah_hst.size() > 0) {
+
+ printf("jumlah hst = %d\r\n",lst_salah_hst.size());
+ for(uint8_t q = 0; q<lst_salah_hst.size(); q++) {
+ ada = false;
+ printf("lst_hst_recent%d = %d\r\n",q+1,lst_salah_hst[q]);
+
+ for(uint8_t r = 0; r<lst_salah.size(); r++) {
+ if(lst_salah[r] == lst_salah_hst[q]) {
+ ada = true;
+ }
+ }
+ if(!ada) {
+ to_remove.push_back(lst_salah_hst[q]);
+ }
+ }
+
+ if(to_remove.size() > 0) {
+ for(uint8_t t = 0; t<to_remove.size(); t++) {
+ lst_salah_hst.erase(remove(lst_salah_hst.begin(), lst_salah_hst.end(), to_remove[t]), lst_salah_hst.end());
+ }
+ }
+
+ for(uint8_t w = 0; w<lst_salah.size(); w++) {
+ it = find (lst_salah_hst.begin(), lst_salah_hst.end(), lst_salah[w]);
+ if (it != lst_salah_hst.end()) {
+ continue;
+ }
+ lst_salah_hst.push_back(lst_salah[w]);
+ }
+ } else {
+ for(uint8_t u = 0; u<lst_salah.size(); u++) {
+ lst_salah_hst.push_back(lst_salah[u]);
+ }
+
+ }
+
+ blink_id = lst_salah_hst[lst_salah_hst.size()-1];
+
+ uint8_t board_number_blink = (blink_id - 1)%40;
+
+ if(board_number_blink>= 0 && board_number_blink<= 7)board_number_blink = 0;
+ else if(board_number_blink>= 8 && board_number_blink<= 15)board_number_blink = 1;
+ else if(board_number_blink>= 16 && board_number_blink<= 23)board_number_blink = 2;
+ else if(board_number_blink>= 24 && board_number_blink<= 31)board_number_blink = 3;
+ else if(board_number_blink>= 32 && board_number_blink<= 39)board_number_blink = 4;
+
+ //printf("board_number_blink = %d\r\n",board_number_blink);
+
+ uint8_t baris_blink = (blink_id - 1)/40;
+ uint8_t kolom_blink = (blink_id - 1)%8;
+ blink_id = board_88[baris_blink][kolom_blink];
+
+ //printf("Board blink : %d,Kolom blink : %d, Baris blink : %d\r\n",board_number_blink,kolom_blink,baris_blink);
+ if(board_number_blink == 0) {
+ real_blink_id_1 = blink_id;
+ real_blink_id_2 = 64;
+ real_blink_id_3 = 64;
+ real_blink_id_4 = 64;
+ real_blink_id_5 = 64;
+ } else if(board_number_blink == 1) {
+ real_blink_id_1 = 64;
+ real_blink_id_2 = blink_id;
+ real_blink_id_3 = 64;
+ real_blink_id_4 = 64;
+ real_blink_id_5 = 64;
+ } else if(board_number_blink == 2) {
+ real_blink_id_1 = 64;
+ real_blink_id_2 = 64;
+ real_blink_id_3 = blink_id;
+ real_blink_id_4 = 64;
+ real_blink_id_5 = 64;
+ } else if(board_number_blink == 3) {
+ real_blink_id_1 = 64;
+ real_blink_id_2 = 64;
+ real_blink_id_3 = 64;
+ real_blink_id_4 = blink_id;
+ real_blink_id_5 = 64;
+ } else if(board_number_blink == 4) {
+ real_blink_id_1 = 64;
+ real_blink_id_2 = 64;
+ real_blink_id_3 = 64;
+ real_blink_id_4 = 64;
+ real_blink_id_5 = blink_id;
+ }
+ blinking_now = lst_salah_hst[lst_salah_hst.size()-1];
+
+ salah_ambil_resultant = salah_ambil1 + salah_ambil2 + salah_ambil3 + salah_ambil4 + salah_ambil5;
+ salah_taruh_resultant = salah_taruh1 + salah_taruh2 + salah_taruh3 + salah_taruh4 + salah_taruh5;
+
+ if(salah_ambil_resultant == "") salah_ambil_resultant = "0-";
+ if(salah_taruh_resultant == "") salah_taruh_resultant = "0-";
+
+ to_sends_cek = "2;"+salah_ambil_resultant + ";" +salah_taruh_resultant+";" + to_string(blinking_now) +";~";
+ printf("Unprosedur : %s\r\n",to_sends_cek.c_str());
+
+ if(TCP_Cek_Data_Last_Sent.find(to_sends_cek) == -1) {
+ dsp.step5(to_string(blinking_now).c_str(),true);
+ socket.send(to_sends_cek.c_str(), to_sends_cek.length());
+
+ TCP_Cek_Data_Last_Sent = to_sends_cek;
+ }
+ } else {
+ if(done_1 && done_2 && done_3 && done_4 && done_5) {
+ lst_salah_hst.clear();
+ blinking_now = 0;
+ real_blink_id_1 = 64;
+ real_blink_id_2 = 64;
+ real_blink_id_3 = 64;
+ real_blink_id_4 = 64;
+ real_blink_id_5 = 64;
+
+ salah_ambil_resultant = "0;";
+ salah_taruh_resultant = "0";
+
+ step = 1;
+
+ to_sends_cek = "2;0-;0-;~";
+
+ if(TCP_Cek_Data_Last_Sent.find(to_sends_cek) == -1) {
+ if(frm_data_received.ids == 3) {
+ dsp.step4(to_string(frm_data_received._key_id).c_str(),false);
+ } else if(frm_data_received.ids== 1) {
+ dsp.step0();
+ } else {
+ dsp.step0();
+ }
+ //wait_ms(50);
+ socket.send(to_sends_cek.c_str(), to_sends_cek.length());
+ TCP_Cek_Data_Last_Sent = to_sends_cek;
+ }
+
+ } else {
+ blinking_now = 0;
+ real_blink_id_1 = 64;
+ real_blink_id_2 = 64;
+ real_blink_id_3 = 64;
+ real_blink_id_4 = 64;
+ real_blink_id_5 = 64;
+ }
+ }
+ }
+ break;
+
+ case 1: {
+ char rbuffer[64];
+
+ uint8_t rcount = socket.recv(rbuffer, sizeof rbuffer);
+ if(rcount < 0) {
+ step = 0;
+ } else if(rcount > 0) {
+ rbuffer[rcount] = '\0';
+
+ string data;
+
+ for(uint8_t i = 0; i<sizeof(rbuffer); i++) {
+ if(rbuffer[i] == '\0')break;
+ data += rbuffer[i];
+ }
+
+ vector<string> res = split(data, "~");
+
+ if(sizeof(res) != 0) {
+ temp_data = split(res[0], ";");
+
+ if(temp_data[0] == "3" && temp_data[1] == "1") {
+ dsp.step4(to_string(frm_data_received._key_id).c_str(),false);
+ } else if(temp_data[0] == "3" && temp_data[1] == "0") {
+ dsp.step0();
+ } else {
+ frm_data_received.ids = atoi(temp_data[0].c_str());
+ frm_data_received.ibutton = temp_data[1];
+ frm_data_received._key_id = atoi(temp_data[2].c_str());
+ frm_data_received.cmd_id = atoi(temp_data[3].c_str());
+
+
+ printf("id = %d\r\n",frm_data_received.ids);
+ printf("ibutton = %s\r\n",frm_data_received.ibutton.c_str());
+ printf("keys = %d\r\n",frm_data_received._key_id);
+ printf("cmd = %d\r\n",frm_data_received.cmd_id);
+
+ if(frm_data_received.ids== 1) {
+ wait(1);
+ dsp.step1(true);
+ step = 2;
+ } else if(frm_data_received.ids == 3) {
+ step = 3;
+
+ //dsp.step4(to_string(frm_data_received._key_id).c_str(),true);
+ }
+ }
+ }
+ } else if(rcount == 0) {
+ printf("Server Has Been Closed..\r\n");
+
+ isConnected = false;
+ step = 0;//
+// blinking_now = 0;
+// real_blink_id_1 = 64;
+// real_blink_id_2 = 64;
+// real_blink_id_3 = 64;
+// real_blink_id_4 = 64;
+// real_blink_id_5 = 64;
+ dsp.init();
+ socket.close();
+ }
+
+ if(ibutton_code != "") {
+ string data_to_send = "3;" + ibutton_code + ";~";
+ printf("%s\r\n",data_to_send.c_str());
+ wait(1);
+
+ socket.send(data_to_send.c_str(), data_to_send.length());
+ TCP_Ibutton_Last_Sent = data_to_send;
+ printf("Send ibutton\r\n");
+
+ ibutton_code.clear();
+ }
+ }
+ break;
+
+ case 2: {
+ buzz.play(1);
+ bool restart = false;
+ while(frm_data_received.ibutton.c_str() != ibutton_code) {
+ uint8_t res_cek = socket.send(cek_con,sizeof(cek_con));
+
+ if(res_cek <= 0) {
+ printf("Server Has Been Closed..\r\n");
+ isConnected = false;
+ socket.close();
+ dsp.init();
+ restart = true;
+ break;
+ }
+ wait(0.05);
+ }
+ if(restart) {
+ continue;
+ } else {
+ ibutton_code.clear();
+ printf("IButton verified\r\n");
+ dsp.step2(to_string(frm_data_received._key_id).c_str());
+ step = 3;
+
+ }
+ }
+ break;
+
+ case 3: {
+ uint8_t res_cek = socket.send(cek_con,sizeof(cek_con));
+
+ if(res_cek <= 0) {
+ printf("Server Has Been Closed..\r\n");
+ isConnected = false;
+ socket.close();
+ dsp.init();
+ continue;
+ }
+
+ buzz.play(1);
+
+ board_number = (frm_data_received._key_id - 1)%40;
+
+ if(board_number>= 0 && board_number<= 7)board_number = 0;
+ if(board_number>= 8 && board_number<= 15)board_number = 1;
+ if(board_number>= 16 && board_number<= 23)board_number = 2;
+ if(board_number>= 24 && board_number<= 31)board_number = 3;
+ if(board_number>= 32 && board_number<= 39)board_number = 4;
+ printf("KEY[board] = %d\r\n",board_number);
+ baris = (frm_data_received._key_id - 1)/40;
+ printf("KEY[baris] = %d\r\n",baris);
+ kolom = (frm_data_received._key_id - 1)%8;
+ printf("KEY[kolom] = %d\r\n",kolom);
+
+ real_id = board_88[baris][kolom];
+ printf("Real Id = %d\r\n",real_id);
+
+ Make_Prediction(board_number,baris,kolom);
+
+ step = 4;
+
+ }
+ break;
+
+ case 4: {
+ uint8_t res_cek = socket.send(cek_con,sizeof(cek_con));
+
+ if(res_cek <= 0) {
+ LCD_Step_4 = 0;
+ printf("Server Has Been Closed..\r\n");
+ isConnected = false;
+ socket.close();
+ dsp.init();
+ continue;
+ }
+
+ for(uint8_t i = 0; i<board_sum; i++) {
+ wait_ms(100);
+ if(board_number == i) {
+ if(i == 0) Send_RS485(i,real_id,real_blink_id_1,true);
+ else if(i == 1) Send_RS485(i,real_id,real_blink_id_2,true);
+ else if(i == 2) Send_RS485(i,real_id,real_blink_id_3,true);
+ else if(i == 3) Send_RS485(i,real_id,real_blink_id_4,true);
+ else if(i == 4) Send_RS485(i,real_id,real_blink_id_5,true);
+ } else {
+ if(i == 0) Send_RS485(i,64,real_blink_id_1,true);
+ else if(i == 1) Send_RS485(i,64,real_blink_id_2,true);
+ else if(i == 2) Send_RS485(i,64,real_blink_id_3,true);
+ else if(i == 3) Send_RS485(i,64,real_blink_id_4,true);
+ else if(i == 4) Send_RS485(i,64,real_blink_id_5,true);
+ }
+
+ printf("Data has been received successfully\r\n");
+ for(uint8_t a = 4; a<12; a++) {
+ uint8_t temp_id = a;
+
+ switch(i) {
+ case 0: {
+ Row_Board1_Now[temp_id-4] = respon_from_slave[a];
+ }
+ break;
+ case 1: {
+ Row_Board2_Now[temp_id-4] = respon_from_slave[a];
+ //printf("Resp : %02X || BoardLast %d : %02X\r\n",respon_from_slave[a],i+1,Row_Board2_Last[temp_id-5]);
+ }
+ break;
+ case 2: {
+ Row_Board3_Now[temp_id-4] = respon_from_slave[a];
+ //printf("Resp : %02X || BoardLast %d : %02X\r\n",respon_from_slave[a],i+1,Row_Board3_Last[temp_id-5]);
+ }
+ break;
+ case 3: {
+ Row_Board4_Now[temp_id-4] = respon_from_slave[a];
+ //printf("Resp : %02X || BoardLast %d : %02X\r\n",respon_from_slave[a],i+1,Row_Board4_Last[temp_id-5]);
+ }
+ break;
+ case 4: {
+ Row_Board5_Now[temp_id-4] = respon_from_slave[a];
+ //printf("Resp : %02X || BoardLast %d : %02X\r\n",respon_from_slave[a],i+1,Row_Board5_Last[temp_id-5]);
+ }
+ break;
+ }
+ }
+ }
+
+ salah_ambil1 = "";
+ salah_taruh1 = "";
+ salah_ambil2 = "";
+ salah_taruh2 = "";
+ salah_ambil3 = "";
+ salah_taruh3 = "";
+ salah_ambil4 = "";
+ salah_taruh4 = "";
+ salah_ambil5 = "";
+ salah_taruh5 = "";
+
+ lst_salah.clear();
+
+ for(uint8_t i = 0; i<board_sum; i++) {
+ switch(i) {
+ case 0: {
+ string salah_1;
+ res_cmp = 0;
+ res_cmp = memcmp(Row_Board1_Now,Row_Board1_Predict, sizeof(Row_Board1_Now));
+ if(res_cmp != 0) {
+ for(uint8_t j = 0; j<8; j++) {
+ if(Row_Board1_Now[j] != Row_Board1_Predict[j]) {
+ bin_string_now = "";
+ bin_string_predict = "";
+ keys = 0;
+ bin_string_now = Byte_to_StringBinary(Row_Board1_Now[j]);
+ bin_string_predict = Byte_to_StringBinary(Row_Board1_Predict[j]);
+
+ for (uint8_t k = 0; k < 8; k++) {
+ if(bin_string_now[abs(k-7)] != bin_string_predict[abs(k-7)]) {
+ keys = (40*j)+k+(8*i)+1;
+ if(keys != frm_data_received._key_id) {
+ lst_salah.push_back(keys);
+ salah_1 += to_string(keys)+"-";
+ } else {
+ done_1 = false;
+ }
+
+ if(bin_string_predict[abs(k-7)] == '0') {
+ if(keys != frm_data_received._key_id) {
+ salah_taruh1 += to_string(keys)+"-";
+ }
+ } else {
+ if(keys != frm_data_received._key_id) {
+ salah_ambil1 += to_string(keys)+"-";
+
+ }
+ }
+ }
+ }
+ }
+ }
+ printf("Salah_Board%d = %s\r\n",i+1,salah_1.c_str());
+ } else if (res_cmp == 0) {
+ printf("Board %d Match\r\n",i+1);
+ real_blink_id_1 = 64;
+ salah_ambil1 = "";
+ salah_taruh1 = "";
+ done_1 = true;
+
+ memcpy(Row_Board1_Last,Row_Board1_Now,sizeof(Row_Board1_Last));
+
+ Send_RS485(i,64,64,false);
+ }
+
+ }
+ break;
+ case 1: {
+ string salah_2;
+ res_cmp = 0;
+ res_cmp = memcmp(Row_Board2_Now,Row_Board2_Predict, sizeof(Row_Board2_Now));
+ if(res_cmp != 0) {
+ for(uint8_t j = 0; j<8; j++) {
+ if(Row_Board2_Now[j] != Row_Board2_Predict[j]) {
+ bin_string_now = "";
+ bin_string_predict = "";
+ keys = 0;
+ bin_string_now = Byte_to_StringBinary(Row_Board2_Now[j]);
+ bin_string_predict = Byte_to_StringBinary(Row_Board2_Predict[j]);
+
+ for (uint8_t k = 0; k < 8; k++) {
+ if(bin_string_now[abs(k-7)] != bin_string_predict[abs(k-7)]) {
+ keys = (40*j)+k+(8*i)+1;
+ if(keys != frm_data_received._key_id) {
+ lst_salah.push_back(keys);
+ salah_2 += to_string(keys)+"-";
+ } else {
+ done_2 = false;
+ }
+
+ if(bin_string_predict[abs(k-7)] == '0') {
+ if(keys != frm_data_received._key_id) {
+ salah_taruh2 += to_string(keys)+"-";
+ }
+ } else {
+ if(keys != frm_data_received._key_id) {
+ salah_ambil2 += to_string(keys)+"-";
+ }
+ }
+ }
+ }
+ }
+ }
+ printf("Salah_Board%d = %s\r\n",i+1,salah_2.c_str());
+ } else if (res_cmp == 0) {
+ printf("Board %d Match\r\n",i+1);
+ real_blink_id_2 = 64;
+ salah_ambil2 = "";
+ salah_taruh2 = "";
+ done_2 = true;
+
+ memcpy(Row_Board2_Last,Row_Board2_Now,sizeof(Row_Board2_Last));
+
+ Send_RS485(i,64,64,false);
+ }
+ }
+ break;
+ case 2: {
+ string salah_3;
+ res_cmp = 0;
+ res_cmp = memcmp(Row_Board3_Now,Row_Board3_Predict, sizeof(Row_Board3_Now));
+ if(res_cmp != 0) {
+ for(uint8_t j = 0; j<8; j++) {
+ if(Row_Board3_Now[j] != Row_Board3_Predict[j]) {
+ bin_string_now = "";
+ bin_string_predict = "";
+ keys = 0;
+ bin_string_now = Byte_to_StringBinary(Row_Board3_Now[j]);
+ bin_string_predict = Byte_to_StringBinary(Row_Board3_Predict[j]);
+
+ for (uint8_t k = 0; k < 8; k++) {
+ if(bin_string_now[abs(k-7)] != bin_string_predict[abs(k-7)]) {
+ keys = (40*j)+k+(8*i)+1;
+ if(keys != frm_data_received._key_id) {
+ lst_salah.push_back(keys);
+ salah_3 += to_string(keys)+"-";
+ } else {
+ done_3 = false;
+ }
+
+ if(bin_string_predict[abs(k-7)] == '0') {
+ if(keys != frm_data_received._key_id) {
+ salah_taruh3 += to_string(keys)+"-";
+ }
+ } else {
+ if(keys != frm_data_received._key_id) {
+ salah_ambil3 += to_string(keys)+"-";
+ }
+ }
+ }
+ }
+ }
+ }
+ printf("Salah_Board%d = %s\r\n",i+1,salah_3.c_str());
+ } else if (res_cmp == 0) {
+ printf("Board %d Match\r\n",i+1);
+ real_blink_id_3 = 64;
+ salah_ambil3 = "";
+ salah_taruh3 = "";
+ done_3 = true;
+
+ memcpy(Row_Board3_Last,Row_Board3_Now,sizeof(Row_Board3_Last));
+
+ Send_RS485(i,64,64,false);
+ }
+ }
+ break;
+ case 3: {
+ string salah_4;
+ res_cmp = 0;
+ res_cmp = memcmp(Row_Board4_Now,Row_Board4_Predict, sizeof(Row_Board4_Now));
+ if(res_cmp != 0) {
+ for(uint8_t j = 0; j<8; j++) {
+ if(Row_Board1_Now[j] != Row_Board4_Predict[j]) {
+ bin_string_now = "";
+ bin_string_predict = "";
+ keys = 0;
+ bin_string_now = Byte_to_StringBinary(Row_Board4_Now[j]);
+ bin_string_predict = Byte_to_StringBinary(Row_Board4_Predict[j]);
+
+ for (uint8_t k = 0; k < 8; k++) {
+ if(bin_string_now[abs(k-7)] != bin_string_predict[abs(k-7)]) {
+ keys = (40*j)+k+(8*i)+1;
+ if(keys != frm_data_received._key_id) {
+ lst_salah.push_back(keys);
+ salah_4 += to_string(keys)+"-";
+ } else {
+ done_4 = false;
+ }
+
+ if(bin_string_predict[abs(k-7)] == '0') {
+ if(keys != frm_data_received._key_id) {
+ salah_taruh4 += to_string(keys)+"-";
+ }
+ } else {
+ if(keys != frm_data_received._key_id) {
+ salah_ambil4 += to_string(keys)+"-";
+
+ }
+ }
+ }
+ }
+ }
+ }
+ printf("Salah_Board%d = %s\r\n",i+1,salah_4.c_str());
+ } else if (res_cmp == 0) {
+ printf("Board %d Match\r\n",i+1);
+ real_blink_id_4 = 64;
+ salah_ambil4 = "";
+ salah_taruh4 = "";
+ done_4 = true;
+
+ memcpy(Row_Board4_Last,Row_Board4_Now,sizeof(Row_Board4_Last));
+
+ Send_RS485(i,64,64,false);
+ }
+ }
+ break;
+ case 4: {
+ string salah_5;
+ res_cmp = 0;
+ res_cmp = memcmp(Row_Board5_Now,Row_Board5_Predict, sizeof(Row_Board5_Now));
+ if(res_cmp != 0) {
+ for(uint8_t j = 0; j<8; j++) {
+ if(Row_Board1_Now[j] != Row_Board5_Predict[j]) {
+ bin_string_now = "";
+ bin_string_predict = "";
+ keys = 0;
+ bin_string_now = Byte_to_StringBinary(Row_Board5_Now[j]);
+ bin_string_predict = Byte_to_StringBinary(Row_Board5_Predict[j]);
+
+ for (uint8_t k = 0; k < 8; k++) {
+ if(bin_string_now[abs(k-7)] != bin_string_predict[abs(k-7)]) {
+ keys = (40*j)+k+(8*i)+1;
+ if(keys != frm_data_received._key_id) {
+ lst_salah.push_back(keys);
+ salah_5 += to_string(keys)+"-";
+ } else {
+ done_5 = false;
+ }
+
+ if(bin_string_predict[abs(k-7)] == '0') {
+ if(keys != frm_data_received._key_id) {
+ salah_taruh5 += to_string(keys)+"-";
+ }
+ } else {
+ if(keys != frm_data_received._key_id) {
+ salah_ambil5 += to_string(keys)+"-";
+ }
+ }
+ }
+ }
+ }
+ }
+ printf("Salah_Board%d = %s\r\n",i+1,salah_5.c_str());
+ } else if (res_cmp == 0) {
+ printf("Board %d Match\r\n",i+1);
+ real_blink_id_5 = 64;
+ salah_ambil5 = "";
+ salah_taruh5 = "";
+ done_5 = true;
+
+ memcpy(Row_Board5_Last,Row_Board5_Now,sizeof(Row_Board5_Last));
+
+ Send_RS485(i,64,64,false);
+ }
+ }
+ break;
+ }
+ }
+
+ salah_ambil_resultant = "";
+ salah_taruh_resultant = "";
+ printf("Size salah = %d\r\n",lst_salah.size());
+ if(lst_salah.size() > 0) {
+ uint8_t blink_id = 64;
+
+ bool ada = false;
+ for(uint8_t p = 0; p<lst_salah.size(); p++) printf("lst salah all%d = %d\r\n",p+1,lst_salah[p]);
+
+ if(lst_salah_hst.size() != 0) {
+
+ //printf("jumlah hst = %d\r\n",lst_salah_hst.size());
+ for(uint8_t q = 0; q<lst_salah_hst.size(); q++) {
+ ada = false;
+
+ for(uint8_t r = 0; r<lst_salah.size(); r++) {
+ if(lst_salah[r] == lst_salah_hst[q]) {
+ ada = true;
+ //break;
+ }
+ }
+ if(!ada) {
+ to_remove.push_back(lst_salah_hst[q]);
+ }
+ }
+
+ if(to_remove.size() > 0) {
+ for(uint8_t t = 0; t<to_remove.size(); t++) {
+ lst_salah_hst.erase(remove(lst_salah_hst.begin(), lst_salah_hst.end(), to_remove[t]), lst_salah_hst.end());
+ }
+ }
+
+ for(uint8_t w = 0; w<lst_salah.size(); w++) {
+ it = find (lst_salah_hst.begin(), lst_salah_hst.end(), lst_salah[w]);
+ if (it != lst_salah_hst.end()) {
+ continue;
+ }
+ lst_salah_hst.push_back(lst_salah[w]);
+ }
+ } else {
+
+ for(uint8_t u = 0; u<lst_salah.size(); u++) {
+ lst_salah_hst.push_back(lst_salah[u]);
+ }
+ }
+
+ blink_id = lst_salah_hst[lst_salah_hst.size()-1];
+ //printf("blink_id = %d\r\n",blink_id);
+
+ uint8_t board_number_blink = (blink_id - 1)%40;
+
+ if(board_number_blink>= 0 && board_number_blink<= 7)board_number_blink = 0;
+ else if(board_number_blink>= 8 && board_number_blink<= 15)board_number_blink = 1;
+ else if(board_number_blink>= 16 && board_number_blink<= 23)board_number_blink = 2;
+ else if(board_number_blink>= 24 && board_number_blink<= 31)board_number_blink = 3;
+ else if(board_number_blink>= 32 && board_number_blink<= 39)board_number_blink = 4;
+
+ //printf("board_number_blink = %d\r\n",board_number_blink);
+
+ uint8_t baris_blink = (blink_id - 1)/40;
+ uint8_t kolom_blink = (blink_id - 1)%8;
+
+ blink_id = board_88[baris_blink][kolom_blink];
+
+ printf("Board blink : %d,Kolom blink : %d, Baris blink : %d\r\n",board_number_blink,kolom_blink,baris_blink);
+ if(board_number_blink == 0) {
+ real_blink_id_1 = blink_id;
+ real_blink_id_2 = 64;
+ real_blink_id_3 = 64;
+ real_blink_id_4 = 64;
+ real_blink_id_5 = 64;
+ } else if(board_number_blink == 1) {
+ real_blink_id_1 = 64;
+ real_blink_id_2 = blink_id;
+ real_blink_id_3 = 64;
+ real_blink_id_4 = 64;
+ real_blink_id_5 = 64;
+ } else if(board_number_blink == 2) {
+ real_blink_id_1 = 64;
+ real_blink_id_2 = 64;
+ real_blink_id_3 = blink_id;
+ real_blink_id_4 = 64;
+ real_blink_id_5 = 64;
+ } else if(board_number_blink == 3) {
+ real_blink_id_1 = 64;
+ real_blink_id_2 = 64;
+ real_blink_id_3 = 64;
+ real_blink_id_4 = blink_id;
+ real_blink_id_5 = 64;
+ } else if(board_number_blink == 4) {
+ real_blink_id_1 = 64;
+ real_blink_id_2 = 64;
+ real_blink_id_3 = 64;
+ real_blink_id_4 = 64;
+ real_blink_id_5 = blink_id;
+ }
+ blinking_now = lst_salah_hst[lst_salah_hst.size()-1];
+ salah_ambil_resultant = salah_ambil1 + salah_ambil2 + salah_ambil3 + salah_ambil4 + salah_ambil5;
+ salah_taruh_resultant = salah_taruh1 + salah_taruh2 + salah_taruh3 + salah_taruh4 + salah_taruh5;
+
+ if(salah_ambil_resultant == "") salah_ambil_resultant = "0-";
+ if(salah_taruh_resultant == "") salah_taruh_resultant = "0-";
+
+ to_sends = to_string(frm_data_received.ids) + ";" +salah_ambil_resultant+";"+salah_taruh_resultant+ ";"+to_string(blinking_now) +";~";
+
+ if(TCP_Data_Last_Sent.find(to_sends) == -1) {
+ dsp.step5(to_string(blinking_now).c_str(),true);
+ LCD_Step_4 = 0;
+ socket.send(to_sends.c_str(), to_sends.length());
+ TCP_Data_Last_Sent = to_sends;
+ }
+ } else {
+ if(done_1 && done_2 && done_3 && done_4 && done_5) {
+ lst_salah_hst.clear();
+ real_blink_id_1 = 64;
+ real_blink_id_2 = 64;
+ real_blink_id_3 = 64;
+ real_blink_id_4 = 64;
+ real_blink_id_5 = 64;
+ blinking_now = 0;
+ printf("Finish\r\n");
+ salah_ambil_resultant = "0-";
+ salah_taruh_resultant = "0-";
+ ibutton_code.clear();
+
+ to_sends = to_string(frm_data_received.ids) + ";"+salah_ambil_resultant+";"+salah_taruh_resultant+";~";
+
+ socket.send(to_sends.c_str(), to_sends.length());
+
+ to_sends = "";
+ LCD_Step_4 = 0;
+
+ step = 0;
+
+ if(frm_data_received.ids == 3) {
+ dsp.step4(to_string(frm_data_received._key_id).c_str(),false);
+ } else if(frm_data_received.ids == 1) {
+ dsp.step0();
+ }
+ } else {
+ real_blink_id_1 = 64;
+ real_blink_id_2 = 64;
+ real_blink_id_3 = 64;
+ real_blink_id_4 = 64;
+ real_blink_id_5 = 64;
+ blinking_now = 0;
+
+ if(LCD_Step_4 == 0) {
+ if(frm_data_received.ids== 1) {
+ dsp.step2(to_string(frm_data_received._key_id).c_str());
+ wait(1);
+ LCD_Step_4 = 1;
+ } else if(frm_data_received.ids == 3) {
+ dsp.step4(to_string(frm_data_received._key_id).c_str(),true);
+ wait(1);
+ LCD_Step_4 = 1;
+ }
+ }
+ }
+ }
+
+ }
+ break;
+ }
+ }
+ }
+}
+
+int main()
+{
+ //serial_rx_tick.attach(&RS485_Recv,0.01);
+ TCP_Cek_Data_Last_Sent = "2;0-;0-;~";
+ ids = 0;
+ board_sum = 5;
+ wait(0.01);
+ dsp.init();
+
+ thd_Cek_Ibutton.start(Cek_Ibutton);
+ thd_Buzzer.start(Cek_Salah_Buzzer);
+ //thd_LCD.start(Cek_LCD_State);
+ //thd_RS485_Recv.start(RS485_Recv);
+
+ FindingServer();
+}
+
+string Byte_to_StringBinary(byte data_byte)
+{
+ string data_temp;
+ for(uint8_t i = 0; i <8; i++) {
+ if((data_byte>>i)&0x01) {
+ data_temp[abs(i-7)] += '1';
+ } else data_temp[abs(i-7)] += '0';
+ }
+ return data_temp;
+}
+
+uint8_t StringBinary_to_Byte(string data_binary)
+{
+ uint8_t data_temp = 0;
+ bitset<8> b(data_binary);
+ unsigned char c = ( b.to_ulong() & 0xFF);
+ data_temp = static_cast<uint8_t>(c);
+
+ return data_temp;
+}
+
+uint8_t Get_Row(uint8_t key_id)
+{
+ uint8_t data_temp = 0;
+
+ data_temp = key_id/(board_sum*8);
+
+ return data_temp;
+}
+
+unsigned short Get_CRC_Modbus(byte data_byte[])
+{
+ unsigned short data_temp;
+
+ data_temp = calculate_crc16_Modbus(reinterpret_cast<char*>(data_byte), 6);
+
+ return data_temp;
+}
+byte to_send[6] = {0x00,0x03,0x14,0x15,0x01,0x00};
+void Send_RS485(uint8_t board,uint8_t key_id,uint8_t key_id_blinking,bool Cek_Respon)
+{
+ to_send[0] = board+1;
+ to_send[2] = key_id;
+ to_send[3] = key_id_blinking;
+ //printf("Calculating crc : ");
+ unsigned short __crc = Get_CRC_Modbus(to_send);
+
+ //printf("%02X\r\n",__crc);
+ memcpy(buffer_crc,(unsigned char*)&(__crc),sizeof(short));
+ byte _eof = 0x0D;
+
+ byte all_to_send[9];
+
+ all_to_send[0] = board+1;
+ all_to_send[1] = to_send[1];
+ all_to_send[2] = to_send[2];
+ all_to_send[3] = to_send[3];
+ all_to_send[4] = to_send[4];
+ all_to_send[5] = to_send[5];
+ all_to_send[6] = buffer_crc[1];
+ all_to_send[7] = buffer_crc[0];
+ all_to_send[8] = _eof;
+
+Resend:
+
+ printf("Data recv : ");
+ for(uint8_t i = 0; i<15; i++) {
+ printf("%02X ",respon_from_slave[i]);
+ }
+ printf("\r\n");
+ wait(0.05);
+ rede = 1;
+ for(uint8_t i = 0; i<9; i++) {
+ dv.putc(all_to_send[i]);
+ }
+
+ if(Cek_Respon) printf("Send Complete to %d\r\n",board+1);
+
+ if(!Cek_Respon) {
+ intr_Done = true;
+ } else {
+ //printf("Trying to received%d..\r\n",board+1);
+ memset(respon_from_slave, 0, sizeof respon_from_slave);
+ intr_Done = false;
+ ids = 0;
+ rede = 0;
+
+ while(!intr_Done) {
+ while(dv.readable()) {
+
+ char tempbuf = dv.getc();
+ if(ids == 0 && tempbuf == 0xFF) {
+
+ } else {
+ respon_from_slave[ids] = tempbuf;
+ ids++;
+ }
+ }
+ if((respon_from_slave[0] == board+1) && (respon_from_slave[14] == 0x0D)) intr_Done = true;
+ else goto Resend;
+ }
+ }
+}
+
+
+void Cek_Ibutton()
+{
+ while(1) {
+ ibutton.DetectiButton();
+ if(ibutton.IsTaping())
+ tap = true;
+ else
+ tap = false;
+
+ if(tap != lasttap) {
+ lasttap = tap;
+ if(tap) {
+ string dataButton;
+
+ dataButton.clear();
+ dataButton = ibutton.GetData();
+ if(dataButton.length()== 12) {
+ ibutton_code = dataButton;
+ printf("[Data Button : %s]\r\n", dataButton.c_str());
+ }
+ }
+ }
+ }
+}
+
+void Cek_Salah_Buzzer()
+{
+ while(1) {
+ if(real_blink_id_1 != 64 || real_blink_id_2 != 64 || real_blink_id_3 != 64 || real_blink_id_4 != 64|| real_blink_id_5 != 64) {
+ buzz.play(3);
+ }
+ wait(0.2);
+ }
+}
+
+void Cek_LCD_State()
+{
+ while(1) {
+
+ if(LCD_Step == 0) {
+ wait_ms(500);
+ if((step == 0 || step == 4) && blinking_now != 0) {
+ dsp.step5(to_string(blinking_now).c_str(),true);
+ wait_ms(500);
+ LCD_Step = 1;
+ } else if(step == 0 && blinking_now == 0) {
+ dsp.step0();
+ LCD_Step = 1;
+ } else if(step == 4 && blinking_now == 0) {
+ dsp.step2(to_string(frm_data_received._key_id).c_str());
+ LCD_Step = 1;
+ }
+ }
+ }
+}
+string frames;
+string First_Update()
+{
+ frames.clear();
+
+ for(uint8_t i = 0; i<board_sum; i++) {
+ wait_ms(50);
+ intr_Done = false;
+ ids = 0;
+ bool done = false;
+ waiting_resp = true;
+ Send_RS485(i,64,64,true);
+
+ for(uint8_t a = 4; a<12; a++) {
+ uint8_t temp_id = a;
+ switch(i) {
+ case 0: {
+ Row_Board1_Last[temp_id-4] = respon_from_slave[a];
+ //printf("%02X\r\n",Row_Board1_Last[temp_id-5]);
+ }
+ break;
+ case 1: {
+ Row_Board2_Last[temp_id-4] = respon_from_slave[a];
+ //printf("%02X\r\n",Row_Board2_Last[temp_id-5]);
+ }
+ break;
+ case 2: {
+ Row_Board3_Last[temp_id-4] = respon_from_slave[a];
+ //printf("%02X\r\n",Row_Board3_Last[temp_id-5]);
+ }
+ break;
+ case 3: {
+ Row_Board4_Last[temp_id-4] = respon_from_slave[a];
+ //printf("%02X\r\n",Row_Board4_Last[temp_id-5]);
+ }
+ break;
+ case 4: {
+ Row_Board5_Last[temp_id-4] = respon_from_slave[a];
+ //printf("%02X\r\n",Row_Board5_Last[temp_id-5]);
+ }
+ break;
+ }
+ }
+ }
+ string bin_string;
+ Frame_To_Send.ids = "";
+ Frame_To_Send.key_off = "";
+ Frame_To_Send.key_on = "";
+ string key_ids;
+ for (uint8_t i = 0; i < 5; i++) {
+ for (uint8_t j = 0; j < 8; j++) {
+ string bin_string = "";
+
+ if (i == 0) bin_string = Byte_to_StringBinary(Row_Board1_Last[j]);
+ if (i == 1) bin_string = Byte_to_StringBinary(Row_Board2_Last[j]);
+ if (i == 2) bin_string = Byte_to_StringBinary(Row_Board3_Last[j]);
+ if (i == 3) bin_string = Byte_to_StringBinary(Row_Board4_Last[j]);
+ if (i == 4) bin_string = Byte_to_StringBinary(Row_Board5_Last[j]);
+
+ //printf("board[%d][%d] = %s\r\n",i,j,bin_string.c_str());
+ for (uint8_t k = 0; k < 8; k++) {
+ if (bin_string[abs(k-7)] == '1') {
+ key_ids = to_string((40*j)+k+(8*i)+1);
+ Frame_To_Send.key_on += (key_ids+"-");
+
+ } else {
+ key_ids = to_string((40*j)+k+(8*i)+1);
+ Frame_To_Send.key_off += (key_ids+"-");
+ }
+ }
+ }
+ }
+
+ if(Frame_To_Send.key_on == "") {
+ Frame_To_Send.key_on = "0-";
+ }
+
+ if(Frame_To_Send.key_off == "") {
+ Frame_To_Send.key_off = "0-";
+ }
+ Frame_To_Send.ids = "4";
+
+ frames = Frame_To_Send.ids + ";" + Frame_To_Send.key_on + ";~";
+ printf("Sent First Update : %s\r\n",frames.c_str());
+ return frames;
+}
+string data_bin_pred;
+void Make_Prediction(uint8_t board_numb,uint8_t baris, uint8_t kolom)
+{
+ printf("baris = %d\r\n",baris);
+ printf("kolom = %d\r\n",kolom);
+
+ memcpy(Row_Board1_Predict,Row_Board1_Last,sizeof(Row_Board1_Predict));
+ memcpy(Row_Board2_Predict,Row_Board2_Last,sizeof(Row_Board2_Predict));
+ memcpy(Row_Board3_Predict,Row_Board3_Last,sizeof(Row_Board3_Predict));
+ memcpy(Row_Board4_Predict,Row_Board4_Last,sizeof(Row_Board4_Predict));
+ memcpy(Row_Board5_Predict,Row_Board5_Last,sizeof(Row_Board5_Predict));
+
+ board_numb += 1;
+ if(board_numb == 1) {
+
+ data_bin_pred.clear();
+ data_bin_pred = Byte_to_StringBinary(Row_Board1_Predict[baris]);
+ printf("%s\r\n",data_bin_pred.c_str());
+
+ if(frm_data_received.cmd_id == 1) {
+ data_bin_pred[abs(kolom-7)] = '0';
+ } else if(frm_data_received.cmd_id == 2) {
+ data_bin_pred[abs(kolom-7)] = '1';
+ }
+
+ Row_Board1_Predict[baris] = StringBinary_to_Byte(data_bin_pred.c_str());
+ } else if(board_numb == 2) {
+
+ data_bin_pred.clear();
+ data_bin_pred = Byte_to_StringBinary(Row_Board2_Predict[baris]);
+ printf("%s\r\n",data_bin_pred.c_str());
+
+ if(frm_data_received.cmd_id == 1) {
+ data_bin_pred[abs(kolom-7)] = '0';
+ } else if(frm_data_received.cmd_id == 2) {
+ data_bin_pred[abs(kolom-7)] = '1';
+ }
+
+ Row_Board2_Predict[baris] = StringBinary_to_Byte(data_bin_pred.c_str());
+ } else if(board_numb == 3) {
+ data_bin_pred.clear();
+ data_bin_pred = Byte_to_StringBinary(Row_Board3_Predict[baris]);
+ printf("%s\r\n",data_bin_pred.c_str());
+
+ if(frm_data_received.cmd_id == 1) {
+ data_bin_pred[abs(kolom-7)] = '0';
+ } else if(frm_data_received.cmd_id == 2) {
+ data_bin_pred[abs(kolom-7)] = '1';
+ }
+
+ Row_Board3_Predict[baris] = StringBinary_to_Byte(data_bin_pred.c_str());
+ } else if(board_numb == 4) {
+ data_bin_pred.clear();
+ data_bin_pred = Byte_to_StringBinary(Row_Board4_Predict[baris]);
+ printf("%s\r\n",data_bin_pred.c_str());
+
+ if(frm_data_received.cmd_id == 1) {
+ data_bin_pred[abs(kolom-7)] = '0';
+ } else if(frm_data_received.cmd_id == 2) {
+ data_bin_pred[abs(kolom-7)] = '1';
+ }
+
+ Row_Board4_Predict[baris] = StringBinary_to_Byte(data_bin_pred.c_str());
+ } else if(board_numb == 5) {
+ data_bin_pred.clear();
+ data_bin_pred = Byte_to_StringBinary(Row_Board5_Predict[baris]);
+ printf("%s\r\n",data_bin_pred.c_str());
+
+ if(frm_data_received.cmd_id == 1) {
+ data_bin_pred[abs(kolom-7)] = '0';
+ } else if(frm_data_received.cmd_id == 2) {
+ data_bin_pred[abs(kolom-7)] = '1';
+ }
+
+ Row_Board5_Predict[baris] = StringBinary_to_Byte(data_bin_pred.c_str());
+ }
+}
\ No newline at end of file
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/mbed-os.lib Thu Jul 09 09:04:32 2020 +0000 @@ -0,0 +1,1 @@ +https://github.com/ARMmbed/mbed-os/#5941d1718339116cd12914238ec331c84da3d08f