1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
|
/***************************************************************************
* Copyright (c) 2024 Microsoft Corporation
* Copyright (c) 2026-present Eclipse ThreadX contributors
*
* This program and the accompanying materials are made available under the
* terms of the MIT License which is available at
* https://opensource.org/licenses/MIT.
*
* SPDX-License-Identifier: MIT
**************************************************************************/
/**************************************************************************/
/**************************************************************************/
/** */
/** USBX Component */
/** */
/** OHCI Controller Driver */
/** */
/**************************************************************************/
/**************************************************************************/
/* Include necessary system files. */
#define UX_SOURCE_CODE
#include "ux_api.h"
#include "ux_host_stack.h"
#include "ux_hcd_ohci.h"
/**************************************************************************/
/* */
/* FUNCTION RELEASE */
/* */
/* _ux_hcd_ohci_periodic_endpoint_destroy PORTABLE C */
/* 6.1.2 */
/* AUTHOR */
/* */
/* Chaoqiong Xiao, Microsoft Corporation */
/* */
/* DESCRIPTION */
/* */
/* This function will destroy an interrupt or isochronous endpoint. */
/* */
/* INPUT */
/* */
/* hcd_ohci Pointer to OHCI controller */
/* endpoint Pointer to endpoint */
/* */
/* OUTPUT */
/* */
/* Completion Status */
/* */
/* CALLS */
/* */
/* _ux_utility_delay_ms Delay ms */
/* */
/* CALLED BY */
/* */
/* OHCI Controller Driver */
/* */
/**************************************************************************/
UINT _ux_hcd_ohci_periodic_endpoint_destroy(UX_HCD_OHCI *hcd_ohci, UX_ENDPOINT *endpoint)
{
UX_OHCI_ED *ed;
UX_OHCI_ED *previous_ed;
UX_OHCI_ED *next_ed;
UX_OHCI_TD *tail_td;
UX_OHCI_TD *head_td;
ULONG value_td;
UX_PARAMETER_NOT_USED(hcd_ohci);
/* From the endpoint container fetch the OHCI ED descriptor. */
ed = (UX_OHCI_ED*) endpoint -> ux_endpoint_ed;
/* Check if this physical endpoint has been initialized properly! */
if (ed == UX_NULL)
{
/* Error trap. */
_ux_system_error_handler(UX_SYSTEM_LEVEL_THREAD, UX_SYSTEM_CONTEXT_HCD, UX_ENDPOINT_HANDLE_UNKNOWN);
/* If trace is enabled, insert this event into the trace buffer. */
UX_TRACE_IN_LINE_INSERT(UX_TRACE_ERROR, UX_ENDPOINT_HANDLE_UNKNOWN, endpoint, 0, 0, UX_TRACE_ERRORS, 0, 0)
return(UX_ENDPOINT_HANDLE_UNKNOWN);
}
/* The endpoint may be active. If so, set the skip bit. */
ed -> ux_ohci_ed_dw0 |= UX_OHCI_ED_SKIP;
/* Wait for the controller to finish the current frame processing. */
_ux_utility_delay_ms(1);
/* Get the previous ED in the list for this ED. */
previous_ed = ed -> ux_ohci_ed_previous_ed;
/* Get the next ED in the list for this ED. */
next_ed = ed -> ux_ohci_ed_next_ed;
/* The previous ED points now to the ED after the ED we are removing. */
previous_ed -> ux_ohci_ed_next_ed = next_ed;
/* There may not be any next endpoint. But if there is one, link it
to the previous ED. */
if (next_ed != UX_NULL)
{
/* Update the previous ED pointer in the next ED. */
next_ed = _ux_utility_virtual_address(next_ed);
next_ed -> ux_ohci_ed_previous_ed = previous_ed;
}
/* Ensure that the potential Halt bit is removed in the head ED. */
value_td = (ULONG) _ux_utility_virtual_address(ed -> ux_ohci_ed_head_td) & UX_OHCI_ED_MASK_TD;
head_td = (UX_OHCI_TD *)value_td;
/* Remove all the tds from this ED and leave the head and tail pointing
to the dummy TD. */
tail_td = _ux_utility_virtual_address(ed -> ux_ohci_ed_tail_td);
/* Free all tds attached to the ED */
while (head_td != tail_td)
{
/* Update the head TD with the next TD. */
ed -> ux_ohci_ed_head_td = head_td -> ux_ohci_td_next_td;
/* Mark the current head TD as free. */
head_td -> ux_ohci_td_status = UX_UNUSED;
/* Now the new head TD is the next TD in the chain. */
head_td = _ux_utility_virtual_address(ed -> ux_ohci_ed_head_td);
}
/* We need to free the dummy TD that was attached to the ED. */
tail_td -> ux_ohci_td_status = UX_UNUSED;
/* Now we can safely make the ED free. */
ed -> ux_ohci_ed_status = UX_UNUSED;
/* Return success. */
return(UX_SUCCESS);
}
|
