sdcc-3.9.0 fork implementing GNU assembler syntax

This fork aims to provide better support for stm8-binutils

1 files changed, 66 insertions, 0 deletions

diff --git a/device/lib/mblen.c b/device/lib/mblen.c
new file mode 100644
index 0000000..123e3dd
--- /dev/null
+++ b/device/lib/mblen.c
@@ -0,0 +1,66 @@
+/*-------------------------------------------------------------------------
+   mblen.c - determine number of bytes in next multibyte character
+
+   Copyright (C) 2016, Philipp Klaus Krause, pkk@spth.de
+
+   This library is free software; you can redistribute it and/or modify it
+   under the terms of the GNU General Public License as published by the
+   Free Software Foundation; either version 2, or (at your option) any
+   later version.
+
+   This library is distributed in the hope that it will be useful,
+   but WITHOUT ANY WARRANTY; without even the implied warranty of
+   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+   GNU General Public License for more details.
+
+   You should have received a copy of the GNU General Public License 
+   along with this library; see the file COPYING. If not, write to the
+   Free Software Foundation, 51 Franklin Street, Fifth Floor, Boston,
+   MA 02110-1301, USA.
+
+   As a special exception, if you link this library with other files,
+   some of which are compiled with SDCC, to produce an executable,
+   this library does not by itself cause the resulting executable to
+   be covered by the GNU General Public License. This exception does
+   not however invalidate any other reasons why the executable file
+   might be covered by the GNU General Public License.
+-------------------------------------------------------------------------*/
+
+#include <stdlib.h>
+
+int mblen(const char *s, size_t n)
+{
+	unsigned char m = 0;
+	unsigned char c;
+
+	if(!s)
+		return(0);
+
+	if(!n)
+		return(-1);
+
+	c = *s;
+
+	if(!c)
+		return(0);
+
+	if(c <= 0x7f)
+		return(1);
+
+	while(c & 0x80)
+	{
+		c <<= 1;
+		m++;
+	}
+
+	if(m > n)
+		return(-1);
+
+	n = m;
+	while(--m)
+		if((*++s & 0xc0) != 0x80)
+			return(-1);
+
+	return(n);
+}
+