Grupo T / Mbed 2 deprecated LCD_GT

Código para o menu no LCD

Dependencies:   mbed SDFileSystemSD TextLCD

Fork of TextLCD_HelloWorld2 by Wim Huiskamp

classes.h@45:6701e27510f9, 2018-05-25 (annotated)

Committer:
lucasfontenla
Date:
Fri May 25 15:11:08 2018 +0000
Revision:
45:6701e27510f9
Parent:
33:0149960e95c1
Child:
46:31297622c5d1
Salvar gcode funcionando;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
lucasfontenla 17:0b8e489fac36 1 #define tx PC_10
lucasfontenla 17:0b8e489fac36 2 #define rx PC_11
lucasfontenla 17:0b8e489fac36 3
lucasfontenla 17:0b8e489fac36 4 Serial Mach(tx, rx);
lucasfontenla 28:b3c51076ebe8 5 Timer t;
lucasfontenla 17:0b8e489fac36 6
lucasfontenla 29:558eccdfc079 7 string file_name;
lucasfontenla 29:558eccdfc079 8 vector <string> filenames;
lucasfontenla 29:558eccdfc079 9
lucasfontenla 17:0b8e489fac36 10 class Machine {
lucasfontenla 17:0b8e489fac36 11 int n;
lucasfontenla 17:0b8e489fac36 12 string buffer;
lucasfontenla 17:0b8e489fac36 13 char buffer_char[2];
lucasfontenla 17:0b8e489fac36 14
lucasfontenla 17:0b8e489fac36 15 public:
lucasfontenla 17:0b8e489fac36 16 int debug;
lucasfontenla 17:0b8e489fac36 17
lucasfontenla 17:0b8e489fac36 18 // PUBLIC FUNCTIONS ----------------------------------------------------------------------------------------------------------------------------------------
lucasfontenla 17:0b8e489fac36 19 void move_to(float x, float y, float z, string type, int speed){
lucasfontenla 17:0b8e489fac36 20
lucasfontenla 17:0b8e489fac36 21 }
lucasfontenla 17:0b8e489fac36 22
lucasfontenla 17:0b8e489fac36 23 void move(int x_axis, int y_axis, int z_axis, float pct_speed){
lucasfontenla 17:0b8e489fac36 24 buffer = "";
lucasfontenla 17:0b8e489fac36 25
lucasfontenla 17:0b8e489fac36 26 buffer.append("f");
lucasfontenla 17:0b8e489fac36 27
lucasfontenla 17:0b8e489fac36 28 //buffer.append("X");
lucasfontenla 17:0b8e489fac36 29 n = sprintf(buffer_char, "%d", x_axis);
lucasfontenla 17:0b8e489fac36 30 buffer.append(buffer_char);
lucasfontenla 17:0b8e489fac36 31
lucasfontenla 17:0b8e489fac36 32 //buffer.append("Y");
lucasfontenla 17:0b8e489fac36 33 n = sprintf(buffer_char, "%d", y_axis);
lucasfontenla 17:0b8e489fac36 34 buffer.append(buffer_char);
lucasfontenla 17:0b8e489fac36 35
lucasfontenla 17:0b8e489fac36 36 //buffer.append("Z");
lucasfontenla 17:0b8e489fac36 37 n = sprintf(buffer_char, "%d", z_axis);
lucasfontenla 17:0b8e489fac36 38 buffer.append(buffer_char);
lucasfontenla 17:0b8e489fac36 39
lucasfontenla 17:0b8e489fac36 40 buffer.append("F");
lucasfontenla 17:0b8e489fac36 41 n = sprintf(buffer_char, "%.2f", pct_speed);
lucasfontenla 17:0b8e489fac36 42 buffer.append(buffer_char);
lucasfontenla 17:0b8e489fac36 43
lucasfontenla 17:0b8e489fac36 44 send(buffer);
lucasfontenla 17:0b8e489fac36 45 }
lucasfontenla 17:0b8e489fac36 46
lucasfontenla 17:0b8e489fac36 47 void save_point(int mode, float pct_speed){
lucasfontenla 17:0b8e489fac36 48 buffer = "";
lucasfontenla 17:0b8e489fac36 49
lucasfontenla 17:0b8e489fac36 50 buffer.append("s");
lucasfontenla 17:0b8e489fac36 51
lucasfontenla 17:0b8e489fac36 52 n = sprintf(buffer_char, "M%d", mode);
lucasfontenla 17:0b8e489fac36 53 buffer.append(buffer_char);
lucasfontenla 17:0b8e489fac36 54
lucasfontenla 17:0b8e489fac36 55 n = sprintf(buffer_char, "F%.2f", pct_speed);
lucasfontenla 17:0b8e489fac36 56 buffer.append(buffer_char);
lucasfontenla 17:0b8e489fac36 57
lucasfontenla 17:0b8e489fac36 58 send(buffer);
lucasfontenla 17:0b8e489fac36 59 }
lucasfontenla 17:0b8e489fac36 60
lucasfontenla 17:0b8e489fac36 61 void start_program(void){
claraluques 20:ccbd80b668ce 62 send("b");
claraluques 20:ccbd80b668ce 63 printf("b\n\r");
lucasfontenla 17:0b8e489fac36 64 }
lucasfontenla 17:0b8e489fac36 65
lucasfontenla 17:0b8e489fac36 66 void cancel_program(void){
lucasfontenla 17:0b8e489fac36 67 send("c");
lucasfontenla 17:0b8e489fac36 68 }
lucasfontenla 17:0b8e489fac36 69
lucasfontenla 17:0b8e489fac36 70 void get_status(void){
lucasfontenla 17:0b8e489fac36 71 send("s");
lucasfontenla 17:0b8e489fac36 72 }
lucasfontenla 17:0b8e489fac36 73
lucasfontenla 17:0b8e489fac36 74 void machine_zero(void){
claraluques 26:59081efdce79 75 send("zm");
lucasfontenla 17:0b8e489fac36 76 }
lucasfontenla 17:0b8e489fac36 77
lucasfontenla 17:0b8e489fac36 78 void set_zero(string axis){
claraluques 27:83d2a710cc2f 79 buffer = "";
lucasfontenla 17:0b8e489fac36 80 buffer.append("z");
lucasfontenla 17:0b8e489fac36 81 buffer+=axis;
lucasfontenla 17:0b8e489fac36 82 send(buffer);
lucasfontenla 17:0b8e489fac36 83 }
lucasfontenla 17:0b8e489fac36 84
claraluques 19:2c890ae2d187 85 void jog(void){
claraluques 19:2c890ae2d187 86 send("j");
claraluques 20:ccbd80b668ce 87 printf("j\n\r");
claraluques 19:2c890ae2d187 88 }
claraluques 19:2c890ae2d187 89
claraluques 20:ccbd80b668ce 90 void kill_jog(void){
claraluques 20:ccbd80b668ce 91 send("jk");
claraluques 20:ccbd80b668ce 92 printf("jk\n\r");
claraluques 20:ccbd80b668ce 93 }
claraluques 20:ccbd80b668ce 94
claraluques 26:59081efdce79 95 void reset (void){
claraluques 26:59081efdce79 96 send("r");
claraluques 26:59081efdce79 97 }
claraluques 26:59081efdce79 98
lucasfontenla 28:b3c51076ebe8 99 void upload_gcode(string gcode){
lucasfontenla 28:b3c51076ebe8 100 buffer = "";
lucasfontenla 28:b3c51076ebe8 101 buffer.append("u");
lucasfontenla 28:b3c51076ebe8 102 buffer.append(gcode);
lucasfontenla 28:b3c51076ebe8 103
lucasfontenla 28:b3c51076ebe8 104 send(buffer);
lucasfontenla 28:b3c51076ebe8 105 }
claraluques 20:ccbd80b668ce 106
lucasfontenla 29:558eccdfc079 107 void get_saved_points(void){
lucasfontenla 29:558eccdfc079 108 send("l");
lucasfontenla 29:558eccdfc079 109 }
lucasfontenla 29:558eccdfc079 110
lucasfontenla 17:0b8e489fac36 111 private:
lucasfontenla 17:0b8e489fac36 112
lucasfontenla 17:0b8e489fac36 113 // PRIVATE FUNCTIONS ----------------------------------------------------------------------------------------------------------------------------------------
lucasfontenla 17:0b8e489fac36 114 void send(string msg){
lucasfontenla 17:0b8e489fac36 115 msg.append("x");
lucasfontenla 17:0b8e489fac36 116
lucasfontenla 17:0b8e489fac36 117 for(int i = 0; i < msg.length(); i++){
lucasfontenla 17:0b8e489fac36 118 Mach.putc(msg[i]);
claraluques 20:ccbd80b668ce 119 wait_ms(20);
lucasfontenla 17:0b8e489fac36 120 }
lucasfontenla 17:0b8e489fac36 121 }
claraluques 18:5338b83b4de9 122 };
claraluques 18:5338b83b4de9 123
claraluques 18:5338b83b4de9 124
lucasfontenla 28:b3c51076ebe8 125 Machine machine;
lucasfontenla 28:b3c51076ebe8 126
lucasfontenla 28:b3c51076ebe8 127 SDFileSystem sd(PB_15, PB_14, PB_13, PB_1, "sd"); //MOSI - D4, MISO - D5, SCLK - D3, CS - D7
lucasfontenla 28:b3c51076ebe8 128 DIR *dp;
lucasfontenla 28:b3c51076ebe8 129
lucasfontenla 29:558eccdfc079 130 string folderString = "Programas";
lucasfontenla 28:b3c51076ebe8 131
lucasfontenla 28:b3c51076ebe8 132 class SDCard{
lucasfontenla 28:b3c51076ebe8 133 public:
lucasfontenla 28:b3c51076ebe8 134 int save_GCODE(string name, string gcode){
lucasfontenla 45:6701e27510f9 135 printf("Saving: %s\n\r", name);
lucasfontenla 45:6701e27510f9 136 printf("Code: %s\n\r", gcode);
lucasfontenla 45:6701e27510f9 137
lucasfontenla 29:558eccdfc079 138 string file_path = "/sd/" + folderString + "/" + name;
lucasfontenla 28:b3c51076ebe8 139 char * path = str_to_char(file_path);
lucasfontenla 28:b3c51076ebe8 140
lucasfontenla 28:b3c51076ebe8 141 printf(path);
lucasfontenla 28:b3c51076ebe8 142
lucasfontenla 28:b3c51076ebe8 143 printf("going...\n\r");
lucasfontenla 28:b3c51076ebe8 144
lucasfontenla 28:b3c51076ebe8 145 FILE *fp = fopen(path, "w");
lucasfontenla 28:b3c51076ebe8 146
lucasfontenla 28:b3c51076ebe8 147 if(fp == NULL) {
lucasfontenla 28:b3c51076ebe8 148 error("Could not open file for write\n\r");
lucasfontenla 28:b3c51076ebe8 149 return 0;
lucasfontenla 28:b3c51076ebe8 150 }
lucasfontenla 28:b3c51076ebe8 151
lucasfontenla 28:b3c51076ebe8 152 char * write_file = str_to_char(gcode);
lucasfontenla 28:b3c51076ebe8 153
lucasfontenla 28:b3c51076ebe8 154 fprintf(fp, write_file);
lucasfontenla 28:b3c51076ebe8 155 fclose(fp);
lucasfontenla 28:b3c51076ebe8 156
lucasfontenla 28:b3c51076ebe8 157 printf("Cool\n\r");
lucasfontenla 28:b3c51076ebe8 158
lucasfontenla 28:b3c51076ebe8 159 return 1;
lucasfontenla 28:b3c51076ebe8 160 }
lucasfontenla 28:b3c51076ebe8 161
lucasfontenla 28:b3c51076ebe8 162 int send_gcode(string name){
lucasfontenla 29:558eccdfc079 163 string file_path = "/sd/" + folderString + "/" + name;
lucasfontenla 28:b3c51076ebe8 164 char * path = str_to_char(file_path);
lucasfontenla 28:b3c51076ebe8 165 unsigned char c;
lucasfontenla 28:b3c51076ebe8 166 string buffer;
lucasfontenla 28:b3c51076ebe8 167
lucasfontenla 28:b3c51076ebe8 168 printf(path);
lucasfontenla 28:b3c51076ebe8 169
lucasfontenla 28:b3c51076ebe8 170 printf("going...\n\r");
lucasfontenla 28:b3c51076ebe8 171
lucasfontenla 28:b3c51076ebe8 172 FILE *fp = fopen(path, "r");
lucasfontenla 28:b3c51076ebe8 173
lucasfontenla 28:b3c51076ebe8 174 if(fp == NULL) {
lucasfontenla 28:b3c51076ebe8 175 error("Could not open file for write\n\r");
lucasfontenla 28:b3c51076ebe8 176 return 0;
lucasfontenla 28:b3c51076ebe8 177 }
lucasfontenla 28:b3c51076ebe8 178
lucasfontenla 28:b3c51076ebe8 179 t.start();
lucasfontenla 28:b3c51076ebe8 180
lucasfontenla 28:b3c51076ebe8 181 while(1){
lucasfontenla 29:558eccdfc079 182 if(t.read() > 4.0){
lucasfontenla 28:b3c51076ebe8 183 fclose(fp);
lucasfontenla 28:b3c51076ebe8 184 return 0;
lucasfontenla 28:b3c51076ebe8 185 }
lucasfontenla 28:b3c51076ebe8 186 c = fgetc(fp);
lucasfontenla 28:b3c51076ebe8 187 printf("%c\n\r", c);
lucasfontenla 28:b3c51076ebe8 188 buffer.push_back(c);
lucasfontenla 28:b3c51076ebe8 189
lucasfontenla 28:b3c51076ebe8 190 if(c == ';'){
lucasfontenla 28:b3c51076ebe8 191 fclose(fp);
lucasfontenla 28:b3c51076ebe8 192 break;
lucasfontenla 28:b3c51076ebe8 193 }
lucasfontenla 28:b3c51076ebe8 194 }
lucasfontenla 28:b3c51076ebe8 195 fclose(fp);
lucasfontenla 28:b3c51076ebe8 196
lucasfontenla 28:b3c51076ebe8 197 printf("%s\n\r", buffer);
lucasfontenla 28:b3c51076ebe8 198
lucasfontenla 28:b3c51076ebe8 199 machine.upload_gcode(buffer);
lucasfontenla 28:b3c51076ebe8 200 return 1;
lucasfontenla 28:b3c51076ebe8 201 }
lucasfontenla 28:b3c51076ebe8 202
lucasfontenla 28:b3c51076ebe8 203 int check_name_available(string name){
lucasfontenla 45:6701e27510f9 204 printf("Checking name...\r\n");
lucasfontenla 29:558eccdfc079 205 string file_path = "/sd/" + folderString;
lucasfontenla 28:b3c51076ebe8 206 char * dir = str_to_char(file_path);
lucasfontenla 28:b3c51076ebe8 207 struct dirent *dirp;
lucasfontenla 28:b3c51076ebe8 208 string filename;
lucasfontenla 28:b3c51076ebe8 209
lucasfontenla 28:b3c51076ebe8 210 printf(dir);
lucasfontenla 28:b3c51076ebe8 211
lucasfontenla 28:b3c51076ebe8 212 dp = opendir(dir);
lucasfontenla 45:6701e27510f9 213
lucasfontenla 45:6701e27510f9 214 t.reset();
lucasfontenla 29:558eccdfc079 215 t.start();
lucasfontenla 29:558eccdfc079 216
lucasfontenla 28:b3c51076ebe8 217 while((dirp = readdir(dp)) != NULL) {
lucasfontenla 29:558eccdfc079 218 if(t.read() > 2.0){
lucasfontenla 29:558eccdfc079 219 t.stop();
lucasfontenla 29:558eccdfc079 220 closedir(dp);
lucasfontenla 45:6701e27510f9 221 printf("Timeout\r\n");
lucasfontenla 29:558eccdfc079 222 return 0;
lucasfontenla 29:558eccdfc079 223 }
lucasfontenla 28:b3c51076ebe8 224 filename = (dirp->d_name);
lucasfontenla 28:b3c51076ebe8 225 printf("%s\n\r", filename);
lucasfontenla 28:b3c51076ebe8 226 if(filename == name){
lucasfontenla 28:b3c51076ebe8 227 closedir(dp);
lucasfontenla 28:b3c51076ebe8 228 return 0;
lucasfontenla 28:b3c51076ebe8 229 }
lucasfontenla 28:b3c51076ebe8 230 }
lucasfontenla 28:b3c51076ebe8 231 closedir(dp);
lucasfontenla 28:b3c51076ebe8 232 return 1;
lucasfontenla 28:b3c51076ebe8 233 }
lucasfontenla 28:b3c51076ebe8 234
lucasfontenla 29:558eccdfc079 235 int get_file_names(void){
lucasfontenla 29:558eccdfc079 236 string file_path = "/sd/" + folderString;
lucasfontenla 29:558eccdfc079 237 char * dir = str_to_char(file_path);
lucasfontenla 29:558eccdfc079 238 struct dirent *dirp;
lucasfontenla 29:558eccdfc079 239 string filename;
lucasfontenla 29:558eccdfc079 240
lucasfontenla 29:558eccdfc079 241 filenames.empty();
lucasfontenla 29:558eccdfc079 242
lucasfontenla 29:558eccdfc079 243 printf(dir);
lucasfontenla 29:558eccdfc079 244
lucasfontenla 29:558eccdfc079 245 dp = opendir(dir);
lucasfontenla 29:558eccdfc079 246
lucasfontenla 29:558eccdfc079 247 while((dirp = readdir(dp)) != NULL) {
lucasfontenla 29:558eccdfc079 248 filename = (dirp->d_name);
lucasfontenla 29:558eccdfc079 249 printf("%s\n\r", filename);
lucasfontenla 29:558eccdfc079 250 filenames.push_back(filename);
lucasfontenla 29:558eccdfc079 251 }
lucasfontenla 29:558eccdfc079 252 return 1;
lucasfontenla 29:558eccdfc079 253 }
lucasfontenla 29:558eccdfc079 254
lucasfontenla 28:b3c51076ebe8 255 int create_folders(void){
lucasfontenla 29:558eccdfc079 256 int gotFolder = 0;
lucasfontenla 28:b3c51076ebe8 257 string filename;
lucasfontenla 28:b3c51076ebe8 258 struct dirent *dirp;
lucasfontenla 28:b3c51076ebe8 259
lucasfontenla 28:b3c51076ebe8 260 dp = opendir("/sd");
lucasfontenla 28:b3c51076ebe8 261
lucasfontenla 28:b3c51076ebe8 262 t.start();
lucasfontenla 28:b3c51076ebe8 263
lucasfontenla 28:b3c51076ebe8 264 while((dirp = readdir(dp)) != NULL) {
lucasfontenla 28:b3c51076ebe8 265 if(t.read() > 2){
lucasfontenla 28:b3c51076ebe8 266 t.stop();
lucasfontenla 28:b3c51076ebe8 267 return 0;
lucasfontenla 28:b3c51076ebe8 268 }
lucasfontenla 28:b3c51076ebe8 269 filename = (dirp->d_name);
lucasfontenla 28:b3c51076ebe8 270 printf("%s\n\r", filename);
lucasfontenla 29:558eccdfc079 271 if(filename == folderString){
lucasfontenla 29:558eccdfc079 272 gotFolder = 1;
lucasfontenla 29:558eccdfc079 273 }
lucasfontenla 28:b3c51076ebe8 274 }
lucasfontenla 28:b3c51076ebe8 275
lucasfontenla 29:558eccdfc079 276 if(!gotFolder){
lucasfontenla 29:558eccdfc079 277 char * path = str_to_char(("/sd/" + folderString));
lucasfontenla 28:b3c51076ebe8 278 mkdir(path, 0777);
lucasfontenla 28:b3c51076ebe8 279 }
lucasfontenla 28:b3c51076ebe8 280
lucasfontenla 28:b3c51076ebe8 281 closedir(dp);
lucasfontenla 28:b3c51076ebe8 282 return 1;
lucasfontenla 28:b3c51076ebe8 283 }
lucasfontenla 28:b3c51076ebe8 284
lucasfontenla 28:b3c51076ebe8 285 private:
lucasfontenla 28:b3c51076ebe8 286 char * str_to_char(string str){
lucasfontenla 28:b3c51076ebe8 287 char * path = new char[str.length() + 1];
lucasfontenla 28:b3c51076ebe8 288 std::strcpy(path, str.c_str());
lucasfontenla 28:b3c51076ebe8 289 return path;
lucasfontenla 28:b3c51076ebe8 290 }
lucasfontenla 28:b3c51076ebe8 291 };
lucasfontenla 28:b3c51076ebe8 292
lucasfontenla 28:b3c51076ebe8 293 SDCard sdcard;
lucasfontenla 28:b3c51076ebe8 294
claraluques 18:5338b83b4de9 295 //criar classe "menu" (funções para as telas)
claraluques 18:5338b83b4de9 296 class Menu{
claraluques 19:2c890ae2d187 297
claraluques 18:5338b83b4de9 298 public:
claraluques 18:5338b83b4de9 299 int linha;
claraluques 18:5338b83b4de9 300 int func;
claraluques 32:c293f89170b0 301 string nome;
claraluques 23:19c67758032d 302
claraluques 18:5338b83b4de9 303
claraluques 18:5338b83b4de9 304 void movercursor(int min, int max, int col){ //função para mover cursor de seleção
claraluques 18:5338b83b4de9 305 linha = min;
claraluques 18:5338b83b4de9 306 lcd.locate(col,min);
claraluques 18:5338b83b4de9 307 lcd.printf("%c", 0x3E);
claraluques 18:5338b83b4de9 308 while (bot_enter==penter){
claraluques 31:77eb51d4ee18 309 if (bot_cima==0){
claraluques 18:5338b83b4de9 310 if (linha==min){
claraluques 18:5338b83b4de9 311 lcd.locate(col,min);
claraluques 18:5338b83b4de9 312 lcd.printf(" ");
claraluques 18:5338b83b4de9 313 linha=max;
claraluques 18:5338b83b4de9 314 lcd.locate(col, linha);
claraluques 18:5338b83b4de9 315 lcd.printf("%c", 0x3E);
claraluques 18:5338b83b4de9 316 }
claraluques 18:5338b83b4de9 317 else {
claraluques 18:5338b83b4de9 318 lcd.locate(col,linha);
claraluques 18:5338b83b4de9 319 lcd.printf(" ");
claraluques 18:5338b83b4de9 320 linha--;
claraluques 18:5338b83b4de9 321 lcd.locate(col, linha);
claraluques 18:5338b83b4de9 322 lcd.printf("%c", 0x3E);
claraluques 18:5338b83b4de9 323 }
claraluques 31:77eb51d4ee18 324 bot_cima = 1;
claraluques 18:5338b83b4de9 325 }
claraluques 31:77eb51d4ee18 326 else if (bot_baixo==0){
claraluques 18:5338b83b4de9 327 if (linha==max){
claraluques 18:5338b83b4de9 328 lcd.locate(col,max);
claraluques 18:5338b83b4de9 329 lcd.printf(" ");
claraluques 18:5338b83b4de9 330 linha=min;
claraluques 18:5338b83b4de9 331 lcd.locate(col, linha);
claraluques 18:5338b83b4de9 332 lcd.printf("%c", 0x3E);
claraluques 18:5338b83b4de9 333 }
claraluques 18:5338b83b4de9 334 else {
claraluques 18:5338b83b4de9 335 lcd.locate(col,linha);
claraluques 18:5338b83b4de9 336 lcd.printf(" ");
claraluques 18:5338b83b4de9 337 linha++;
claraluques 18:5338b83b4de9 338 lcd.locate(col, linha);
claraluques 18:5338b83b4de9 339 lcd.printf("%c", 0x3E);
claraluques 18:5338b83b4de9 340 }
claraluques 31:77eb51d4ee18 341 bot_baixo = 1;
claraluques 18:5338b83b4de9 342 }
claraluques 33:0149960e95c1 343 }
claraluques 18:5338b83b4de9 344 }
claraluques 32:c293f89170b0 345
claraluques 18:5338b83b4de9 346
claraluques 18:5338b83b4de9 347 //func 0
claraluques 18:5338b83b4de9 348 void inicializar(){ //função tela incial de boas-vindas
claraluques 33:0149960e95c1 349 int status;
claraluques 33:0149960e95c1 350 printf("Starting...\n\r");
claraluques 26:59081efdce79 351 machine.reset();
claraluques 18:5338b83b4de9 352 lcd.cls();
claraluques 18:5338b83b4de9 353 lcd.locate(4,0);
claraluques 18:5338b83b4de9 354 lcd.printf("Bem-vindo(a)");
claraluques 18:5338b83b4de9 355 lcd.locate(0,1);
claraluques 18:5338b83b4de9 356 lcd.printf("Utilize seu EPI para operar a maquina.");
claraluques 33:0149960e95c1 357 wait(1);
claraluques 30:614dcbd74cdc 358 /*status = sdcard.get_file_names();
lucasfontenla 29:558eccdfc079 359 if(status){
lucasfontenla 29:558eccdfc079 360 printf("Filenames: \n\r");
lucasfontenla 29:558eccdfc079 361 for(int i = 0; i < filenames.size(); i++){
lucasfontenla 29:558eccdfc079 362 printf("%s\n\r", filenames[i]);
lucasfontenla 29:558eccdfc079 363 }
claraluques 30:614dcbd74cdc 364 }*/
claraluques 18:5338b83b4de9 365 func = 1;
claraluques 18:5338b83b4de9 366 }
claraluques 18:5338b83b4de9 367
claraluques 18:5338b83b4de9 368 //func 1
claraluques 18:5338b83b4de9 369 void menuprincipal(){ //função menu principal
claraluques 31:77eb51d4ee18 370 bot_enter = penter;
claraluques 18:5338b83b4de9 371 lcd.cls();
claraluques 18:5338b83b4de9 372 lcd.locate(1,0);
claraluques 18:5338b83b4de9 373 lcd.printf("Modo JOG");
claraluques 18:5338b83b4de9 374 lcd.locate(1,1);
claraluques 18:5338b83b4de9 375 lcd.printf("Modo Automatico");
claraluques 18:5338b83b4de9 376 lcd.locate(1,2);
claraluques 26:59081efdce79 377 lcd.printf("Zerar");
claraluques 18:5338b83b4de9 378 lcd.locate(1,3);
claraluques 26:59081efdce79 379 lcd.printf("Config");
claraluques 18:5338b83b4de9 380 movercursor(0,3,0);
claraluques 18:5338b83b4de9 381 if (bot_enter!=penter){
claraluques 18:5338b83b4de9 382 if (linha==0){
claraluques 18:5338b83b4de9 383 func = 2;
claraluques 18:5338b83b4de9 384 }
claraluques 18:5338b83b4de9 385 else if (linha==1) {
claraluques 18:5338b83b4de9 386 func = 3;
claraluques 18:5338b83b4de9 387 }
claraluques 18:5338b83b4de9 388 else if (linha==2) {
claraluques 26:59081efdce79 389 func = 8;
claraluques 18:5338b83b4de9 390 }
claraluques 18:5338b83b4de9 391 else if (linha==3) {
claraluques 26:59081efdce79 392 func = 4;
claraluques 18:5338b83b4de9 393 }
claraluques 18:5338b83b4de9 394 }
claraluques 18:5338b83b4de9 395 }
claraluques 18:5338b83b4de9 396
claraluques 18:5338b83b4de9 397 //func 2
claraluques 18:5338b83b4de9 398 void jog(){ //função tela jog
claraluques 31:77eb51d4ee18 399 lcd.cls();
claraluques 31:77eb51d4ee18 400 bot_enter = penter;
claraluques 20:ccbd80b668ce 401 machine.kill_jog();
claraluques 20:ccbd80b668ce 402 wait(0.1);
claraluques 19:2c890ae2d187 403 machine.jog();
claraluques 18:5338b83b4de9 404 lcd.locate(4,0);
claraluques 33:0149960e95c1 405 lcd.printf("");
claraluques 33:0149960e95c1 406 lcd.locate(6,1);
claraluques 18:5338b83b4de9 407 lcd.printf("Salvar");
claraluques 33:0149960e95c1 408 lcd.locate(6,2);
claraluques 18:5338b83b4de9 409 lcd.printf("Concluir");
claraluques 33:0149960e95c1 410 lcd.locate(6,3);
claraluques 18:5338b83b4de9 411 lcd.printf("Cancelar");
claraluques 33:0149960e95c1 412 movercursor(1,3,5);
claraluques 18:5338b83b4de9 413 if (bot_enter!=penter){
claraluques 20:ccbd80b668ce 414 if (linha==1){
claraluques 33:0149960e95c1 415 if (pontos==0 && maxpontos>10){
claraluques 26:59081efdce79 416 cx_salva = 0;
claraluques 26:59081efdce79 417 cy_salva = 0;
claraluques 26:59081efdce79 418 cz_salva = 0;
claraluques 26:59081efdce79 419 pontos++;
claraluques 26:59081efdce79 420 maxpontos--;
claraluques 33:0149960e95c1 421 func = 22;
claraluques 26:59081efdce79 422 }
claraluques 33:0149960e95c1 423 else if (pontos>=1 && maxpontos>10){
claraluques 18:5338b83b4de9 424 cx_salva = cx;
claraluques 18:5338b83b4de9 425 cy_salva = cy;
claraluques 18:5338b83b4de9 426 cz_salva = cz;
claraluques 33:0149960e95c1 427 pontos++;
claraluques 26:59081efdce79 428 maxpontos--;
claraluques 33:0149960e95c1 429 func = 22;
claraluques 33:0149960e95c1 430 }
claraluques 33:0149960e95c1 431 else if (maxpontos<=10){
claraluques 33:0149960e95c1 432 cx_salva = cx;
claraluques 33:0149960e95c1 433 cy_salva = cy;
claraluques 33:0149960e95c1 434 cz_salva = cz;
claraluques 33:0149960e95c1 435 pontos++;
claraluques 33:0149960e95c1 436 maxpontos--;
claraluques 33:0149960e95c1 437 func = 5;
claraluques 18:5338b83b4de9 438 }
claraluques 26:59081efdce79 439 else if (maxpontos==0){
claraluques 18:5338b83b4de9 440 func = 16;
claraluques 33:0149960e95c1 441 }
claraluques 18:5338b83b4de9 442 }
claraluques 18:5338b83b4de9 443 else if (linha==2) {
claraluques 27:83d2a710cc2f 444 machine.kill_jog();
claraluques 26:59081efdce79 445 func = 17;
claraluques 18:5338b83b4de9 446 }
claraluques 18:5338b83b4de9 447 else if (linha==3) {
claraluques 20:ccbd80b668ce 448 machine.kill_jog();
claraluques 26:59081efdce79 449 wait(0.1);
claraluques 26:59081efdce79 450 machine.cancel_program();
claraluques 18:5338b83b4de9 451 func = 1;
claraluques 18:5338b83b4de9 452 pontos = 10;
claraluques 18:5338b83b4de9 453 }
claraluques 18:5338b83b4de9 454 }
claraluques 18:5338b83b4de9 455 }
claraluques 18:5338b83b4de9 456
claraluques 18:5338b83b4de9 457 //func 3
claraluques 18:5338b83b4de9 458 void automatico(){ //tela modo automatico
claraluques 18:5338b83b4de9 459 lcd.cls();
claraluques 31:77eb51d4ee18 460 bot_enter = penter;
claraluques 18:5338b83b4de9 461 lcd.printf("Modo automatico");
claraluques 18:5338b83b4de9 462 lcd.locate(7,2);
claraluques 18:5338b83b4de9 463 lcd.printf("OK");
claraluques 18:5338b83b4de9 464 lcd.locate(7,3);
claraluques 18:5338b83b4de9 465 lcd.printf("Voltar");
claraluques 18:5338b83b4de9 466 movercursor(2,3,6);
claraluques 18:5338b83b4de9 467 if (bot_enter!=penter) {
claraluques 18:5338b83b4de9 468 if (linha==2){
claraluques 18:5338b83b4de9 469 func = 12;
claraluques 18:5338b83b4de9 470 }
claraluques 18:5338b83b4de9 471 else if (linha==3){
claraluques 18:5338b83b4de9 472 func = 1;
claraluques 18:5338b83b4de9 473 }
claraluques 18:5338b83b4de9 474 }
claraluques 18:5338b83b4de9 475 }
claraluques 18:5338b83b4de9 476
claraluques 18:5338b83b4de9 477 //func 4
claraluques 18:5338b83b4de9 478 void config() {
claraluques 18:5338b83b4de9 479 lcd.cls();
claraluques 31:77eb51d4ee18 480 bot_enter = penter;
claraluques 27:83d2a710cc2f 481 //printf("%d,tela\n\r", penter);
claraluques 18:5338b83b4de9 482 lcd.locate(1,0);
claraluques 18:5338b83b4de9 483 lcd.printf("Definir velocidade");
claraluques 18:5338b83b4de9 484 lcd.locate(1,1);
claraluques 18:5338b83b4de9 485 lcd.printf("Limpar seringa cola");
claraluques 18:5338b83b4de9 486 lcd.locate(1,2);
claraluques 26:59081efdce79 487 lcd.printf("Origem maquina");
claraluques 18:5338b83b4de9 488 lcd.locate(1,3);
claraluques 18:5338b83b4de9 489 lcd.printf("Voltar");
claraluques 18:5338b83b4de9 490 movercursor(0,3,0);
claraluques 18:5338b83b4de9 491 if (bot_enter!=penter){
claraluques 18:5338b83b4de9 492 if (linha==0) {
claraluques 18:5338b83b4de9 493 func = 13;
claraluques 18:5338b83b4de9 494 }
claraluques 18:5338b83b4de9 495 else if (linha==1) {
claraluques 18:5338b83b4de9 496 func = 14;
claraluques 18:5338b83b4de9 497 }
claraluques 18:5338b83b4de9 498 else if (linha==2) {
claraluques 27:83d2a710cc2f 499 home = 1;
claraluques 27:83d2a710cc2f 500 func = 18;
claraluques 18:5338b83b4de9 501 }
claraluques 18:5338b83b4de9 502 else if (linha==3) {
claraluques 18:5338b83b4de9 503 func = 1;
claraluques 18:5338b83b4de9 504 }
claraluques 18:5338b83b4de9 505 }
claraluques 18:5338b83b4de9 506 }
claraluques 18:5338b83b4de9 507
claraluques 18:5338b83b4de9 508 //func 5
claraluques 18:5338b83b4de9 509 void telasalvamento(){ //função para quando salvar um ponto
claraluques 18:5338b83b4de9 510 lcd.cls();
claraluques 18:5338b83b4de9 511 lcd.locate(0,0);
claraluques 18:5338b83b4de9 512 lcd.printf("Voce salvou");
claraluques 18:5338b83b4de9 513 lcd.locate(1,1);
claraluques 25:af1f99666ca9 514 lcd.printf("X:%.2f ", cx_salva);
claraluques 18:5338b83b4de9 515 lcd.locate(1,2);
claraluques 25:af1f99666ca9 516 lcd.printf("Y:%.2f ", cy_salva);
claraluques 18:5338b83b4de9 517 lcd.locate(1,3);
claraluques 25:af1f99666ca9 518 lcd.printf("Z:%.2f ", cz_salva);
claraluques 18:5338b83b4de9 519 lcd.locate(13,1);
claraluques 18:5338b83b4de9 520 lcd.printf("Pontos");
claraluques 18:5338b83b4de9 521 lcd.locate(13,2);
claraluques 18:5338b83b4de9 522 lcd.printf("livres");
claraluques 18:5338b83b4de9 523 lcd.locate(16,3);
claraluques 26:59081efdce79 524 lcd.printf("%d", maxpontos);
claraluques 18:5338b83b4de9 525 wait(1);
claraluques 18:5338b83b4de9 526 if (pontos>0){
claraluques 18:5338b83b4de9 527 func = 6;
claraluques 18:5338b83b4de9 528 }
claraluques 18:5338b83b4de9 529 else if (pontos==0){
claraluques 18:5338b83b4de9 530 func = 2;
claraluques 18:5338b83b4de9 531 }
claraluques 18:5338b83b4de9 532 }
claraluques 18:5338b83b4de9 533
claraluques 18:5338b83b4de9 534 //func 6
claraluques 18:5338b83b4de9 535 void telacola(){ //tela para escolher o tipo de sequencia da cola
claraluques 18:5338b83b4de9 536 lcd.cls();
claraluques 31:77eb51d4ee18 537 bot_enter = penter;
claraluques 18:5338b83b4de9 538 lcd.printf("P/ o proximo ponto:");
claraluques 18:5338b83b4de9 539 lcd.locate(3,1);
claraluques 18:5338b83b4de9 540 lcd.printf("Sem cola");
claraluques 18:5338b83b4de9 541 lcd.locate(3,2);
claraluques 18:5338b83b4de9 542 lcd.printf("Cola no ponto");
claraluques 18:5338b83b4de9 543 lcd.locate(3,3);
claraluques 18:5338b83b4de9 544 lcd.printf("Cola continua");
claraluques 18:5338b83b4de9 545 movercursor(1,3,2);
claraluques 18:5338b83b4de9 546 if (bot_enter!=penter){
claraluques 18:5338b83b4de9 547 if (linha==1){
claraluques 18:5338b83b4de9 548 cola = 0;
claraluques 18:5338b83b4de9 549 func = 2;
claraluques 18:5338b83b4de9 550 }
claraluques 18:5338b83b4de9 551 else if (linha==2) {
claraluques 18:5338b83b4de9 552 cola = 1;
claraluques 18:5338b83b4de9 553 func = 2;
claraluques 18:5338b83b4de9 554 }
claraluques 18:5338b83b4de9 555 else if (linha==3) {
claraluques 18:5338b83b4de9 556 cola = 2;
claraluques 18:5338b83b4de9 557 func = 2;
claraluques 18:5338b83b4de9 558 }
lucasfontenla 45:6701e27510f9 559 machine.save_point(cola,1.0);
claraluques 18:5338b83b4de9 560 }
claraluques 18:5338b83b4de9 561 }
claraluques 18:5338b83b4de9 562
claraluques 18:5338b83b4de9 563 //func 7
claraluques 18:5338b83b4de9 564 void executarprograma() { //tela para selecionar se deseja executar o programa
claraluques 18:5338b83b4de9 565 lcd.cls();
claraluques 31:77eb51d4ee18 566 bot_enter = penter;
claraluques 18:5338b83b4de9 567 lcd.locate(2,0);
claraluques 18:5338b83b4de9 568 lcd.printf("VOCE CONCLUIU SEU");
claraluques 18:5338b83b4de9 569 lcd.locate(5,1);
claraluques 18:5338b83b4de9 570 lcd.printf("PROGRAMA.");
claraluques 18:5338b83b4de9 571 lcd.locate(0,2);
claraluques 18:5338b83b4de9 572 lcd.printf("Deseja");
claraluques 18:5338b83b4de9 573 lcd.locate(0,3);
claraluques 18:5338b83b4de9 574 lcd.printf("executa-lo?");
claraluques 18:5338b83b4de9 575 lcd.locate(14,2);
claraluques 18:5338b83b4de9 576 lcd.printf("Sim");
claraluques 18:5338b83b4de9 577 lcd.locate(14,3);
claraluques 18:5338b83b4de9 578 lcd.printf("Voltar");
claraluques 18:5338b83b4de9 579 movercursor(2,3,13);
claraluques 18:5338b83b4de9 580 if (bot_enter!=penter) {
claraluques 18:5338b83b4de9 581 if (linha==2){
claraluques 21:7603fe283ba4 582 machine.kill_jog();
claraluques 21:7603fe283ba4 583 wait(0.1);
claraluques 27:83d2a710cc2f 584 //machine.start_program();
claraluques 18:5338b83b4de9 585 exec = 1;
claraluques 18:5338b83b4de9 586 func = 9;
claraluques 18:5338b83b4de9 587 }
claraluques 18:5338b83b4de9 588 else if (linha==3){
claraluques 18:5338b83b4de9 589 exec = 0;
claraluques 18:5338b83b4de9 590 func = 2;
claraluques 18:5338b83b4de9 591 }
claraluques 18:5338b83b4de9 592 }
claraluques 18:5338b83b4de9 593 }
claraluques 18:5338b83b4de9 594
claraluques 18:5338b83b4de9 595 //func 8
claraluques 18:5338b83b4de9 596 void telazerar(){ //tela para zerar a máquina
claraluques 18:5338b83b4de9 597 lcd.cls();
claraluques 31:77eb51d4ee18 598 bot_enter = penter;
claraluques 26:59081efdce79 599 machine.kill_jog();
claraluques 26:59081efdce79 600 machine.jog();
claraluques 18:5338b83b4de9 601 lcd.locate(2,0);
claraluques 19:2c890ae2d187 602 lcd.printf("Zerar:");
claraluques 19:2c890ae2d187 603 lcd.locate(0,1);
claraluques 19:2c890ae2d187 604 lcd.printf("X:");
claraluques 19:2c890ae2d187 605 lcd.locate(0,2);
claraluques 19:2c890ae2d187 606 lcd.printf("Y:");
claraluques 19:2c890ae2d187 607 lcd.locate(0,3);
claraluques 19:2c890ae2d187 608 lcd.printf("Z:");
claraluques 19:2c890ae2d187 609 lcd.locate(13,0);
claraluques 19:2c890ae2d187 610 lcd.printf("X");
claraluques 19:2c890ae2d187 611 lcd.locate(13,1);
claraluques 19:2c890ae2d187 612 lcd.printf("Y");
claraluques 19:2c890ae2d187 613 lcd.locate(13,2);
claraluques 19:2c890ae2d187 614 lcd.printf("Z");
claraluques 19:2c890ae2d187 615 lcd.locate(13,3);
claraluques 19:2c890ae2d187 616 lcd.printf("Voltar");
claraluques 19:2c890ae2d187 617 movercursor(0,3,12);
claraluques 18:5338b83b4de9 618 if (bot_enter!=penter) {
claraluques 19:2c890ae2d187 619 if (linha==0){
claraluques 18:5338b83b4de9 620 cx = 0;
claraluques 19:2c890ae2d187 621 func = 10;
claraluques 19:2c890ae2d187 622 machine.set_zero("X");
claraluques 19:2c890ae2d187 623 }
claraluques 19:2c890ae2d187 624 else if (linha==1){
claraluques 18:5338b83b4de9 625 cy = 0;
claraluques 19:2c890ae2d187 626 func = 10;
claraluques 19:2c890ae2d187 627 machine.set_zero("Y");
claraluques 19:2c890ae2d187 628 }
claraluques 19:2c890ae2d187 629 else if (linha==2){
claraluques 18:5338b83b4de9 630 cz = 0;
claraluques 18:5338b83b4de9 631 func = 10;
claraluques 19:2c890ae2d187 632 machine.set_zero("Z");
claraluques 18:5338b83b4de9 633 }
claraluques 18:5338b83b4de9 634 else if (linha==3){
claraluques 18:5338b83b4de9 635 func = 1;
claraluques 26:59081efdce79 636 machine.kill_jog();
claraluques 18:5338b83b4de9 637 }
claraluques 18:5338b83b4de9 638 }
claraluques 18:5338b83b4de9 639 }
claraluques 18:5338b83b4de9 640
claraluques 18:5338b83b4de9 641 //func 9
claraluques 18:5338b83b4de9 642 void executando(){ //tela de executando
claraluques 18:5338b83b4de9 643 lcd.cls();
claraluques 27:83d2a710cc2f 644 machine.start_program();
claraluques 18:5338b83b4de9 645 lcd.locate(4,1);
claraluques 18:5338b83b4de9 646 lcd.printf("Executando");
claraluques 27:83d2a710cc2f 647 while (exec == 1){
claraluques 27:83d2a710cc2f 648 if (Mach.readable()){
claraluques 27:83d2a710cc2f 649 readSerial();
claraluques 27:83d2a710cc2f 650 }/*
claraluques 18:5338b83b4de9 651 lcd.locate(14,1);
claraluques 18:5338b83b4de9 652 lcd.printf(". ");
claraluques 18:5338b83b4de9 653 wait(0.5);
claraluques 18:5338b83b4de9 654 lcd.locate(14,1);
claraluques 18:5338b83b4de9 655 lcd.printf(".. ");
claraluques 18:5338b83b4de9 656 wait(0.5);
claraluques 18:5338b83b4de9 657 lcd.locate(14,1);
claraluques 18:5338b83b4de9 658 lcd.printf("...");
claraluques 18:5338b83b4de9 659 wait(0.5);
claraluques 18:5338b83b4de9 660 lcd.locate(14,1);
claraluques 18:5338b83b4de9 661 lcd.printf(" ");
claraluques 27:83d2a710cc2f 662 wait(0.5);*/
claraluques 18:5338b83b4de9 663 }
claraluques 27:83d2a710cc2f 664 printf("saiu\n\r");
claraluques 27:83d2a710cc2f 665 func = 11;
claraluques 18:5338b83b4de9 666 }
claraluques 18:5338b83b4de9 667
claraluques 18:5338b83b4de9 668 //func 10
claraluques 18:5338b83b4de9 669 void zerado() { //tela avisando que a máquina foi zerada
claraluques 18:5338b83b4de9 670 lcd.cls();
claraluques 18:5338b83b4de9 671 lcd.locate(5,1);
claraluques 18:5338b83b4de9 672 lcd.printf("Voce zerou");
claraluques 19:2c890ae2d187 673 lcd.locate(6,2);
claraluques 19:2c890ae2d187 674 lcd.printf("o eixo!");
claraluques 18:5338b83b4de9 675 wait(1);
claraluques 18:5338b83b4de9 676 func = 8;
claraluques 18:5338b83b4de9 677 }
claraluques 18:5338b83b4de9 678
claraluques 18:5338b83b4de9 679 //func 11
claraluques 18:5338b83b4de9 680 void finalizado() { //tela aviso programa finalizado
claraluques 18:5338b83b4de9 681 lcd.cls();
claraluques 18:5338b83b4de9 682 lcd.locate(6,1);
claraluques 18:5338b83b4de9 683 lcd.printf("PROGRAMA");
claraluques 18:5338b83b4de9 684 lcd.locate(5,2);
claraluques 18:5338b83b4de9 685 lcd.printf("FINALIZADO");
claraluques 18:5338b83b4de9 686 wait(1);
claraluques 18:5338b83b4de9 687 func = 1;
claraluques 18:5338b83b4de9 688 }
claraluques 18:5338b83b4de9 689
claraluques 18:5338b83b4de9 690 //func 12
claraluques 18:5338b83b4de9 691
claraluques 18:5338b83b4de9 692 //func 13
claraluques 18:5338b83b4de9 693
claraluques 18:5338b83b4de9 694 //func 14
claraluques 18:5338b83b4de9 695
claraluques 18:5338b83b4de9 696 //func 15
claraluques 27:83d2a710cc2f 697 void gohome(){
claraluques 27:83d2a710cc2f 698 lcd.cls();
claraluques 27:83d2a710cc2f 699 machine.machine_zero();
claraluques 27:83d2a710cc2f 700 while (home == 1){
claraluques 27:83d2a710cc2f 701 if (Mach.readable()){
claraluques 27:83d2a710cc2f 702 readSerial();
claraluques 27:83d2a710cc2f 703 }
claraluques 27:83d2a710cc2f 704 }
claraluques 27:83d2a710cc2f 705 func = 19;
claraluques 27:83d2a710cc2f 706 }
claraluques 18:5338b83b4de9 707
claraluques 18:5338b83b4de9 708 //func 16
claraluques 18:5338b83b4de9 709 void limitepontos(){ //tela para quando acabam os pontos
claraluques 18:5338b83b4de9 710 lcd.cls();
claraluques 26:59081efdce79 711 lcd.printf(" Voce atingiu o n%c maximo de pontos", 0xDF);
claraluques 26:59081efdce79 712 lcd.locate(9,2);
claraluques 26:59081efdce79 713 lcd.printf("(%d)", pontos);
claraluques 18:5338b83b4de9 714 lcd.locate(0,3);
claraluques 18:5338b83b4de9 715 lcd.printf("Conclua seu programa");
claraluques 18:5338b83b4de9 716 wait(1);
claraluques 18:5338b83b4de9 717 func = 2;
claraluques 21:7603fe283ba4 718 }
claraluques 26:59081efdce79 719
claraluques 26:59081efdce79 720 //func 17
claraluques 26:59081efdce79 721 void salvarprog(){
claraluques 26:59081efdce79 722 lcd.cls();
claraluques 31:77eb51d4ee18 723 bot_enter = penter;
claraluques 30:614dcbd74cdc 724 lcd.printf("Voce deseja salvar este programa?");
claraluques 26:59081efdce79 725 lcd.locate(5,2);
claraluques 26:59081efdce79 726 lcd.printf("Sim");
claraluques 26:59081efdce79 727 lcd.locate(5,3);
claraluques 26:59081efdce79 728 lcd.printf("Nao");
claraluques 26:59081efdce79 729 movercursor(2,3,4);
claraluques 26:59081efdce79 730 if (bot_enter!=penter){
claraluques 26:59081efdce79 731 if (linha==2){
claraluques 26:59081efdce79 732 salvar = 1;
claraluques 32:c293f89170b0 733 //printf("salvar\n\r");
claraluques 31:77eb51d4ee18 734 func = 20;
claraluques 26:59081efdce79 735 }
claraluques 26:59081efdce79 736 if (linha==3){
claraluques 26:59081efdce79 737 salvar = 0;
claraluques 31:77eb51d4ee18 738 func = 7;
claraluques 26:59081efdce79 739 }
claraluques 26:59081efdce79 740 }
claraluques 26:59081efdce79 741 }
claraluques 27:83d2a710cc2f 742
claraluques 27:83d2a710cc2f 743 //func 18
claraluques 27:83d2a710cc2f 744 void ctzhome(){
claraluques 27:83d2a710cc2f 745 lcd.cls();
claraluques 31:77eb51d4ee18 746 bot_enter = penter;
claraluques 27:83d2a710cc2f 747 lcd.printf("Certifique-se de que a maquina pode se");
claraluques 27:83d2a710cc2f 748 lcd.locate(5,2);
claraluques 27:83d2a710cc2f 749 lcd.printf("movimentar");
claraluques 27:83d2a710cc2f 750 lcd.locate(9,3);
claraluques 27:83d2a710cc2f 751 lcd.printf("OK");
claraluques 27:83d2a710cc2f 752 movercursor(3,3,8);
claraluques 27:83d2a710cc2f 753 if (bot_enter!=penter){
claraluques 27:83d2a710cc2f 754 if (linha==3){
claraluques 27:83d2a710cc2f 755 func = 15;
claraluques 27:83d2a710cc2f 756 }
claraluques 27:83d2a710cc2f 757 }
claraluques 27:83d2a710cc2f 758 }
claraluques 27:83d2a710cc2f 759
claraluques 27:83d2a710cc2f 760 //func 19
claraluques 27:83d2a710cc2f 761 void origem(){
claraluques 27:83d2a710cc2f 762 lcd.cls();
claraluques 27:83d2a710cc2f 763 lcd.locate(5,1);
claraluques 27:83d2a710cc2f 764 lcd.printf("A MAQUINA");
claraluques 27:83d2a710cc2f 765 lcd.locate(2,2);
claraluques 27:83d2a710cc2f 766 lcd.printf("ESTA NA ORIGEM");
claraluques 27:83d2a710cc2f 767 wait(1);
claraluques 27:83d2a710cc2f 768 func = 4;
claraluques 27:83d2a710cc2f 769 }
claraluques 26:59081efdce79 770
claraluques 30:614dcbd74cdc 771 //func 20
claraluques 30:614dcbd74cdc 772 void nomeprog(){
claraluques 32:c293f89170b0 773 nome = "";
claraluques 32:c293f89170b0 774 sair = 0;
claraluques 33:0149960e95c1 775 voltar = 0;
claraluques 33:0149960e95c1 776 coluna = 1;
claraluques 32:c293f89170b0 777 lcd.cls();
claraluques 31:77eb51d4ee18 778 bot_enter = penter;
claraluques 32:c293f89170b0 779 escrever();
claraluques 33:0149960e95c1 780 //lcd.setCursor(TextLCD::CurOff_BlkOff);
claraluques 32:c293f89170b0 781 if (sair==1){
claraluques 33:0149960e95c1 782 int len = nome.length();
lucasfontenla 45:6701e27510f9 783 //printf("%d\n\r", len);
claraluques 33:0149960e95c1 784 nome.erase(len - 1);
claraluques 32:c293f89170b0 785 nome.append(".txt");
lucasfontenla 45:6701e27510f9 786 printf("Nome do programa: %s\n\r", nome);
claraluques 32:c293f89170b0 787 int verificar = sdcard.check_name_available(nome);
lucasfontenla 45:6701e27510f9 788 printf("Status do nome: %d\n\r", verificar);
lucasfontenla 45:6701e27510f9 789 if (verificar){
claraluques 32:c293f89170b0 790 file_name = nome;
claraluques 32:c293f89170b0 791 machine.get_saved_points();
lucasfontenla 45:6701e27510f9 792 while(1){
lucasfontenla 45:6701e27510f9 793 if(Mach.readable()){
lucasfontenla 45:6701e27510f9 794 readSerial();
lucasfontenla 45:6701e27510f9 795 break;
lucasfontenla 45:6701e27510f9 796 }
lucasfontenla 45:6701e27510f9 797 }
claraluques 32:c293f89170b0 798 printf("ok\n\r");
claraluques 33:0149960e95c1 799 func = 7;
claraluques 32:c293f89170b0 800 }
lucasfontenla 45:6701e27510f9 801 else if (!verificar){
claraluques 33:0149960e95c1 802 func = 20;
claraluques 32:c293f89170b0 803 printf("nok\n\r");
claraluques 32:c293f89170b0 804 }
claraluques 30:614dcbd74cdc 805 }
claraluques 30:614dcbd74cdc 806 }
claraluques 30:614dcbd74cdc 807
claraluques 32:c293f89170b0 808 //func 21
claraluques 32:c293f89170b0 809 void mudar_nome(){
claraluques 32:c293f89170b0 810 lcd.cls();
claraluques 32:c293f89170b0 811 wait(1);
claraluques 32:c293f89170b0 812 func = 20;
claraluques 32:c293f89170b0 813 }
claraluques 32:c293f89170b0 814
claraluques 33:0149960e95c1 815 //func 22
claraluques 33:0149960e95c1 816 void salva2(){
claraluques 33:0149960e95c1 817 lcd.cls();
claraluques 33:0149960e95c1 818 lcd.locate(0,0);
claraluques 33:0149960e95c1 819 lcd.printf("Voce salvou o ponto:");
claraluques 33:0149960e95c1 820 lcd.locate(5,1);
claraluques 33:0149960e95c1 821 lcd.printf("X:");
claraluques 33:0149960e95c1 822 lcd.locate(5,2);
claraluques 33:0149960e95c1 823 lcd.printf("Y:");
claraluques 33:0149960e95c1 824 lcd.locate(5,3);
claraluques 33:0149960e95c1 825 lcd.printf("Z:");
claraluques 33:0149960e95c1 826 //x
claraluques 33:0149960e95c1 827 if (cx<=-1 && cx>=-9){
claraluques 33:0149960e95c1 828 lcd.locate(7,1);
claraluques 33:0149960e95c1 829 lcd.printf(" %.2f ", cx);
claraluques 33:0149960e95c1 830 }
claraluques 33:0149960e95c1 831 if (cx<=-10 && cx>=-99){
claraluques 33:0149960e95c1 832 lcd.locate(7,1);
claraluques 33:0149960e95c1 833 lcd.printf(" %.2f ", cx);
claraluques 33:0149960e95c1 834 }
claraluques 33:0149960e95c1 835 if (cx<=-100){
claraluques 33:0149960e95c1 836 lcd.locate(7,1);
claraluques 33:0149960e95c1 837 lcd.printf("%.2f ", cx);
claraluques 33:0149960e95c1 838 }
claraluques 33:0149960e95c1 839 if (cx<=9 && cx>=0){
claraluques 33:0149960e95c1 840 lcd.locate(7,1);
claraluques 33:0149960e95c1 841 lcd.printf(" %.2f ", cx);
claraluques 33:0149960e95c1 842 }
claraluques 33:0149960e95c1 843 if (cx>=10 && cx<=99){
claraluques 33:0149960e95c1 844 lcd.locate(7,1);
claraluques 33:0149960e95c1 845 lcd.printf(" %.2f ", cx);
claraluques 33:0149960e95c1 846 }
claraluques 33:0149960e95c1 847 if (cx>=100){
claraluques 33:0149960e95c1 848 lcd.locate(7,1);
claraluques 33:0149960e95c1 849 lcd.printf(" %.2f ", cx);
claraluques 33:0149960e95c1 850 }
claraluques 33:0149960e95c1 851 //y
claraluques 33:0149960e95c1 852 if (cy<=-1 && cy>=-9){
claraluques 33:0149960e95c1 853 lcd.locate(7,2);
claraluques 33:0149960e95c1 854 lcd.printf(" %.2f ", cy);
claraluques 33:0149960e95c1 855 }
claraluques 33:0149960e95c1 856 if (cy<=-10 && cx>=-99){
claraluques 33:0149960e95c1 857 lcd.locate(7,2);
claraluques 33:0149960e95c1 858 lcd.printf(" %.2f ", cy);
claraluques 33:0149960e95c1 859 }
claraluques 33:0149960e95c1 860 if (cy<=-100){
claraluques 33:0149960e95c1 861 lcd.locate(7,2);
claraluques 33:0149960e95c1 862 lcd.printf("%.2f ", cy);
claraluques 33:0149960e95c1 863 }
claraluques 33:0149960e95c1 864 if (cy<=9 && cy>=0){
claraluques 33:0149960e95c1 865 lcd.locate(7,2);
claraluques 33:0149960e95c1 866 lcd.printf(" %.2f ", cy);
claraluques 33:0149960e95c1 867 }
claraluques 33:0149960e95c1 868 if (cy>=10 && cx<=99){
claraluques 33:0149960e95c1 869 lcd.locate(7,2);
claraluques 33:0149960e95c1 870 lcd.printf(" %.2f ", cy);
claraluques 33:0149960e95c1 871 }
claraluques 33:0149960e95c1 872 if (cy>=100){
claraluques 33:0149960e95c1 873 lcd.locate(7,2);
claraluques 33:0149960e95c1 874 lcd.printf(" %.2f ", cy);
claraluques 33:0149960e95c1 875 }
claraluques 33:0149960e95c1 876 //z
claraluques 33:0149960e95c1 877 if (cz<=-1 && cz>=-9){
claraluques 33:0149960e95c1 878 lcd.locate(7,3);
claraluques 33:0149960e95c1 879 lcd.printf(" %.2f ", cz);
claraluques 33:0149960e95c1 880 }
claraluques 33:0149960e95c1 881 if (cz<=-10 && cx>=-99){
claraluques 33:0149960e95c1 882 lcd.locate(7,3);
claraluques 33:0149960e95c1 883 lcd.printf(" %.2f ", cz);
claraluques 33:0149960e95c1 884 }
claraluques 33:0149960e95c1 885 if (cz<=-100){
claraluques 33:0149960e95c1 886 lcd.locate(7,3);
claraluques 33:0149960e95c1 887 lcd.printf("%.2f ", cz);
claraluques 33:0149960e95c1 888 }
claraluques 33:0149960e95c1 889 if (cz<=9 && cz>=0){
claraluques 33:0149960e95c1 890 lcd.locate(7,3);
claraluques 33:0149960e95c1 891 lcd.printf(" %.2f ", cz);
claraluques 33:0149960e95c1 892 }
claraluques 33:0149960e95c1 893 if (cz>=10 && cx<=99){
claraluques 33:0149960e95c1 894 lcd.locate(7,3);
claraluques 33:0149960e95c1 895 lcd.printf(" %.2f ", cz);
claraluques 33:0149960e95c1 896 }
claraluques 33:0149960e95c1 897 if (cz>=100){
claraluques 33:0149960e95c1 898 lcd.locate(7,3);
claraluques 33:0149960e95c1 899 lcd.printf(" %.2f ", cz);
claraluques 33:0149960e95c1 900 }
claraluques 33:0149960e95c1 901 wait(1);
claraluques 33:0149960e95c1 902 func = 6;
claraluques 33:0149960e95c1 903 }
claraluques 33:0149960e95c1 904
claraluques 30:614dcbd74cdc 905 //função para escrever nome arquivo
claraluques 32:c293f89170b0 906 void escrever(){
claraluques 32:c293f89170b0 907 char alfabeto[38] = {'A','B','C','D','E','F','G','H','I','J','K','L','M','N','O','P','Q','R','S','T','U','V','W','X','Y','Z',
claraluques 30:614dcbd74cdc 908 '0','1','2','3','4','5','6','7','8','9','-','_'};
claraluques 30:614dcbd74cdc 909 int imax = 37;
claraluques 30:614dcbd74cdc 910 int imin = 0;
claraluques 33:0149960e95c1 911 //lcd.locate(1,1);
claraluques 32:c293f89170b0 912 while (sair==0){
claraluques 33:0149960e95c1 913 voltar = 0;
claraluques 32:c293f89170b0 914 int i = 0;
claraluques 33:0149960e95c1 915 //lcd.locate(0,2);
claraluques 33:0149960e95c1 916 //lcd.setCursor(TextLCD::CurOn_BlkOn);
claraluques 32:c293f89170b0 917 lcd.locate(1,1);
claraluques 32:c293f89170b0 918 lcd.printf("%s", nome);
claraluques 32:c293f89170b0 919 while (bot_enter==penter){
claraluques 32:c293f89170b0 920 if (bot_cima == 0){
claraluques 32:c293f89170b0 921 if (i==imin){
claraluques 32:c293f89170b0 922 i = imax;
claraluques 32:c293f89170b0 923 }
claraluques 32:c293f89170b0 924 else if (i>imin && i<=imax){
claraluques 32:c293f89170b0 925 i--;
claraluques 32:c293f89170b0 926 }
claraluques 32:c293f89170b0 927 bot_cima = 1;
claraluques 31:77eb51d4ee18 928 }
claraluques 32:c293f89170b0 929 else if (bot_baixo == 0){
claraluques 32:c293f89170b0 930 if (i==imax){
claraluques 32:c293f89170b0 931 i = imin;
claraluques 32:c293f89170b0 932 }
claraluques 32:c293f89170b0 933 else if (i<imax && i>=imin){
claraluques 32:c293f89170b0 934 i++;
claraluques 32:c293f89170b0 935 }
claraluques 32:c293f89170b0 936 bot_baixo = 1;
claraluques 32:c293f89170b0 937 }
claraluques 32:c293f89170b0 938 lcd.locate(coluna, 1);
claraluques 32:c293f89170b0 939 lcd.printf("%c", alfabeto[i]);
claraluques 33:0149960e95c1 940 lcd.locate(coluna,2);
claraluques 33:0149960e95c1 941 lcd.printf("%c", 0x5E);
claraluques 31:77eb51d4ee18 942 }
claraluques 32:c293f89170b0 943 if (coluna<=18){
claraluques 32:c293f89170b0 944 char carac = alfabeto[i];
claraluques 32:c293f89170b0 945 nome.push_back(carac);
lucasfontenla 45:6701e27510f9 946 printf("Nome do programa (func - escrever): %s\n\r", nome);
claraluques 32:c293f89170b0 947 bot_enter = penter;
claraluques 33:0149960e95c1 948 if (coluna<18){
claraluques 33:0149960e95c1 949 if (voltar==1){
claraluques 33:0149960e95c1 950 printf("voltar\n\r");
claraluques 33:0149960e95c1 951 if (coluna>1){
claraluques 33:0149960e95c1 952 //nome[coluna-1]="";
claraluques 33:0149960e95c1 953 lcd.locate(coluna, 1);
claraluques 33:0149960e95c1 954 lcd.printf(" ");
claraluques 33:0149960e95c1 955 lcd.locate(coluna, 2);
claraluques 33:0149960e95c1 956 lcd.printf(" ");
claraluques 33:0149960e95c1 957 coluna--;
claraluques 33:0149960e95c1 958 nome.erase(coluna-1);
claraluques 33:0149960e95c1 959 lcd.locate(coluna, 2);
claraluques 33:0149960e95c1 960 lcd.printf("%c", 0x5E);
claraluques 33:0149960e95c1 961 }
claraluques 33:0149960e95c1 962 }
claraluques 33:0149960e95c1 963 if (voltar==0){
claraluques 33:0149960e95c1 964 lcd.locate(coluna, 2);
claraluques 33:0149960e95c1 965 lcd.printf(" ");
claraluques 33:0149960e95c1 966 coluna++;
claraluques 33:0149960e95c1 967 lcd.locate(coluna, 2);
claraluques 33:0149960e95c1 968 lcd.printf("%c", 0x5E);
claraluques 33:0149960e95c1 969 }
claraluques 33:0149960e95c1 970 }
claraluques 33:0149960e95c1 971 /*char carac = alfabeto[i];
claraluques 33:0149960e95c1 972 nome.push_back(carac);
claraluques 33:0149960e95c1 973 printf("%s\n\r", nome);
claraluques 33:0149960e95c1 974 bot_enter = penter;*/
claraluques 32:c293f89170b0 975 }
claraluques 30:614dcbd74cdc 976 }
claraluques 30:614dcbd74cdc 977 }
claraluques 30:614dcbd74cdc 978
claraluques 26:59081efdce79 979 //função para ler os pontos
claraluques 21:7603fe283ba4 980 void readSerial(){
claraluques 21:7603fe283ba4 981 char recv;
lucasfontenla 24:46c3be0e8273 982 int points = 0;
lucasfontenla 24:46c3be0e8273 983 int pointx = 0;
lucasfontenla 24:46c3be0e8273 984 int pointy = 0;
lucasfontenla 24:46c3be0e8273 985 int pointz = 0;
claraluques 27:83d2a710cc2f 986 int action = 0;
lucasfontenla 29:558eccdfc079 987 int uploading_saved = 0;
lucasfontenla 24:46c3be0e8273 988 string coordx = "";
lucasfontenla 24:46c3be0e8273 989 string coordy = "";
lucasfontenla 24:46c3be0e8273 990 string coordz = "";
lucasfontenla 29:558eccdfc079 991 string recv_buffer;
lucasfontenla 45:6701e27510f9 992
lucasfontenla 45:6701e27510f9 993 int status;
claraluques 26:59081efdce79 994
claraluques 32:c293f89170b0 995
claraluques 21:7603fe283ba4 996 while(1){
claraluques 21:7603fe283ba4 997 recv = Mach.getc();
lucasfontenla 45:6701e27510f9 998
claraluques 32:c293f89170b0 999 if (recv == 'a'){
claraluques 27:83d2a710cc2f 1000 home = 0;
claraluques 27:83d2a710cc2f 1001 exec = 0;
claraluques 26:59081efdce79 1002 printf("oi\n\r");
claraluques 27:83d2a710cc2f 1003 action = 1;
lucasfontenla 45:6701e27510f9 1004 }
lucasfontenla 45:6701e27510f9 1005
lucasfontenla 24:46c3be0e8273 1006 if (recv == 'p'){
claraluques 21:7603fe283ba4 1007 points = 1;
lucasfontenla 45:6701e27510f9 1008 }
lucasfontenla 45:6701e27510f9 1009
lucasfontenla 29:558eccdfc079 1010 if(recv == 'u'){
lucasfontenla 29:558eccdfc079 1011 uploading_saved = 1;
lucasfontenla 29:558eccdfc079 1012 }
lucasfontenla 45:6701e27510f9 1013
lucasfontenla 45:6701e27510f9 1014 if(uploading_saved){
lucasfontenla 45:6701e27510f9 1015 if(recv == 'x'){
lucasfontenla 45:6701e27510f9 1016 printf("OK\n\r");
lucasfontenla 45:6701e27510f9 1017 status = sdcard.save_GCODE(file_name, recv_buffer);
lucasfontenla 45:6701e27510f9 1018 return;
lucasfontenla 45:6701e27510f9 1019 } else if(recv != 'u'){
lucasfontenla 45:6701e27510f9 1020 recv_buffer.push_back(recv);
lucasfontenla 45:6701e27510f9 1021 }
lucasfontenla 45:6701e27510f9 1022 }
lucasfontenla 45:6701e27510f9 1023
lucasfontenla 45:6701e27510f9 1024 if (points && !uploading_saved){
lucasfontenla 24:46c3be0e8273 1025 if (recv == 'X'){
claraluques 21:7603fe283ba4 1026 pointx = 1;
lucasfontenla 24:46c3be0e8273 1027 pointy = 0;
lucasfontenla 24:46c3be0e8273 1028 pointz = 0;
claraluques 21:7603fe283ba4 1029 }
lucasfontenla 24:46c3be0e8273 1030 else if (recv == 'Y'){
claraluques 21:7603fe283ba4 1031 pointy = 1;
lucasfontenla 24:46c3be0e8273 1032 pointx = 0;
lucasfontenla 24:46c3be0e8273 1033 pointz = 0;
claraluques 21:7603fe283ba4 1034 }
lucasfontenla 24:46c3be0e8273 1035 else if (recv == 'Z'){
claraluques 21:7603fe283ba4 1036 pointz = 1;
lucasfontenla 24:46c3be0e8273 1037 pointx = 0;
lucasfontenla 24:46c3be0e8273 1038 pointy = 0;
claraluques 23:19c67758032d 1039 }
lucasfontenla 45:6701e27510f9 1040 else if(recv == 'x'){
claraluques 23:19c67758032d 1041 cx = atof(coordx.c_str());
claraluques 23:19c67758032d 1042 cy = atof(coordy.c_str());
claraluques 23:19c67758032d 1043 cz = atof(coordz.c_str());
claraluques 23:19c67758032d 1044 printf("%s,%s,%s\n\r", coordx, coordy, coordz);
claraluques 21:7603fe283ba4 1045 break;
claraluques 21:7603fe283ba4 1046 }
claraluques 23:19c67758032d 1047 }
lucasfontenla 45:6701e27510f9 1048
lucasfontenla 45:6701e27510f9 1049 if(pointx){
lucasfontenla 24:46c3be0e8273 1050 if (recv!='X'){
claraluques 23:19c67758032d 1051 coordx.push_back(recv);
claraluques 23:19c67758032d 1052 }
lucasfontenla 45:6701e27510f9 1053 }
claraluques 23:19c67758032d 1054 if (pointy){
lucasfontenla 24:46c3be0e8273 1055 if (recv!='Y'){
claraluques 23:19c67758032d 1056 coordy.push_back(recv);
claraluques 23:19c67758032d 1057 }
lucasfontenla 45:6701e27510f9 1058 }
claraluques 23:19c67758032d 1059 if (pointz){
lucasfontenla 24:46c3be0e8273 1060 if (recv!='Z'){
claraluques 23:19c67758032d 1061 coordz.push_back(recv);
claraluques 23:19c67758032d 1062 }
lucasfontenla 45:6701e27510f9 1063 }
claraluques 27:83d2a710cc2f 1064 if (action){
claraluques 27:83d2a710cc2f 1065 if (recv=='x'){
claraluques 27:83d2a710cc2f 1066 break;
claraluques 27:83d2a710cc2f 1067 }
lucasfontenla 45:6701e27510f9 1068 }
claraluques 21:7603fe283ba4 1069 }
lucasfontenla 29:558eccdfc079 1070 }
claraluques 23:19c67758032d 1071
claraluques 26:59081efdce79 1072
lucasfontenla 22:22ddb0b21d48 1073
claraluques 21:7603fe283ba4 1074 Menu(); //não apagar
lucasfontenla 17:0b8e489fac36 1075 };