Tom Rini | 83d290c | 2018-05-06 17:58:06 -0400 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0+ |
Stefan Agner | a3774c1 | 2017-08-16 11:00:54 -0700 | [diff] [blame] | 2 | /* |
| 3 | * (C) Copyright 2016 Toradex |
| 4 | * Author: Stefan Agner <stefan.agner@toradex.com> |
Stefan Agner | a3774c1 | 2017-08-16 11:00:54 -0700 | [diff] [blame] | 5 | */ |
| 6 | |
| 7 | #include <common.h> |
Simon Glass | f7ae49f | 2020-05-10 11:40:05 -0600 | [diff] [blame] | 8 | #include <log.h> |
Stefan Agner | a3774c1 | 2017-08-16 11:00:54 -0700 | [diff] [blame] | 9 | #include <spl.h> |
| 10 | #include <usb.h> |
| 11 | #include <g_dnl.h> |
| 12 | #include <sdp.h> |
| 13 | |
Stefan Agner | a3774c1 | 2017-08-16 11:00:54 -0700 | [diff] [blame] | 14 | static int spl_sdp_load_image(struct spl_image_info *spl_image, |
| 15 | struct spl_boot_device *bootdev) |
| 16 | { |
| 17 | int ret; |
Ye Li | 407e384 | 2020-04-29 10:35:12 +0800 | [diff] [blame] | 18 | const int controller_index = CONFIG_SPL_SDP_USB_DEV; |
Stefan Agner | a3774c1 | 2017-08-16 11:00:54 -0700 | [diff] [blame] | 19 | |
Sherry Sun | d8e7755 | 2020-04-29 10:35:14 +0800 | [diff] [blame] | 20 | usb_gadget_initialize(controller_index); |
Frank Li | 62597d2 | 2020-04-29 10:35:10 +0800 | [diff] [blame] | 21 | |
Stefan Agner | a3774c1 | 2017-08-16 11:00:54 -0700 | [diff] [blame] | 22 | g_dnl_clear_detach(); |
Sjoerd Simons | 25ee924 | 2019-06-04 21:01:55 +0200 | [diff] [blame] | 23 | ret = g_dnl_register("usb_dnl_sdp"); |
| 24 | if (ret) { |
| 25 | pr_err("SDP dnl register failed: %d\n", ret); |
| 26 | return ret; |
| 27 | } |
Stefan Agner | a3774c1 | 2017-08-16 11:00:54 -0700 | [diff] [blame] | 28 | |
| 29 | ret = sdp_init(controller_index); |
| 30 | if (ret) { |
Andre Heider | 24ccd0c | 2018-02-15 07:08:55 +0100 | [diff] [blame] | 31 | pr_err("SDP init failed: %d\n", ret); |
Stefan Agner | a3774c1 | 2017-08-16 11:00:54 -0700 | [diff] [blame] | 32 | return -ENODEV; |
| 33 | } |
| 34 | |
Frieder Schrempf | 2c72ead | 2019-06-04 21:56:29 +0200 | [diff] [blame] | 35 | /* |
| 36 | * This command either loads a legacy image, jumps and never returns, |
| 37 | * or it loads a FIT image and returns it to be handled by the SPL |
| 38 | * code. |
| 39 | */ |
| 40 | ret = spl_sdp_handle(controller_index, spl_image); |
| 41 | debug("SDP ended\n"); |
Stefan Agner | a3774c1 | 2017-08-16 11:00:54 -0700 | [diff] [blame] | 42 | |
Sherry Sun | d8e7755 | 2020-04-29 10:35:14 +0800 | [diff] [blame] | 43 | usb_gadget_release(controller_index); |
Frieder Schrempf | 2c72ead | 2019-06-04 21:56:29 +0200 | [diff] [blame] | 44 | return ret; |
Stefan Agner | a3774c1 | 2017-08-16 11:00:54 -0700 | [diff] [blame] | 45 | } |
| 46 | SPL_LOAD_IMAGE_METHOD("USB SDP", 0, BOOT_DEVICE_BOARD, spl_sdp_load_image); |