X-Git-Url: https://codewiz.org/gitweb?a=blobdiff_plain;ds=sidebyside;f=bertos%2Fdrv%2Fser.c;h=a684ebbaf6cdcb22767afe8ad248fb09db685235;hb=32d1445272120a254d77ce8d1af1f527da7a2c17;hp=5f2b6fcd66af4298bdae8d95891c31276854ed57;hpb=8200b51bd42e69333cbb3d50532bbd8b45201da2;p=bertos.git

diff --git a/bertos/drv/ser.c b/bertos/drv/ser.c
index 5f2b6fcd..a684ebba 100644
--- a/bertos/drv/ser.c
+++ b/bertos/drv/ser.c
@@ -52,40 +52,33 @@
 
 #include "ser.h"
 #include "wdt.h"
+#include "timer.h"
 #include "ser_p.h"
 
 #include "cfg/cfg_ser.h"
-#include "cfg/cfg_kern.h"
+#include "cfg/cfg_proc.h"
 #include <cfg/debug.h>
 
 #include <mware/formatwr.h>
 
-#include <string.h> /* memset */
+#include <cpu/power.h> /* cpu_relax() */
+
+#include <string.h> /* memset() */
 
 /*
  * Sanity check for config parameters required by this module.
  */
-#if !defined(CONFIG_KERNEL) || ((CONFIG_KERNEL != 0) && CONFIG_KERNEL != 1)
-	#error CONFIG_KERNEL must be set to either 0 or 1 in config.h
+#if !defined(CONFIG_KERN) || ((CONFIG_KERN != 0) && CONFIG_KERN != 1)
+	#error CONFIG_KERN must be set to either 0 or 1 in cfg_kern.h
 #endif
 #if !defined(CONFIG_SER_RXTIMEOUT)
-	#error CONFIG_SER_TXTIMEOUT missing in config.h
+	#error CONFIG_SER_TXTIMEOUT missing in cfg_ser.h
 #endif
 #if !defined(CONFIG_SER_RXTIMEOUT)
-	#error CONFIG_SER_RXTIMEOUT missing in config.h
+	#error CONFIG_SER_RXTIMEOUT missing in cfg_ser.h
 #endif
 #if !defined(CONFIG_SER_DEFBAUDRATE)
-	#error CONFIG_SER_DEFBAUDRATE missing in config.h
-#endif
-
-#if CONFIG_KERNEL && CONFIG_KERN_SCHED
-	#include <kern/proc.h>
-#else
-	#define proc_yield() do {} while(0)
-#endif
-
-#if CONFIG_SER_TXTIMEOUT != -1 || CONFIG_SER_RXTIMEOUT != -1
-	#include <drv/timer.h>
+	#error CONFIG_SER_DEFBAUDRATE missing in cfg_ser.h
 #endif
 
 
@@ -114,9 +107,7 @@ static int ser_putchar(int c, struct Serial *port)
 		/* Wait while buffer is full... */
 		do
 		{
-			/* Give up timeslice to other processes. */
-			proc_yield();
-			wdt_reset();
+			cpu_relax();
 
 #if CONFIG_SER_TXTIMEOUT != -1
 			if (timer_clock() - start_time >= port->txtimeout)
@@ -162,9 +153,7 @@ static int ser_getchar(struct Serial *port)
 		/* Wait while buffer is empty */
 		do
 		{
-			/* Give up timeslice to other processes. */
-			proc_yield();
-			wdt_reset();
+			cpu_relax();
 
 #if CONFIG_SER_RXTIMEOUT != -1
 			if (timer_clock() - start_time >= port->rxtimeout)
@@ -252,38 +241,20 @@ static size_t ser_write(struct KFile *fd, const void *_buf, size_t size)
 #if CONFIG_SER_RXTIMEOUT != -1 || CONFIG_SER_TXTIMEOUT != -1
 void ser_settimeouts(struct Serial *fd, mtime_t rxtimeout, mtime_t txtimeout)
 {
-	fd->rxtimeout = ms_to_ticks(rxtimeout);
-	fd->txtimeout = ms_to_ticks(txtimeout);
+	#if CONFIG_SER_RXTIMEOUT != -1
+		fd->rxtimeout = ms_to_ticks(rxtimeout);
+	#else
+		(void)rxtimeout;
+	#endif
+
+	#if CONFIG_SER_TXTIMEOUT != -1
+		fd->txtimeout = ms_to_ticks(txtimeout);
+	#else
+		(void)txtimeout;
+	#endif
 }
 #endif /* CONFIG_SER_RXTIMEOUT || CONFIG_SER_TXTIMEOUT */
 
-#if CONFIG_SER_RXTIMEOUT != -1
-/**
- * Discard input to resynchronize with remote end.
- *
- * Discard incoming data until the port stops receiving
- * characters for at least \a delay milliseconds.
- *
- * \note Serial errors are reset before and after executing the purge.
- */
-void ser_resync(struct Serial *fd, mtime_t delay)
-{
-	mtime_t old_rxtimeout = ticks_to_ms(fd->rxtimeout);
-
-	ser_settimeouts(fd, delay, ticks_to_ms(fd->txtimeout));
-	do
-	{
-		ser_setstatus(fd, 0);
-		ser_getchar(fd);
-	}
-	while (!(ser_getstatus(fd) & SERRF_RXTIMEOUT));
-
-	/* Restore port to an usable status */
-	ser_setstatus(fd, 0);
-	ser_settimeouts(fd, old_rxtimeout, ticks_to_ms(fd->txtimeout));
-}
-#endif /* CONFIG_SER_RXTIMEOUT */
-
 
 void ser_setbaudrate(struct Serial *fd, unsigned long rate)
 {
@@ -354,11 +325,7 @@ static int ser_flush(struct KFile *fd)
 	 */
 	while (!fifo_isempty(&fds->txfifo)
 	       || fds->hw->table->txSending(fds->hw))
-	{
-			/* Give up timeslice to other processes. */
-			proc_yield();
-			wdt_reset();
-	}
+		cpu_relax();
 	return 0;
 }