blob: 5a5ccd0676cdbeaa4dac749618611e8b497f12bb [file] [log] [blame]
Tom Rini83d290c2018-05-06 17:58:06 -04001// SPDX-License-Identifier: GPL-2.0+
Stefan Agnera3774c12017-08-16 11:00:54 -07002/*
3 * (C) Copyright 2016 Toradex
4 * Author: Stefan Agner <stefan.agner@toradex.com>
Stefan Agnera3774c12017-08-16 11:00:54 -07005 */
6
7#include <common.h>
Simon Glassf7ae49f2020-05-10 11:40:05 -06008#include <log.h>
Stefan Agnera3774c12017-08-16 11:00:54 -07009#include <spl.h>
10#include <usb.h>
11#include <g_dnl.h>
12#include <sdp.h>
13
Stefan Agnera3774c12017-08-16 11:00:54 -070014static int spl_sdp_load_image(struct spl_image_info *spl_image,
15 struct spl_boot_device *bootdev)
16{
Ye Li407e3842020-04-29 10:35:12 +080017 const int controller_index = CONFIG_SPL_SDP_USB_DEV;
Marek Vasut6b84acc2023-09-01 11:49:58 +020018 struct udevice *udc;
19 int ret;
Stefan Agnera3774c12017-08-16 11:00:54 -070020
Marek Vasut6b84acc2023-09-01 11:49:58 +020021 ret = udc_device_get_by_index(controller_index, &udc);
22 if (ret)
23 return ret;
Frank Li62597d22020-04-29 10:35:10 +080024
Fabio Estevam16aabfe2022-07-13 17:39:46 -030025 board_usb_init(controller_index, USB_INIT_DEVICE);
Frank Li0ced2fa2020-08-18 18:16:43 +080026
Stefan Agnera3774c12017-08-16 11:00:54 -070027 g_dnl_clear_detach();
Sjoerd Simons25ee9242019-06-04 21:01:55 +020028 ret = g_dnl_register("usb_dnl_sdp");
29 if (ret) {
30 pr_err("SDP dnl register failed: %d\n", ret);
Marek Vasut99924db2023-09-01 11:49:57 +020031 goto err_detach;
Sjoerd Simons25ee9242019-06-04 21:01:55 +020032 }
Stefan Agnera3774c12017-08-16 11:00:54 -070033
Marek Vasut6b84acc2023-09-01 11:49:58 +020034 ret = sdp_init(udc);
Stefan Agnera3774c12017-08-16 11:00:54 -070035 if (ret) {
Andre Heider24ccd0c2018-02-15 07:08:55 +010036 pr_err("SDP init failed: %d\n", ret);
Marek Vasut99924db2023-09-01 11:49:57 +020037 goto err_unregister;
Stefan Agnera3774c12017-08-16 11:00:54 -070038 }
39
Frieder Schrempf2c72ead2019-06-04 21:56:29 +020040 /*
41 * This command either loads a legacy image, jumps and never returns,
42 * or it loads a FIT image and returns it to be handled by the SPL
43 * code.
44 */
Marek Vasut6b84acc2023-09-01 11:49:58 +020045 ret = spl_sdp_handle(udc, spl_image, bootdev);
Frieder Schrempf2c72ead2019-06-04 21:56:29 +020046 debug("SDP ended\n");
Stefan Agnera3774c12017-08-16 11:00:54 -070047
Marek Vasut99924db2023-09-01 11:49:57 +020048err_unregister:
49 g_dnl_unregister();
50err_detach:
Marek Vasut6b84acc2023-09-01 11:49:58 +020051 udc_device_put(udc);
Frieder Schrempf2c72ead2019-06-04 21:56:29 +020052 return ret;
Stefan Agnera3774c12017-08-16 11:00:54 -070053}
54SPL_LOAD_IMAGE_METHOD("USB SDP", 0, BOOT_DEVICE_BOARD, spl_sdp_load_image);