53 lines
1.4 KiB
C
53 lines
1.4 KiB
C
|
// Copyright 2022-2023 Beken
|
||
|
|
//
|
||
|
|
// 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 "arch_delay.h"
|
||
|
|
|
||
|
|
void arch_delay_us(uint32_t us)
|
||
|
|
{
|
||
|
|
uint32_t ret;
|
||
|
|
uint32_t div;
|
||
|
|
uint32_t clk = 0;
|
||
|
|
uint32_t cell;
|
||
|
|
SYS_CTRL_U param;
|
||
|
|
|
||
|
|
ret = sddev_control(DD_DEV_TYPE_SCTRL, CMD_GET_SCTRL_CONTROL, ¶m);
|
||
|
|
BK_ASSERT(SCTRL_SUCCESS == ret); /* ASSERT VERIFIED */
|
||
|
|
|
||
|
|
div = param.bits.mclk_div;
|
||
|
|
switch (param.bits.mclk_mux) {
|
||
|
|
case MCLK_MODE_DCO:
|
||
|
|
case MCLK_MODE_26M_XTAL:
|
||
|
|
clk = 26000000;
|
||
|
|
break;
|
||
|
|
|
||
|
|
case MCLK_MODE_DPLL:
|
||
|
|
clk = 480000000 / (2 << div);
|
||
|
|
break;
|
||
|
|
|
||
|
|
case MCLK_MODE_LPO:
|
||
|
|
clk = 32000;
|
||
|
|
break;
|
||
|
|
|
||
|
|
default:
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
|
||
|
|
BK_ASSERT(clk); /* ASSERT VERIFIED */
|
||
|
|
|
||
|
|
cell = 100 * clk / 26000;
|
||
|
|
delay(ms_count * cell);
|
||
|
|
}
|
||
|
|
|