| 1 | //
|
|---|
| 2 | // FADctrl
|
|---|
| 3 | //
|
|---|
| 4 |
|
|---|
| 5 | #include <stdio.h>
|
|---|
| 6 | #include <readline/history.h>
|
|---|
| 7 |
|
|---|
| 8 | #include "FAD.h"
|
|---|
| 9 |
|
|---|
| 10 | const char READLINE_HIST_FILE[] = "/tmp/.history.FADctrl";
|
|---|
| 11 |
|
|---|
| 12 | void OpenOtherSockets();
|
|---|
| 13 |
|
|---|
| 14 | // ================
|
|---|
| 15 | // Main program
|
|---|
| 16 | // ================
|
|---|
| 17 |
|
|---|
| 18 | int main() {
|
|---|
| 19 |
|
|---|
| 20 | // Uses getc() for readline library (allows interruption by signal)
|
|---|
| 21 | rl_getc_function = getc;
|
|---|
| 22 |
|
|---|
| 23 | // Load history buffer
|
|---|
| 24 | read_history(READLINE_HIST_FILE);
|
|---|
| 25 |
|
|---|
| 26 | system("clear");
|
|---|
| 27 | printf("\n*** FADctrl (built %s, %s, revision %s) *** \n\n",__DATE__, __TIME__, REVISION);
|
|---|
| 28 |
|
|---|
| 29 | // Construct main instance (static ensures destructor is called with exit())
|
|---|
| 30 | static FAD M;
|
|---|
| 31 |
|
|---|
| 32 | // Do not kill process if writing to closed socket
|
|---|
| 33 | signal(SIGPIPE,SIG_IGN);
|
|---|
| 34 |
|
|---|
| 35 | // Create thread to connect to other sockets
|
|---|
| 36 | int RetVal;
|
|---|
| 37 | pthread_t Thread;
|
|---|
| 38 | if ((RetVal = pthread_create(&Thread, NULL, (void * (*)(void *)) OpenOtherSockets, NULL)) != 0) {
|
|---|
| 39 | printf("pthread_create() failed for OpenOtherSockets(%s)\n", strerror(RetVal));
|
|---|
| 40 | exit(EXIT_FAILURE);
|
|---|
| 41 | }
|
|---|
| 42 |
|
|---|
| 43 | // Initialise all boards
|
|---|
| 44 | M.PrintMessage("Initalizing all boards...\n");
|
|---|
| 45 |
|
|---|
| 46 | DimClient::sendCommand(SERVER_NAME"/Command", "dwrite off");
|
|---|
| 47 | DimClient::sendCommand(SERVER_NAME"/Command", "domino off");
|
|---|
| 48 | sleep(1);
|
|---|
| 49 |
|
|---|
| 50 | DimClient::sendCommand(SERVER_NAME"/Command", "dac 0 25000");
|
|---|
| 51 | DimClient::sendCommand(SERVER_NAME"/Command", "dac 1-3 0");
|
|---|
| 52 | DimClient::sendCommand(SERVER_NAME"/Command", "dac 4-7 28800");
|
|---|
| 53 | sleep (1);
|
|---|
| 54 |
|
|---|
| 55 | //DimClient::sendCommand(SERVER_NAME"/Command", "roi all 10");
|
|---|
| 56 | //DimClient::sendCommand(SERVER_NAME"/Command", "address 44 29");
|
|---|
| 57 | //sleep (1);
|
|---|
| 58 |
|
|---|
| 59 | //DimClient::sendCommand(SERVER_NAME"/Command", "trigger");
|
|---|
| 60 | //sleep (1);
|
|---|
| 61 |
|
|---|
| 62 | //DimClient::sendCommand(SERVER_NAME"/Command", "address 44 30");
|
|---|
| 63 | //sleep (1);
|
|---|
| 64 |
|
|---|
| 65 | //DimClient::sendCommand(SERVER_NAME"/Command", "trigger");
|
|---|
| 66 | //sleep (1);
|
|---|
| 67 |
|
|---|
| 68 | //DimClient::sendCommand(SERVER_NAME"/Command", "address 44 0");
|
|---|
| 69 | //sleep (1);
|
|---|
| 70 |
|
|---|
| 71 | //DimClient::sendCommand(SERVER_NAME"/Command", "trigger");
|
|---|
| 72 | DimClient::sendCommand(SERVER_NAME"/Command", "domino on");
|
|---|
| 73 | DimClient::sendCommand(SERVER_NAME"/Command", "dwrite on");
|
|---|
| 74 | DimClient::sendCommand(SERVER_NAME"/Command", "roi all 1024");
|
|---|
| 75 | sleep (1);
|
|---|
| 76 |
|
|---|
| 77 | //EmptySockets(SocketDescriptor, 8, 750000L);
|
|---|
| 78 | M.PrintMessage("Finished initalizing all boards\n");
|
|---|
| 79 |
|
|---|
| 80 | // Command loop
|
|---|
| 81 | char *Command;
|
|---|
| 82 | std::string LastHist;
|
|---|
| 83 |
|
|---|
| 84 | while (!M.ExitRequest) {
|
|---|
| 85 | Command = readline("\rFADctrl>");
|
|---|
| 86 |
|
|---|
| 87 | // Check for interruption by signal
|
|---|
| 88 | if (Command == NULL) continue;
|
|---|
| 89 |
|
|---|
| 90 | // Add command to history
|
|---|
| 91 | if(strlen(Command) > 0 && LastHist != Command) {
|
|---|
| 92 | add_history(Command);
|
|---|
| 93 | LastHist = Command;
|
|---|
| 94 | }
|
|---|
| 95 |
|
|---|
| 96 | // Process command
|
|---|
| 97 | DimClient::sendCommand(SERVER_NAME"/Command", Command);
|
|---|
| 98 | free(Command);
|
|---|
| 99 | }
|
|---|
| 100 |
|
|---|
| 101 | // Save history buffer
|
|---|
| 102 | int Ret = write_history(READLINE_HIST_FILE);
|
|---|
| 103 | if (Ret != 0 ) printf("Error writing history file to '%s' (%s)\n", READLINE_HIST_FILE, strerror(Ret));
|
|---|
| 104 |
|
|---|
| 105 | // Terminate thread for other sockets
|
|---|
| 106 | if ((Ret = pthread_cancel(Thread)) != 0) printf("Error: Could not request thread cancellation in main() (%s)\n", strerror(Ret));
|
|---|
| 107 | if ((Ret = pthread_join(Thread, NULL)) != 0) printf("pthread_join() failed in main () (%s)\n", strerror(Ret));
|
|---|
| 108 | }
|
|---|
| 109 |
|
|---|
| 110 |
|
|---|
| 111 | // ====================
|
|---|
| 112 | // OpenOtherSockets()
|
|---|
| 113 | // ====================
|
|---|
| 114 |
|
|---|
| 115 | void OpenOtherSockets() {
|
|---|
| 116 |
|
|---|
| 117 | //ETHZ
|
|---|
| 118 | static char Hostname[] = "192.33.99.225";
|
|---|
| 119 | //TUDO
|
|---|
| 120 | //static char Hostname[] = "129.217.160.119";
|
|---|
| 121 | int List[] = {5001, 5002, 5003, 5004, 5005, 5006, 5007};
|
|---|
| 122 | int Socket[sizeof(List)/sizeof(int)], MaxSocketNum=0, Ret;
|
|---|
| 123 | fd_set DescriptorList;
|
|---|
| 124 | char Buffer[1000000];
|
|---|
| 125 |
|
|---|
| 126 | // Resolve hostname
|
|---|
| 127 | struct hostent *Host = gethostbyname(Hostname);
|
|---|
| 128 | if (Host == 0) {
|
|---|
| 129 | printf("OtherSockets: Could not resolve host name for %s\n", Hostname);
|
|---|
| 130 | return;
|
|---|
| 131 | }
|
|---|
| 132 |
|
|---|
| 133 | // Connect to server
|
|---|
| 134 | struct sockaddr_in SocketAddress;
|
|---|
| 135 | SocketAddress.sin_family = PF_INET;
|
|---|
| 136 | SocketAddress.sin_addr = *(struct in_addr*) Host->h_addr;
|
|---|
| 137 |
|
|---|
| 138 | for (unsigned int i=0; i<sizeof(List)/sizeof(int); i++) {
|
|---|
| 139 | // Open socket descriptor
|
|---|
| 140 | if ((Socket[i] = socket(PF_INET, SOCK_STREAM, 0)) == -1) {
|
|---|
| 141 | printf("OtherSockets: Could not open socket for port %d (%s)\n", List[i], strerror(errno));
|
|---|
| 142 | return;
|
|---|
| 143 | }
|
|---|
| 144 |
|
|---|
| 145 | // Determine highest socket number for select()
|
|---|
| 146 | if (Socket[i] > MaxSocketNum) MaxSocketNum = Socket[i];
|
|---|
| 147 |
|
|---|
| 148 | // Connect to server
|
|---|
| 149 | SocketAddress.sin_port = htons((unsigned short) List[i]);
|
|---|
| 150 | if (connect(Socket[i], (struct sockaddr *) &SocketAddress, sizeof(SocketAddress)) == -1) {
|
|---|
| 151 | printf("OtherSockets: Could not connect to port %d (%s)\n", List[i], strerror(errno));
|
|---|
| 152 | return;
|
|---|
| 153 | }
|
|---|
| 154 | }
|
|---|
| 155 |
|
|---|
| 156 | while(true) {
|
|---|
| 157 | // Wait for data from terminal (stdin) or from sockets
|
|---|
| 158 | FD_ZERO(&DescriptorList);
|
|---|
| 159 | for (unsigned int i=0; i<sizeof(List)/sizeof(int); i++) FD_SET(Socket[i], &DescriptorList);
|
|---|
| 160 | if (select(MaxSocketNum+1, &DescriptorList, NULL, NULL, NULL) == -1) {
|
|---|
| 161 | perror("OtherSockets: Error with select()");
|
|---|
| 162 | break;
|
|---|
| 163 | }
|
|---|
| 164 |
|
|---|
| 165 | // Data from socket
|
|---|
| 166 | for (unsigned int i=0; i<sizeof(List)/sizeof(int); i++) if (FD_ISSET(Socket[i], &DescriptorList)) {
|
|---|
| 167 | Ret = read(Socket[i], Buffer, sizeof(Buffer));
|
|---|
| 168 | if(Ret == 0) printf("OtherSockets: Connection to port %d not existing anymore\n", List[i]);
|
|---|
| 169 | else if (Ret == -1) printf("OtherSockets: Error reading from port %d (%s)\n", List[i], strerror(errno));
|
|---|
| 170 | else ;//printf("OtherSockets: Read %d bytes from port %d\n", Ret, List[i]);
|
|---|
| 171 | }
|
|---|
| 172 | }
|
|---|
| 173 |
|
|---|
| 174 | // Close all sockets
|
|---|
| 175 | for (unsigned int i=0; i<sizeof(List)/sizeof(int); i++) {
|
|---|
| 176 | if ((Socket[i] != -1) && (close(Socket[i]) == -1)) {
|
|---|
| 177 | printf("OtherSockets: Could not close socket of port %d (%s)", List[i], strerror(errno));
|
|---|
| 178 | }
|
|---|
| 179 | }
|
|---|
| 180 | }
|
|---|