chiark / gitweb /
Logging fixes.
[chiark-tcl.git] / dgram / dgram.c
index e6df127ab79bae33afa345d9268193f17f70c7eb..e541a3a2ed5891c687696d7bae982f4d18668d76 100644 (file)
@@ -4,19 +4,24 @@
  * dgram-socket create <local>                        => <sockid>
  * dgram-socket close <sockid>
  * dgram-socket transmit <sockid> <data> <remote>
- * dgram-socket on-receive <sockid> <script>
+ * dgram-socket on-receive <sockid> [<script>]
  *    calls, effectively,  eval <script> [list <data> <remote-addr> <socket>]
+ *    if script not supplied, cancel
  */
 
 #include "tables.h"
 #include "hbytes.h"
 
 typedef struct DgramSocket {
-  int fd;
+  int ix, fd, script_llength;
+  Tcl_Interp *ip;
+  Tcl_Obj *script;
+  void *addr_buf, *msg_buf;
+  int addr_buflen, msg_buflen;
 } DgramSocket;
 
 static int n_socks;
-static DgramSocket *socks;
+static DgramSocket **socks;
 
 static int sockfail(Tcl_Interp *ip, int fd, const char *m) {
   int e;
@@ -26,17 +31,18 @@ static int sockfail(Tcl_Interp *ip, int fd, const char *m) {
 }
 
 int do_dgram_socket_create(ClientData cd, Tcl_Interp *ip,
-                         SockAddr_Value local, int *sock_r) {
-  int fd, al, r, sock;
+                         SockAddr_Value local, DgramSockID *sock_r) {
+  int fd, al, r, sockix;
+  DgramSocket *sock;
   const struct sockaddr *sa;
 
-  for (sock=0; sock<n_socks && socks[sock].fd>=0; sock++);
-  if (sock>=n_socks) {
+  for (sockix=0; sockix<n_socks && socks[sockix]; sockix++);
+  if (sockix>=n_socks) {
     n_socks += 2;
     n_socks *= 2;
     socks= (void*)Tcl_Realloc((void*)socks, n_socks*sizeof(*socks));
-    while (sock<n_socks) socks[sock++].fd=-1;
-    sock--;
+    while (sockix<n_socks) socks[sockix++]=0;
+    sockix--;
   }
 
   sa= sockaddr_addr(&local);
@@ -47,40 +53,168 @@ int do_dgram_socket_create(ClientData cd, Tcl_Interp *ip,
   r= bind(fd, sa, al);  if (r) return sockfail(ip,fd,"bind");
   r= setnonblock(fd, 1);  if (r) return sockfail(ip,fd,"setnonblock");
 
-  socks[sock].fd= fd;
+  socks[sockix]= sock= TALLOC(sizeof(DgramSocket));
+  sock->fd= fd;
+  sock->ix= sockix;
+  sock->script= 0;
+  sock->addr_buflen= al+1;
+  sock->addr_buf= TALLOC(sock->addr_buflen);
+  sock->msg_buflen= 0;
+  sock->msg_buf= 0;
+
   *sock_r= sock;
   return TCL_OK;
 }
 
-int do_dgram_socket_close(ClientData cd, Tcl_Interp *ip, int sock) {
-  close(socks[sock].fd); /* nothing useful to be done with errors */
-  socks[sock].fd= -1;
+int do_dgram_socket_transmit(ClientData cd, Tcl_Interp *ip,
+                            DgramSocket *sock, HBytes_Value data,
+                            SockAddr_Value remote) {
+  int l, r;
+
+  r= sendto(sock->fd,
+           hbytes_data(&data), l=hbytes_len(&data),
+           0,
+           sockaddr_addr(&remote), sockaddr_len(&remote));
+  if (r==-1) return posixerr(ip,errno,"sendto");
+  else if (r!=l) return staticerr(ip,"sendto gave wrong answer",0);
+  return TCL_OK;
+}
+
+static void cancel(DgramSocket *sock) {
+  if (sock->script) {
+    Tcl_DeleteFileHandler(sock->fd);
+    Tcl_DecrRefCount(sock->script);
+    sock->script= 0;
+  }
+}
+
+static void recv_call(ClientData sock_cd, int mask) {
+  DgramSocket *sock= (void*)sock_cd;
+  Tcl_Interp *ip= sock->ip;
+  int sz, rc, i, peek;
+  HBytes_Value message_val;
+  SockAddr_Value peer_val;
+  Tcl_Obj *args[3], *invoke;
+  struct msghdr mh;
+  struct iovec iov;
+
+  hbytes_empty(&message_val);
+  sockaddr_clear(&peer_val);
+  invoke=0; for (i=0; i<3; i++) args[i]=0;
+
+  mh.msg_iov= &iov;
+  mh.msg_iovlen= 1;
+  mh.msg_control= 0;
+  mh.msg_controllen= 0;
+  mh.msg_flags= 0;
+
+  peek= MSG_PEEK;
+  
+  for (;;) {
+    mh.msg_name= sock->addr_buf;
+    mh.msg_namelen= sock->addr_buflen;
+
+    iov.iov_base= sock->msg_buf;
+    iov.iov_len= sock->msg_buflen;
+
+    sz= recvmsg(sock->fd, &mh, peek);
+    if (sz==-1) { rc=0; goto x_rc; }
+
+    assert(mh.msg_namelen < sock->addr_buflen);
+
+    if (!(mh.msg_flags & MSG_TRUNC)) {
+      if (!peek) break;
+      peek= 0;
+      continue;
+    }
+
+    TFREE(sock->msg_buf);
+    sock->msg_buflen *= 2;
+    sock->msg_buflen += 100;
+    sock->msg_buf= TALLOC(sock->msg_buflen);
+  }
+
+  hbytes_array(&message_val, iov.iov_base, sz);
+  sockaddr_create(&peer_val, mh.msg_name, mh.msg_namelen);
+
+  args[0]= ret_hb(ip, message_val);  hbytes_empty(&message_val);
+  args[1]= ret_sockaddr(ip, peer_val);  sockaddr_clear(&peer_val);
+  args[2]= ret_sockid(ip, sock);
+  for (i=0; i<3; i++) Tcl_IncrRefCount(args[i]);
+
+  invoke= Tcl_DuplicateObj(sock->script);
+  Tcl_IncrRefCount(invoke);
+
+  rc= Tcl_ListObjReplace(ip,invoke,sock->script_llength,0,3,args);
+  for (i=0; i<3; i++) { Tcl_DecrRefCount(args[i]); args[i]= 0; }
+  if (rc) goto x_rc;
+
+  rc= Tcl_EvalObjEx(ip,invoke,TCL_EVAL_GLOBAL|TCL_EVAL_DIRECT);
+
+x_rc:
+  if (invoke) Tcl_DecrRefCount(invoke);
+
+  if (rc)
+    Tcl_BackgroundError(ip);
+}
+
+int do_dgram_socket_on_receive(ClientData cd, Tcl_Interp *ip,
+                              DgramSocket *sock, Tcl_Obj *script) {
+  int rc;
+  
+  if (script) {
+    rc= Tcl_ListObjLength(ip, script, &sock->script_llength);
+    if (rc) return rc;
+  }
+  
+  cancel(sock);
+  if (script) {
+    Tcl_IncrRefCount(script);
+    sock->script= script;
+    sock->ip= ip;
+  }
+  Tcl_CreateFileHandler(sock->fd, TCL_READABLE, recv_call, sock);
+  return TCL_OK;
+}
+
+int do_dgram_socket_close(ClientData cd, Tcl_Interp *ip, DgramSocket *sock) {
+  int sockix;
+  cancel(sock);
+  close(sock->fd); /* nothing useful to be done with errors */
+  sockix= sock->ix;
+  TFREE(sock->addr_buf);
+  TFREE(sock->msg_buf);
+  TFREE(sock);
+  socks[sockix]= 0;
   return TCL_OK;
 }
 
 /* Arg parsing */
 
-int pat_sockid(Tcl_Interp *ip, Tcl_Obj *o, int *val) {
-  int rc, sock;
+int pat_sockid(Tcl_Interp *ip, Tcl_Obj *o, DgramSocket **val) {
+  int rc, sockix;
+  DgramSocket *sock;
   
-  rc= Tcl_ConvertToType(ip,o,&sockid_type);
+  rc= Tcl_ConvertToType(ip,o,&dgramsockid_type);
   if (rc) return rc;
 
-  sock= o->internalRep.longValue;
-  if (sock >= n_socks || socks[sock].fd==-1)
-    return staticerr(ip,"dgram socket not open");
+  sockix= o->internalRep.longValue;
+  if (sockix >= n_socks || !(sock= socks[sockix]))
+    return staticerr(ip,"dgram socket not open",0);
+
+  assert(socks[sockix]->ix == sockix);
 
   *val= sock;
   return TCL_OK;
 }
 
-Tcl_Obj *ret_sockid(Tcl_Interp *ip, int val) {
+Tcl_Obj *ret_sockid(Tcl_Interp *ip, DgramSocket *val) {
   Tcl_Obj *o;
 
   o= Tcl_NewObj();
   Tcl_InvalidateStringRep(o);
-  o->internalRep.longValue= val;
-  o->typePtr= &sockid_type;
+  o->internalRep.longValue= val->ix;
+  o->typePtr= &dgramsockid_type;
   return o;
 }
 
@@ -88,16 +222,17 @@ static void sockid_t_free(Tcl_Obj *o) { }
 
 static void sockid_t_dup(Tcl_Obj *src, Tcl_Obj *dup) {
   dup->internalRep= src->internalRep;
+  dup->typePtr= &dgramsockid_type;
 }
 
 static void sockid_t_ustr(Tcl_Obj *o) {
-  char buf[100];
-  int l;
+  char buf[75];
 
-  snprintf(buf,sizeof(buf),"dgramsock%d", (int)o->internalRep.longValue);
-  l= o->length= strlen(buf);
-  o->bytes= TALLOC(l+1);
-  strcpy(o->bytes, buf);
+  snprintf(buf,sizeof(buf), "%d", (int)o->internalRep.longValue);
+  obj_updatestr_vstringls(o,
+                         "dgramsock",9,
+                         buf, strlen(buf),
+                         (char*)0);
 }
 
 static int sockid_t_sfa(Tcl_Interp *ip, Tcl_Obj *o) {
@@ -105,15 +240,18 @@ static int sockid_t_sfa(Tcl_Interp *ip, Tcl_Obj *o) {
   char *ep, *str;
   
   str= Tcl_GetStringFromObj(o,0);
-  if (memcmp(str,"dgramsock",9)) return staticerr(ip,"bad dgram socket id");
+  if (memcmp(str,"dgramsock",9)) return staticerr(ip,"bad dgram socket id",0);
   errno=0; ul=strtoul(str+9,&ep,10);
-  if (errno || *ep) return staticerr(ip,"bad dgram socket id number");
-  if (ul > INT_MAX) return staticerr(ip,"out of range dgram socket id");
+  if (errno || *ep) return staticerr(ip,"bad dgram socket id number",0);
+  if (ul > INT_MAX) return staticerr(ip,"out of range dgram socket id",0);
+
+  objfreeir(o);
   o->internalRep.longValue= ul;
+  o->typePtr= &dgramsockid_type;
   return TCL_OK;
 }
 
-Tcl_ObjType sockid_type = {
-  "sockid-nearly",
+Tcl_ObjType dgramsockid_type = {
+  "dgramsockid",
   sockid_t_free, sockid_t_dup, sockid_t_ustr, sockid_t_sfa
 };