*** empty log message ***

[sympathy.git] / src / tty.c

diff --git a/src/tty.c b/src/tty.c
index 1ac8c87467fc03e3b1c78f361f48413d6397a361..3171c6c74620f0e3804df57299eaca498ac10d57 100644 (file)
--- a/src/tty.c
+++ b/src/tty.c
@@ -10,6 +10,12 @@ static char rcsid[] = "$Id$";
 
 /*
  * $Log$
+ * Revision 1.14  2008/02/23 13:05:58  staffcvs
+ * *** empty log message ***
+ *
+ * Revision 1.13  2008/02/23 11:48:37  james
+ * *** empty log message ***
+ *
  * Revision 1.12  2008/02/22 23:39:27  james
  * *** empty log message ***
  *
@@ -255,6 +261,18 @@ tty_get_status (TTY * t, TTY_Status * s)
   return 0;
 }
 
+int
+tty_get_baud (TTY * t)
+{
+  struct termios tios = { 0 };
+
+  if (tcgetattr (t->rfd, &tios))
+    return;
+
+  return speed_t_to_baud (cfgetispeed (&tios));
+}
+
+
 void
 tty_set_baud (TTY * t, int rate)
 {
@@ -344,29 +362,139 @@ typedef struct
          } \
        while (0)
 
-void
-tty_stats (TTY_Parser * p, int err, int ch)
+static void
+tty_bit_analyse (Context * c, int err, int ch)
 {
-  int c = 128;
+  int d;
   int zc = 0, oc = 0;
+  TTY_Parser *p = c->tp;
 
-  if (err)
-    p->biterrs++;
 
   bit (p, 0, zc, oc);
 
-  while (c)
+  for (d = 1; d < 0x100; d <<= 1)
     {
-      bit (p,ch & c,zc,oc);
-      c >>= 1;
+      bit (p, ch & d, zc, oc);
     }
   bit (p, 1, zc, oc);
+
+
+
+  if (err)
+    {
+      p->biterrs++;
+      gettimeofday (&p->lasterr, NULL);
+    }
+
+  if (p->biterrs)
+    {
+      log_f (c->l,
+             "<tty_bit_analyse: 0%d%d%d%d%d%d%d%d1  [%d,%d,%d,%d,%d,%d,%d,%d,%d,%d]>",
+             ch & 0x01 ? 1 : 0, ch & 0x02 ? 1 : 0, ch & 0x04 ? 1 : 0,
+             ch & 0x08 ? 1 : 0, ch & 0x10 ? 1 : 0, ch & 0x20 ? 1 : 0,
+             ch & 0x40 ? 1 : 0, ch & 0x80 ? 1 : 0, p->bitfreq[0],
+             p->bitfreq[1], p->bitfreq[2], p->bitfreq[3], p->bitfreq[4],
+             p->bitfreq[5], p->bitfreq[6], p->bitfreq[7], p->bitfreq[8],
+             p->bitfreq[9]);
+    }
+
+}
+
+void
+tty_parse_reset (Context * c)
+{
+  TTY_Parser *p = c->tp;
+  memset (p->bitfreq, 0, sizeof (p->bitfreq));
+  p->biterrs = 0;
+  p->guessed_baud = 0;
+}
+
+void
+tty_analyse (Context * c)
+{
+  TTY_Parser *p = c->tp;
+  struct timeval now, dif;
+  int i, j, max;
+
+  if (!p->biterrs)
+    {
+      p->guessed_baud = 0;
+      return;
+    }
+
+  gettimeofday (&now, NULL);
+
+  timersub (&now, &p->lasterr, &dif);
+
+  if (dif.tv_sec > 10)
+    {
+      tty_parse_reset (c);
+      return;
+    }
+
+
+  max = -1;
+  j = 0;
+  for (i = 0; i < TTY_BITFREQ_LEN; ++i)
+    {
+      if (p->bitfreq[i] > max)
+        {
+          max = p->bitfreq[i];
+          j = i;
+        }
+    }
+
+  if (c->t)
+    i = tty_get_baud (c->t);
+  else
+    i = -1;
+
+  if (j == 1)
+    {
+      /*Closest bit edge is one bit, so the baud rate is too low */
+      p->guessed_baud = -1;
+
+    }
+  else
+    {
+      if (i > 0)
+        p->guessed_baud = i / j;
+      else
+        p->guessed_baud = 0;
+
+    }
+
+  if (p->guessed_baud == -1)
+    {
+      log_f (c->l, "<tty_analyse: %6d errors, current rate %db is too low>",
+             p->biterrs, i);
+    }
+  else
+    {
+      log_f (c->l, "<tty_analyse: %6d errors, current rate %db, suggest %db>",
+             p->biterrs, i, p->guessed_baud);
+    }
+
+}
+
+TTY_Parser *
+tty_parser_new (void)
+{
+  TTY_Parser *p;
+
+  p = (TTY_Parser *) malloc (sizeof (TTY_Parser));
+
+  memset (p, 0, sizeof (TTY_Parser));
+
+  return p;
 }
 
 void
 tty_parse (Context * c, uint8_t * buf, int len)
 {
-  TTY_Parser *p = &c->t->parser;
+  TTY_Parser *p;
+
+  p = c->tp;
 
   while (len--)
     {
@@ -377,28 +505,46 @@ tty_parse (Context * c, uint8_t * buf, int len)
           switch (*buf)
             {
             case DLE:
-              tty_bit_analyse (p, 0, *buf);
+              tty_bit_analyse (c, 0, *buf);
               utf8_parse (c, *buf);
               break;
             case 0:
               p->in_errmark = 1;
               break;
             default:
-              log_f (c->l, "%s:%d DLE parsing error: \\377 \\%03o", *buf);
+              log_f (c->l, "%s:%d DLE parsing error: \\377 \\%03o", __FILE__,
+                     __LINE__, *buf);
             }
         }
       else if (p->in_errmark)
         {
           p->in_errmark = 0;
-          log_f (c->l, "%s:%d tty reports error: \\377 \\000 \\%03o", *buf);
+
+          log_f (c->l, "%s:%d tty reports error: \\377 \\000 \\%03o",
+                 __FILE__, __LINE__, *buf);
+
+          tty_bit_analyse (c, 1, *buf);
+
+          tty_analyse (c);
+
           utf8_parse (c, *buf);
-          tty_bit_analyse (p, 1, *buf);
+
           utf8_parse (c, SYM_CHAR_RESET);
+
+        }
+      else if (*buf == DLE)
+        {
+          p->in_dle = 1;
+
         }
       else
         {
-          tty_bit_analyse (p, 0, *buf);
+          tty_bit_analyse (c, 0, *buf);
+
+          tty_analyse (c);
+
           utf8_parse (c, *buf);
+
         }
       buf++;
     }