We can reuse strlen and memcpy. __pa(x) is already defined in page.h We don't have (and need) defines for error values and consuming sclp irqs is not required, as we won't be passing control to some other OS. Signed-off-by: David Hildenbrand <david@xxxxxxxxxx> --- lib/s390x/sclp-ascii.c | 28 +++++++--------------------- lib/s390x/sclp.h | 2 -- s390x/Makefile | 1 + 3 files changed, 8 insertions(+), 23 deletions(-) diff --git a/lib/s390x/sclp-ascii.c b/lib/s390x/sclp-ascii.c index dc1c3e4..dfb9e68 100644 --- a/lib/s390x/sclp-ascii.c +++ b/lib/s390x/sclp-ascii.c @@ -8,7 +8,9 @@ * directory. */ -#include "s390-ccw.h" +#include <libcflat.h> +#include <string.h> +#include <asm/page.h> #include "sclp.h" static char _sccb[PAGE_SIZE] __attribute__((__aligned__(4096))); @@ -24,11 +26,10 @@ static int sclp_service_call(unsigned int command, void *sccb) " srl %0,28" : "=&d" (cc) : "d" (command), "a" (__pa(sccb)) : "cc", "memory"); - consume_sclp_int(); if (cc == 3) - return -EIO; + return -1; if (cc == 2) - return -EBUSY; + return -1; return 0; } @@ -51,24 +52,9 @@ void sclp_setup(void) sclp_set_write_mask(); } -static int _strlen(const char *str) -{ - int i; - for (i = 0; *str; i++) - str++; - return i; -} - -static void _memcpy(char *dest, const char *src, int len) -{ - int i; - for (i = 0; i < len; i++) - dest[i] = src[i]; -} - void sclp_print(const char *str) { - int len = _strlen(str); + int len = strlen(str); WriteEventData *sccb = (void *)_sccb; sccb->h.length = sizeof(WriteEventData) + len; @@ -76,7 +62,7 @@ void sclp_print(const char *str) sccb->ebh.length = sizeof(EventBufferHeader) + len; sccb->ebh.type = SCLP_EVENT_ASCII_CONSOLE_DATA; sccb->ebh.flags = 0; - _memcpy(sccb->data, str, len); + memcpy(sccb->data, str, len); sclp_service_call(SCLP_CMD_WRITE_EVENT_DATA, sccb); } diff --git a/lib/s390x/sclp.h b/lib/s390x/sclp.h index 3cbfb78..c48cc21 100644 --- a/lib/s390x/sclp.h +++ b/lib/s390x/sclp.h @@ -102,6 +102,4 @@ typedef struct ReadEventData { uint32_t mask; } __attribute__((packed)) ReadEventData; -#define __pa(x) (x) - #endif /* SCLP_H */ diff --git a/s390x/Makefile b/s390x/Makefile index 549c1c0..0f72c9e 100644 --- a/s390x/Makefile +++ b/s390x/Makefile @@ -20,6 +20,7 @@ cflatobjs += lib/util.o cflatobjs += lib/alloc.o cflatobjs += lib/s390x/io.o cflatobjs += lib/s390x/stack.o +cflatobjs += lib/s390x/sclp-ascii.o cstart.o = $(TEST_DIR)/cstart64.o -- 2.9.3