| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111 |
- #include <stdio.h>
- #include <signal.h>
- #include <string.h>
- #include <fcntl.h>
- #include <sys/time.h>
- #include <sys/socket.h>
- #include <netinet/in.h>
- #include <linux/kd.h>
- #define CLK_FREQ 1193180
- int term;
- static int ident = 0x42454550;
- enum cmd_t {CMD_KA, CMD_PING, CMD_QUIT, CMD_PLAY, CMD_CAPS};
- struct cmd_buffer {
- int cmd;
- union {
- int data[8];
- char string[8*sizeof(int)];
- };
- };
- void sigalrm(int sig) {
- ioctl(term, KIOCSOUND, 0);
- }
- int main(int argc, char **argv) {
- struct sockaddr_in addr, remote;
- int sock, rlen = sizeof(remote), i, len_uid = 0;
- struct itimerval tmr;
- struct cmd_buffer cmd;
- struct sigaction sa;
- if(argc > 1) {
- len_uid = strlen(argv[1]);
- }
- if((term = open("/dev/console", O_WRONLY)) < 0) {
- perror("open");
- return 1;
- }
- if((sock = socket(AF_INET, SOCK_DGRAM, 0)) < 0) {
- perror("socket");
- return 1;
- }
- memset(&addr, 0, sizeof(addr));
- addr.sin_family = AF_INET;
- addr.sin_addr.s_addr = htonl(INADDR_ANY);
- addr.sin_port = htons(13676);
- if((bind(sock, (struct sockaddr *) &addr, sizeof(addr))) < 0) {
- perror("bind");
- return 1;
- }
- sa.sa_handler = sigalrm;
- sa.sa_flags = SA_NODEFER | SA_RESTART;
- sigemptyset(&sa.sa_mask);
- sigaction(SIGALRM, &sa, NULL);
- printf("Ready to begin (listening on 13676)\n");
- memset(&tmr, 0, sizeof(tmr));
- while(1) {
- if(recvfrom(sock, &cmd, sizeof(cmd), 0, (struct sockaddr *) &remote, &rlen) < 0) {
- perror("recvfrom");
- return 1;
- }
- cmd.cmd = ntohl(cmd.cmd);
- for(i = 0; i < 8; i++) cmd.data[i] = ntohl(cmd.data[i]);
- /* printf("From %s:%d, cmd %d\n", inet_ntoa(remote.sin_addr.s_addr), remote.sin_port, cmd.cmd); */
- switch((enum cmd_t) cmd.cmd) {
- case CMD_QUIT:
- return 0;
- break;
- case CMD_PING:
- sendto(sock, &cmd, sizeof(cmd), 0, (struct sockaddr *) &remote, rlen);
- break;
- case CMD_PLAY:
- tmr.it_value.tv_sec = cmd.data[0];
- tmr.it_value.tv_usec = cmd.data[1];
- setitimer(ITIMER_REAL, &tmr, NULL);
- ioctl(term, KIOCSOUND, (int) (CLK_FREQ / cmd.data[2]));
- break;
- case CMD_CAPS:
- cmd.data[0] = htonl(1);
- cmd.data[1] = htonl(ident);
- for(i = 0; i < 6 * sizeof(int); i++) {
- if(argc > 1 && i < len_uid) {
- cmd.string[i+8] = argv[1][i];
- } else {
- cmd.string[i+8] = '\0';
- }
- }
- sendto(sock, &cmd, sizeof(cmd), 0, (struct sockaddr *) &remote, rlen);
- break;
-
- default:
- printf("WARNING: Unknown cmd %d\n", cmd.cmd);
- case CMD_KA:
- break;
- }
- }
- }
|