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
|
/***************************************************************************
* 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 */
/** */
/** Storage Class */
/** */
/**************************************************************************/
/**************************************************************************/
/* Include necessary system files. */
#define UX_SOURCE_CODE
#include "ux_api.h"
#include "ux_host_class_storage.h"
#include "ux_host_stack.h"
/**************************************************************************/
/* */
/* FUNCTION RELEASE */
/* */
/* _ux_host_class_storage_start_stop PORTABLE C */
/* 6.1 */
/* AUTHOR */
/* */
/* Chaoqiong Xiao, Microsoft Corporation */
/* */
/* DESCRIPTION */
/* */
/* This function starts or stops the UFI device. */
/* */
/* INPUT */
/* */
/* storage Pointer to storage class */
/* start_stop_flag 1 or 0 if start/stop */
/* */
/* OUTPUT */
/* */
/* Completion Status */
/* */
/* CALLS */
/* */
/* _ux_host_class_storage_cbw_initialize Initialize the CBW */
/* _ux_host_class_storage_transport Send transport layer command */
/* */
/* CALLED BY */
/* */
/* Storage Class */
/* */
/**************************************************************************/
UINT _ux_host_class_storage_start_stop(UX_HOST_CLASS_STORAGE *storage,
ULONG start_stop_signal)
{
UINT status;
UCHAR *cbw;
UINT command_length;
ULONG command_retry;
/* If trace is enabled, insert this event into the trace buffer. */
UX_TRACE_IN_LINE_INSERT(UX_TRACE_HOST_CLASS_STORAGE_START_STOP, storage, start_stop_signal, 0, 0, UX_TRACE_HOST_CLASS_EVENTS, 0, 0)
/* Use a pointer for the CBW, easier to manipulate. */
cbw = (UCHAR *) storage -> ux_host_class_storage_cbw;
/* Get the START_STOP Command Length. */
#ifdef UX_HOST_CLASS_STORAGE_INCLUDE_LEGACY_PROTOCOL_SUPPORT
if (storage -> ux_host_class_storage_interface -> ux_interface_descriptor.bInterfaceSubClass == UX_HOST_CLASS_STORAGE_SUBCLASS_UFI)
command_length = UX_HOST_CLASS_STORAGE_START_STOP_COMMAND_LENGTH_UFI;
else
command_length = UX_HOST_CLASS_STORAGE_START_STOP_COMMAND_LENGTH_SBC;
#else
command_length = UX_HOST_CLASS_STORAGE_START_STOP_COMMAND_LENGTH_SBC;
#endif
/* Initialize the CBW for this command. */
_ux_host_class_storage_cbw_initialize(storage, 0, 0, command_length);
/* Prepare the START STOP command block. */
*(cbw + UX_HOST_CLASS_STORAGE_CBW_CB + UX_HOST_CLASS_STORAGE_START_STOP_OPERATION) = UX_HOST_CLASS_STORAGE_SCSI_START_STOP;
/* Set the required signal. */
*(cbw + UX_HOST_CLASS_STORAGE_CBW_CB + UX_HOST_CLASS_STORAGE_START_STOP_START_BIT) = (UCHAR) start_stop_signal;
/* On floppies, this operation tends to fail a few times. So we try harder. */
for (command_retry = 0; command_retry < 50; command_retry++)
{
/* Send the command to transport layer. */
status = _ux_host_class_storage_transport(storage, UX_NULL);
/* If we have a transport error give up. */
if(status != UX_SUCCESS)
/* Return completion status. */
return(status);
/* Check the CSW. We may learn something there about the state of the device. */
if (storage -> ux_host_class_storage_sense_code == 0)
return(UX_SUCCESS);
}
/* The start/Stop did not work. */
return(UX_ERROR);
}
|