18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci *	arch/alpha/lib/srm_printk.c
48c2ecf20Sopenharmony_ci */
58c2ecf20Sopenharmony_ci
68c2ecf20Sopenharmony_ci#include <linux/kernel.h>
78c2ecf20Sopenharmony_ci#include <asm/console.h>
88c2ecf20Sopenharmony_ci
98c2ecf20Sopenharmony_cilong
108c2ecf20Sopenharmony_cisrm_printk(const char *fmt, ...)
118c2ecf20Sopenharmony_ci{
128c2ecf20Sopenharmony_ci	static char buf[1024];
138c2ecf20Sopenharmony_ci	va_list args;
148c2ecf20Sopenharmony_ci	long len, num_lf;
158c2ecf20Sopenharmony_ci	char *src, *dst;
168c2ecf20Sopenharmony_ci
178c2ecf20Sopenharmony_ci	va_start(args, fmt);
188c2ecf20Sopenharmony_ci	len = vsprintf(buf, fmt, args);
198c2ecf20Sopenharmony_ci	va_end(args);
208c2ecf20Sopenharmony_ci
218c2ecf20Sopenharmony_ci	/* count number of linefeeds in string: */
228c2ecf20Sopenharmony_ci
238c2ecf20Sopenharmony_ci	num_lf = 0;
248c2ecf20Sopenharmony_ci	for (src = buf; *src; ++src) {
258c2ecf20Sopenharmony_ci		if (*src == '\n') {
268c2ecf20Sopenharmony_ci			++num_lf;
278c2ecf20Sopenharmony_ci		}
288c2ecf20Sopenharmony_ci	}
298c2ecf20Sopenharmony_ci
308c2ecf20Sopenharmony_ci	if (num_lf) {
318c2ecf20Sopenharmony_ci		/* expand each linefeed into carriage-return/linefeed: */
328c2ecf20Sopenharmony_ci		for (dst = src + num_lf; src >= buf; ) {
338c2ecf20Sopenharmony_ci			if (*src == '\n') {
348c2ecf20Sopenharmony_ci				*dst-- = '\r';
358c2ecf20Sopenharmony_ci			}
368c2ecf20Sopenharmony_ci			*dst-- = *src--;
378c2ecf20Sopenharmony_ci		}
388c2ecf20Sopenharmony_ci	}
398c2ecf20Sopenharmony_ci
408c2ecf20Sopenharmony_ci	srm_puts(buf, num_lf+len);
418c2ecf20Sopenharmony_ci        return len;
428c2ecf20Sopenharmony_ci}
43