source: mainline/uspace/drv/bus/usb/ohci/ohci.c@ 6297465

lfn serial ticket/834-toolchain-update topic/msim-upgrade topic/simplify-dev-export
Last change on this file since 6297465 was 952bc66, checked in by Jan Vesely <jano.vesely@…>, 12 years ago

ohci, uhci: Don't unregister interrupt handler on setup failure.

This is handled by the library helper.

  • Property mode set to 100644
File size: 4.7 KB
Line 
1/*
2 * Copyright (c) 2011 Jan Vesely
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 *
9 * - Redistributions of source code must retain the above copyright
10 * notice, this list of conditions and the following disclaimer.
11 * - Redistributions in binary form must reproduce the above copyright
12 * notice, this list of conditions and the following disclaimer in the
13 * documentation and/or other materials provided with the distribution.
14 * - The name of the author may not be used to endorse or promote products
15 * derived from this software without specific prior written permission.
16 *
17 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 */
28
29/** @addtogroup drvusbohci
30 * @{
31 */
32/** @file
33 * @brief OHCI driver
34 */
35
36#include <assert.h>
37#include <errno.h>
38#include <ddf/interrupt.h>
39#include <device/hw_res_parsed.h>
40#include <stdbool.h>
41#include <str_error.h>
42#include <sys/types.h>
43
44#include <usb/usb.h>
45#include <usb/debug.h>
46
47#include <usb/host/ddf_helpers.h>
48#include <usb/host/usb_bus.h>
49
50#include "ohci.h"
51#include "ohci_endpoint.h"
52#include "hc.h"
53
54
55/** IRQ handling callback, identifies device
56 *
57 * @param[in] dev DDF instance of the device to use.
58 * @param[in] iid (Unused).
59 * @param[in] call Pointer to the call that represents interrupt.
60 */
61static void irq_handler(ddf_dev_t *dev, ipc_callid_t iid, ipc_call_t *call)
62{
63 assert(dev);
64 hcd_t *hcd = dev_to_hcd(dev);
65 if (!hcd || !hcd->driver.data) {
66 usb_log_warning("Interrupt on device that is not ready.\n");
67 return;
68 }
69
70 const uint16_t status = IPC_GET_ARG1(*call);
71 hc_interrupt(hcd->driver.data, status);
72}
73
74/** Initialize hc and rh ddf structures and their respective drivers.
75 *
76 * @param[in] device DDF instance of the device to use.
77 * @param[in] instance OHCI structure to use.
78 *
79 * This function does all the preparatory work for hc and rh drivers:
80 * - gets device hw resources
81 * - disables OHCI legacy support
82 * - asks for interrupt
83 * - registers interrupt handler
84 */
85int device_setup_ohci(ddf_dev_t *device)
86{
87 hw_res_list_parsed_t hw_res;
88 int ret = hcd_ddf_get_registers(device, &hw_res);
89 if (ret != EOK ||
90 hw_res.irqs.count != 1 || hw_res.mem_ranges.count != 1) {
91 usb_log_error("Failed to get register memory addresses "
92 "for %" PRIun ": %s.\n", ddf_dev_get_handle(device),
93 str_error(ret));
94 return ret;
95 }
96 addr_range_t regs = hw_res.mem_ranges.ranges[0];
97 const int irq = hw_res.irqs.irqs[0];
98 hw_res_list_parsed_clean(&hw_res);
99
100 usb_log_debug("Memory mapped regs at %p (size %zu), IRQ %d.\n",
101 RNGABSPTR(regs), RNGSZ(regs), irq);
102
103 /* Initialize generic HCD driver */
104 ret = hcd_ddf_setup_hc(device, USB_SPEED_FULL,
105 BANDWIDTH_AVAILABLE_USB11, bandwidth_count_usb11);
106 if (ret != EOK) {
107 usb_log_error("Failed to setup generic hcd structures: %s.",
108 str_error(ret));
109 return ret;
110 }
111
112 hc_t *hc = malloc(sizeof(hc_t));
113 if (!hc) {
114 usb_log_error("Failed to allocate driver structure.\n");
115 ret = ENOMEM;
116 goto ddf_hc_clean;
117 }
118
119 /* Try to enable interrupts */
120 bool interrupts = false;
121 ret = hcd_ddf_setup_interrupts(device, &regs, irq, irq_handler,
122 hc_gen_irq_code);
123 if (ret != EOK) {
124 usb_log_warning("Failed to enable interrupts: %s."
125 " Falling back to polling\n", str_error(ret));
126 } else {
127 usb_log_debug("Hw interrupts enabled.\n");
128 interrupts = true;
129 }
130
131 /* Initialize OHCI HC */
132 ret = hc_init(hc, &regs, interrupts);
133 if (ret != EOK) {
134 usb_log_error("Failed to init hc: %s.\n", str_error(ret));
135 goto unregister_irq;
136 }
137
138 /* Connect OHCI to generic HCD */
139 hcd_set_implementation(dev_to_hcd(device), hc,
140 hc_schedule, ohci_endpoint_init, ohci_endpoint_fini);
141
142 /* HC should be running OK. We can add root hub */
143 ret = hcd_ddf_setup_root_hub(device);
144 if (ret != EOK) {
145 usb_log_error("Failed to register OHCI root hub: %s.\n",
146 str_error(ret));
147 hc_fini(hc);
148unregister_irq:
149 unregister_interrupt_handler(device, irq);
150 free(hc);
151ddf_hc_clean:
152 hcd_ddf_clean_hc(device);
153 }
154 return ret;
155}
156/**
157 * @}
158 */
Note: See TracBrowser for help on using the repository browser.