Marcelo Rebonatto / Mbed 2 deprecated ptgm_semfft

Versão sem FFT e aquisição por DMA. 256 amostras.

Dependencies:   EthernetInterface NTPClient mbed-rtos mbed

Codes/TelnetServer.cpp@0:e57bc370d339, 2016-01-05 (annotated)

Committer:
rebonatto
Date:
Tue Jan 05 11:45:44 2016 +0000
Revision:
0:e57bc370d339
Vers?o est?vel sem calculo de FFT. Aquisi??o por DMA. Usa 256 amostras.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
rebonatto 0:e57bc370d339 1 /*
rebonatto 0:e57bc370d339 2 Original autor: Francisco
rebonatto 0:e57bc370d339 3 Modificacao do uso da rede: rebonatto
rebonatto 0:e57bc370d339 4 */
rebonatto 0:e57bc370d339 5
rebonatto 0:e57bc370d339 6
rebonatto 0:e57bc370d339 7 #include "TelnetServer.h"
rebonatto 0:e57bc370d339 8
rebonatto 0:e57bc370d339 9 #include "Split.h"
rebonatto 0:e57bc370d339 10
rebonatto 0:e57bc370d339 11 #define OPT_WILL 251
rebonatto 0:e57bc370d339 12 #define OPT_WONT 252
rebonatto 0:e57bc370d339 13 #define OPT_DO 253
rebonatto 0:e57bc370d339 14 #define OPT_DONT 254
rebonatto 0:e57bc370d339 15
rebonatto 0:e57bc370d339 16 char* welcome_msg = "Protegemed - welcome to telnet\r\nType 'help' for a list of commands\r\n";
rebonatto 0:e57bc370d339 17 char *command_not_found_msg_get = "Command not found.\r\n\r\n";
rebonatto 0:e57bc370d339 18 char* prompt_msg = "\r\n$ ";
rebonatto 0:e57bc370d339 19 char iac_will_echo[] = {0xFF,0xFB,0x01};
rebonatto 0:e57bc370d339 20 char erase_cmd[] = { 0x1B,0x5B,0x44,0x1B,0x5B,0x4B};
rebonatto 0:e57bc370d339 21
rebonatto 0:e57bc370d339 22 const struct telnet_cmd_handler TelnetServer::cmds[] = {
rebonatto 0:e57bc370d339 23 {"exit",(cmd_function)-1},
rebonatto 0:e57bc370d339 24 {"help",TelnetServer::HelpCommand},
rebonatto 0:e57bc370d339 25 {"reset",TelnetServer::ResetCommand},
rebonatto 0:e57bc370d339 26 {"remove",TelnetServer::RemoveCommand},
rebonatto 0:e57bc370d339 27 {"listparam",TelnetServer::ListParamCommand},
rebonatto 0:e57bc370d339 28 {"getparam",TelnetServer::GetParamCommand},
rebonatto 0:e57bc370d339 29 {"setparam",TelnetServer::SetParamCommand},
rebonatto 0:e57bc370d339 30 {"version",TelnetServer::VersionCommand},
rebonatto 0:e57bc370d339 31 {"update",TelnetServer::UpdateCommand},
rebonatto 0:e57bc370d339 32 {"",(cmd_function)0}
rebonatto 0:e57bc370d339 33 };
rebonatto 0:e57bc370d339 34
rebonatto 0:e57bc370d339 35 void TelnetServer::TelnetServer_Thread(void const* arg)
rebonatto 0:e57bc370d339 36 {
rebonatto 0:e57bc370d339 37 int r=0;
rebonatto 0:e57bc370d339 38 printf("Telnet Thread starting... \r\nCommands up to 100 chars\n");
rebonatto 0:e57bc370d339 39
rebonatto 0:e57bc370d339 40 TCPSocketServer server;
rebonatto 0:e57bc370d339 41
rebonatto 0:e57bc370d339 42 server.bind(23);
rebonatto 0:e57bc370d339 43 server.listen();
rebonatto 0:e57bc370d339 44
rebonatto 0:e57bc370d339 45 while(1)
rebonatto 0:e57bc370d339 46 {
rebonatto 0:e57bc370d339 47 TCPSocketConnection* conn ;
rebonatto 0:e57bc370d339 48 TCPSocketConnection aux;
rebonatto 0:e57bc370d339 49 r = server.accept(aux);
rebonatto 0:e57bc370d339 50 conn = &aux;
rebonatto 0:e57bc370d339 51 printf("Aceitou conexao \n");
rebonatto 0:e57bc370d339 52 if (r != 0){
rebonatto 0:e57bc370d339 53 printf("Error in connection\n");
rebonatto 0:e57bc370d339 54 exit(1);
rebonatto 0:e57bc370d339 55 }
rebonatto 0:e57bc370d339 56
rebonatto 0:e57bc370d339 57 TelnetSession(conn);
rebonatto 0:e57bc370d339 58 printf("Fechou\n");
rebonatto 0:e57bc370d339 59 conn->close();
rebonatto 0:e57bc370d339 60 }
rebonatto 0:e57bc370d339 61 }
rebonatto 0:e57bc370d339 62
rebonatto 0:e57bc370d339 63 void TelnetServer::TelnetSession(TCPSocketConnection *conn)
rebonatto 0:e57bc370d339 64 {
rebonatto 0:e57bc370d339 65 int r, flag;
rebonatto 0:e57bc370d339 66 int buffer_ptr=0;
rebonatto 0:e57bc370d339 67
rebonatto 0:e57bc370d339 68 printf("Connected to %s:%d\n",conn->get_address(),conn->get_port());
rebonatto 0:e57bc370d339 69
rebonatto 0:e57bc370d339 70 conn->send(welcome_msg,strlen(welcome_msg));
rebonatto 0:e57bc370d339 71 conn->send(prompt_msg,strlen(prompt_msg));
rebonatto 0:e57bc370d339 72
rebonatto 0:e57bc370d339 73 conn->set_blocking(true);
rebonatto 0:e57bc370d339 74
rebonatto 0:e57bc370d339 75 while(1)
rebonatto 0:e57bc370d339 76 {
rebonatto 0:e57bc370d339 77 char buf_rec[260];
rebonatto 0:e57bc370d339 78 unsigned char buf[260];
rebonatto 0:e57bc370d339 79 char buffer[260];
rebonatto 0:e57bc370d339 80
rebonatto 0:e57bc370d339 81 //printf("Vai recevber\n");
rebonatto 0:e57bc370d339 82 r = conn->receive(buf_rec, strlen(buf_rec) );
rebonatto 0:e57bc370d339 83
rebonatto 0:e57bc370d339 84 /* need memcpy becouse commands are ready to unsigned char and tcp receive char */
rebonatto 0:e57bc370d339 85 memcpy(buf, buf_rec, r);
rebonatto 0:e57bc370d339 86
rebonatto 0:e57bc370d339 87 //printf("Receive %d\n", r);
rebonatto 0:e57bc370d339 88
rebonatto 0:e57bc370d339 89 if(r == -1)
rebonatto 0:e57bc370d339 90 {
rebonatto 0:e57bc370d339 91 printf("Error %d %s\n", r, buf);
rebonatto 0:e57bc370d339 92 break;
rebonatto 0:e57bc370d339 93 }
rebonatto 0:e57bc370d339 94
rebonatto 0:e57bc370d339 95 if (r > 120){
rebonatto 0:e57bc370d339 96 printf("Max command length = 100 chars\n");
rebonatto 0:e57bc370d339 97 //send
rebonatto 0:e57bc370d339 98 break;
rebonatto 0:e57bc370d339 99 }
rebonatto 0:e57bc370d339 100
rebonatto 0:e57bc370d339 101 //printf("Got Here %d *%s*\n", r, buf);
rebonatto 0:e57bc370d339 102 //printf("\n\nGot Here2 [%s]\n\n", buf_rec);
rebonatto 0:e57bc370d339 103
rebonatto 0:e57bc370d339 104 for(int i=0;i<r;i++)
rebonatto 0:e57bc370d339 105 {
rebonatto 0:e57bc370d339 106 //check if it is a printable or any of the line control chars
rebonatto 0:e57bc370d339 107 if((buf[i]>31 && buf[i] < 128) || buf[i]=='\r' || buf[i]=='\n' || buf[i]=='\t')
rebonatto 0:e57bc370d339 108 {
rebonatto 0:e57bc370d339 109 //append to the buffer
rebonatto 0:e57bc370d339 110 buffer[buffer_ptr] = buf[i];
rebonatto 0:e57bc370d339 111 buffer_ptr++;
rebonatto 0:e57bc370d339 112 }
rebonatto 0:e57bc370d339 113 else if(buf[i] == '\b') //backspace
rebonatto 0:e57bc370d339 114 {
rebonatto 0:e57bc370d339 115 //erases the character from the command buffer
rebonatto 0:e57bc370d339 116 if(buffer_ptr > 0)
rebonatto 0:e57bc370d339 117 {
rebonatto 0:e57bc370d339 118 buffer_ptr--;
rebonatto 0:e57bc370d339 119 }
rebonatto 0:e57bc370d339 120 //resets m variable state (will not cause error on the next block of code
rebonatto 0:e57bc370d339 121
rebonatto 0:e57bc370d339 122 }
rebonatto 0:e57bc370d339 123 else if((int)buf[i] == 255) //IAC - Interpret As Command
rebonatto 0:e57bc370d339 124 {
rebonatto 0:e57bc370d339 125 if((int)buf[i+1] >= 251)
rebonatto 0:e57bc370d339 126 {
rebonatto 0:e57bc370d339 127 option_negotiator(conn,buf[i+1],buf[i+2]);
rebonatto 0:e57bc370d339 128 i+=2;
rebonatto 0:e57bc370d339 129 }
rebonatto 0:e57bc370d339 130 else
rebonatto 0:e57bc370d339 131 i+=1;
rebonatto 0:e57bc370d339 132 }
rebonatto 0:e57bc370d339 133 }
rebonatto 0:e57bc370d339 134
rebonatto 0:e57bc370d339 135 //detect a carriage return and line feed sequence. Trigger command processor
rebonatto 0:e57bc370d339 136 if(buffer_ptr >= 2)
rebonatto 0:e57bc370d339 137 {
rebonatto 0:e57bc370d339 138 if(buffer[buffer_ptr-1] == '\n' && buffer[buffer_ptr-2] == '\r')
rebonatto 0:e57bc370d339 139 {
rebonatto 0:e57bc370d339 140 char **command;
rebonatto 0:e57bc370d339 141 int command_count;
rebonatto 0:e57bc370d339 142
rebonatto 0:e57bc370d339 143 buffer[buffer_ptr-2] = '\0';
rebonatto 0:e57bc370d339 144 command_count = split((char*)buffer," ",&command);
rebonatto 0:e57bc370d339 145
rebonatto 0:e57bc370d339 146 printf("Command found: %s\n", command[0]);
rebonatto 0:e57bc370d339 147 flag = 1;
rebonatto 0:e57bc370d339 148 //must find a function in the table and then execute it, passing the command array as an argument
rebonatto 0:e57bc370d339 149 for(int i=0;cmds[i].pfn != 0;i++)
rebonatto 0:e57bc370d339 150 {
rebonatto 0:e57bc370d339 151 if(!strcasecmp(command[0],cmds[i].command_name))
rebonatto 0:e57bc370d339 152 {
rebonatto 0:e57bc370d339 153 if((int)cmds[i].pfn == -1)//exit cmd
rebonatto 0:e57bc370d339 154 {
rebonatto 0:e57bc370d339 155 //delete buffer;
rebonatto 0:e57bc370d339 156 return;
rebonatto 0:e57bc370d339 157 }
rebonatto 0:e57bc370d339 158 else
rebonatto 0:e57bc370d339 159 {
rebonatto 0:e57bc370d339 160 flag = 0;
rebonatto 0:e57bc370d339 161 cmds[i].pfn(conn,command,command_count);
rebonatto 0:e57bc370d339 162 break;
rebonatto 0:e57bc370d339 163 }
rebonatto 0:e57bc370d339 164 }
rebonatto 0:e57bc370d339 165 }
rebonatto 0:e57bc370d339 166
rebonatto 0:e57bc370d339 167 if (flag)
rebonatto 0:e57bc370d339 168 conn->send(command_not_found_msg_get,strlen(command_not_found_msg_get));
rebonatto 0:e57bc370d339 169
rebonatto 0:e57bc370d339 170 //write the prompt
rebonatto 0:e57bc370d339 171 conn->send(prompt_msg,strlen(prompt_msg));
rebonatto 0:e57bc370d339 172 buffer_ptr=0;
rebonatto 0:e57bc370d339 173 }
rebonatto 0:e57bc370d339 174 }
rebonatto 0:e57bc370d339 175 //buf_rec[0] = buf[0] = buffer[0] = '\0';
rebonatto 0:e57bc370d339 176 }
rebonatto 0:e57bc370d339 177
rebonatto 0:e57bc370d339 178 //delete buffer;
rebonatto 0:e57bc370d339 179
rebonatto 0:e57bc370d339 180
rebonatto 0:e57bc370d339 181 }
rebonatto 0:e57bc370d339 182
rebonatto 0:e57bc370d339 183 void TelnetServer::option_negotiator(TCPSocketConnection *conn,unsigned char opt_cmd,unsigned char opt_param)
rebonatto 0:e57bc370d339 184 {
rebonatto 0:e57bc370d339 185 char opt[3]={0,0,0};
rebonatto 0:e57bc370d339 186
rebonatto 0:e57bc370d339 187 if(opt_param == 1 && (opt_cmd == OPT_DO || opt_cmd == OPT_DONT)) //response for our will echo
rebonatto 0:e57bc370d339 188 {
rebonatto 0:e57bc370d339 189 printf("HERE");
rebonatto 0:e57bc370d339 190 return;
rebonatto 0:e57bc370d339 191 }
rebonatto 0:e57bc370d339 192 if(opt_cmd == OPT_DO) //every other option that it will ask to us to do, we won't
rebonatto 0:e57bc370d339 193 {
rebonatto 0:e57bc370d339 194 opt[0] = 255;
rebonatto 0:e57bc370d339 195 opt[1] = OPT_WONT;
rebonatto 0:e57bc370d339 196 opt[2] = opt_param;
rebonatto 0:e57bc370d339 197 conn->send(opt,3);
rebonatto 0:e57bc370d339 198 }
rebonatto 0:e57bc370d339 199 else if(opt_cmd == OPT_WILL && opt_param==3) //OK to supperss go ahead
rebonatto 0:e57bc370d339 200 {
rebonatto 0:e57bc370d339 201 opt[0] = 255;
rebonatto 0:e57bc370d339 202 opt[1] = OPT_DO;
rebonatto 0:e57bc370d339 203 opt[2] = opt_param;
rebonatto 0:e57bc370d339 204 conn->send(opt,3);
rebonatto 0:e57bc370d339 205 }
rebonatto 0:e57bc370d339 206 else if(opt_cmd == OPT_WILL) //every other option that it will ask do, we don't
rebonatto 0:e57bc370d339 207 {
rebonatto 0:e57bc370d339 208 opt[0] = 255;
rebonatto 0:e57bc370d339 209 opt[1] = OPT_DONT;
rebonatto 0:e57bc370d339 210 opt[2] = opt_param;
rebonatto 0:e57bc370d339 211 conn->send(opt,3);
rebonatto 0:e57bc370d339 212
rebonatto 0:e57bc370d339 213 }
rebonatto 0:e57bc370d339 214
rebonatto 0:e57bc370d339 215 }
rebonatto 0:e57bc370d339 216