diff options
Diffstat (limited to 'source/hal/source/platform/mps3/source')
-rw-r--r-- | source/hal/source/platform/mps3/source/platform_drivers.c | 12 | ||||
-rw-r--r-- | source/hal/source/platform/mps3/source/vsi_mps3.c | 62 |
2 files changed, 73 insertions, 1 deletions
diff --git a/source/hal/source/platform/mps3/source/platform_drivers.c b/source/hal/source/platform/mps3/source/platform_drivers.c index 73b388b..1f55bb9 100644 --- a/source/hal/source/platform/mps3/source/platform_drivers.c +++ b/source/hal/source/platform/mps3/source/platform_drivers.c @@ -1,5 +1,5 @@ /* - * SPDX-FileCopyrightText: Copyright 2022-2023 Arm Limited and/or its affiliates <open-source-office@arm.com> + * SPDX-FileCopyrightText: Copyright 2022-2024 Arm Limited and/or its affiliates <open-source-office@arm.com> * SPDX-License-Identifier: Apache-2.0 * * Licensed under the Apache License, Version 2.0 (the "License"); @@ -40,6 +40,10 @@ #endif /* ARM_NPU */ +#if VSI_ENABLED +#include "vsi_mps3.h" +#endif /* VSI_ENABLED */ + /** * @brief Checks if the platform is valid by checking * the CPU ID for the FPGA implementation against @@ -94,6 +98,12 @@ int platform_init(void) #endif /* ARM_NPU */ +#if VSI_ENABLED + if (0 != (err = vsi_init())) { + return err; + } +#endif /* VSI_ENABLED */ + /* Print target design info */ info("Target system design: %s\n", s_platform_name); return 0; diff --git a/source/hal/source/platform/mps3/source/vsi_mps3.c b/source/hal/source/platform/mps3/source/vsi_mps3.c new file mode 100644 index 0000000..8516c1c --- /dev/null +++ b/source/hal/source/platform/mps3/source/vsi_mps3.c @@ -0,0 +1,62 @@ +/* + * SPDX-FileCopyrightText: Copyright 2024 Arm Limited and/or its affiliates <open-source-office@arm.com> + * SPDX-License-Identifier: Apache-2.0 + * + * 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 "vsi_mps3.h" + +#include "log_macros.h" +#include "RTE_Components.h" +#include "peripheral_irqs.h" + +#include "video_drv.h" + +/* Exception / Interrupt Handler */ +#define DEFAULT_IRQ_HANDLER(handler_name) \ +void __WEAK __NO_RETURN handler_name(void); \ +void handler_name(void) { \ + while(1); \ +} + +DEFAULT_IRQ_HANDLER(ARM_VSI0_Handler) +DEFAULT_IRQ_HANDLER(ARM_VSI1_Handler) +DEFAULT_IRQ_HANDLER(ARM_VSI2_Handler) +DEFAULT_IRQ_HANDLER(ARM_VSI3_Handler) +DEFAULT_IRQ_HANDLER(ARM_VSI4_Handler) +DEFAULT_IRQ_HANDLER(ARM_VSI5_Handler) +DEFAULT_IRQ_HANDLER(ARM_VSI6_Handler) +DEFAULT_IRQ_HANDLER(ARM_VSI7_Handler) + +int vsi_init(void) +{ + /* Register the VSI handlers in our vector table. */ + NVIC_SetVector(ARM_VSI0_IRQn, (uint32_t)ARM_VSI0_Handler); + NVIC_SetVector(ARM_VSI1_IRQn, (uint32_t)ARM_VSI1_Handler); + NVIC_SetVector(ARM_VSI2_IRQn, (uint32_t)ARM_VSI2_Handler); + NVIC_SetVector(ARM_VSI3_IRQn, (uint32_t)ARM_VSI3_Handler); + NVIC_SetVector(ARM_VSI4_IRQn, (uint32_t)ARM_VSI4_Handler); + NVIC_SetVector(ARM_VSI5_IRQn, (uint32_t)ARM_VSI5_Handler); + NVIC_SetVector(ARM_VSI6_IRQn, (uint32_t)ARM_VSI6_Handler); + NVIC_SetVector(ARM_VSI7_IRQn, (uint32_t)ARM_VSI7_Handler); + + /* Initialize Video VSI. */ + if (VideoDrv_Initialize(NULL) != VIDEO_DRV_OK) { + printf_err("Failed to initialise video driver\n"); + return 1; + } + + info("VSI device initialised\n"); + + return 0; +} |