/*
 * Copyright 2024 Hangzhou Yingyi Technology Co., Ltd
 * 
 * Licensed under the Apache License, Version 2.0 (the "License");
 * you may not use this file except in compliance with the License.
 * You may obtain a copy of the License at
 *
 *    http://www.apache.org/licenses/LICENSE-2.0

 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 */

#include <raspi/mbox.h>
#include <libfdt.h>
#include <uk/plat/console.h>
#include <uk/config.h>
#include <arm/cpu.h>
#include <uk/essentials.h>
#include <uk/tty/pl011.h>
#include <raspi/gpio.h>
#include <uk/assert.h>

void _libraspiplat_init_console(void *dtb)
{
	PL011_REG_WRITE(REG_UARTCR_OFFSET, 0);
	/* set up clock for consistent divisor values */
	/* ARM to VedioCore*/
	mbox_msg_create(9, 4*9, MBOX_REQUEST, MBOX_TAG_SETCLKRATE,
			12, 8, 2, 4000000, 0, MBOX_TAG_LAST);

	if (mbox_call(MBOX_CH_PROP) != 1) {
		UK_CRASH("mbox call failed!\n");
		return;
	}

	if (map_uart_to_gpio()) {
		UK_CRASH("gpio mapping failed!\n");
		return;
	}

	pl011_console_init(dtb);
}