Added MS_Host_TestUnitReady() and MS_Host_ReadDeviceCapacity() to the host mode Mass...
[pub/USBasp.git] / Demos / Host / ClassDriver / MassStorageHost / MassStorageHost.c
1 /*
2 LUFA Library
3 Copyright (C) Dean Camera, 2009.
4
5 dean [at] fourwalledcubicle [dot] com
6 www.fourwalledcubicle.com
7 */
8
9 /*
10 Copyright 2009 Dean Camera (dean [at] fourwalledcubicle [dot] com)
11
12 Permission to use, copy, modify, and distribute this software
13 and its documentation for any purpose and without fee is hereby
14 granted, provided that the above copyright notice appear in all
15 copies and that both that the copyright notice and this
16 permission notice and warranty disclaimer appear in supporting
17 documentation, and that the name of the author not be used in
18 advertising or publicity pertaining to distribution of the
19 software without specific, written prior permission.
20
21 The author disclaim all warranties with regard to this
22 software, including all implied warranties of merchantability
23 and fitness. In no event shall the author be liable for any
24 special, indirect or consequential damages or any damages
25 whatsoever resulting from loss of use, data or profits, whether
26 in an action of contract, negligence or other tortious action,
27 arising out of or in connection with the use or performance of
28 this software.
29 */
30
31 /** \file
32 *
33 * Main source file for the MassStorageHost demo. This file contains the main tasks of
34 * the demo and is responsible for the initial application hardware configuration.
35 */
36
37 #include "MassStorageHost.h"
38
39 /** LUFA Mass Storage Class driver interface configuration and state information. This structure is
40 * passed to all Mass Storage Class driver functions, so that multiple instances of the same class
41 * within a device can be differentiated from one another.
42 */
43 USB_ClassInfo_MS_Host_t FlashDisk_MS_Interface =
44 {
45 .Config =
46 {
47 .DataINPipeNumber = 1,
48 .DataOUTPipeNumber = 2,
49 },
50 };
51
52
53 /** Main program entry point. This routine configures the hardware required by the application, then
54 * starts the scheduler to run the application tasks.
55 */
56 int main(void)
57 {
58 SetupHardware();
59
60 puts_P(PSTR(ESC_FG_CYAN "Mass Storage Host Demo running.\r\n" ESC_FG_WHITE));
61
62 LEDs_SetAllLEDs(LEDMASK_USB_NOTREADY);
63
64 for (;;)
65 {
66 switch (USB_HostState)
67 {
68 case HOST_STATE_Addressed:
69 LEDs_SetAllLEDs(LEDMASK_USB_ENUMERATING);
70
71 uint16_t ConfigDescriptorSize;
72 uint8_t ConfigDescriptorData[512];
73
74 if ((USB_GetDeviceConfigDescriptor(1, &ConfigDescriptorSize, NULL) != HOST_SENDCONTROL_Successful) ||
75 (ConfigDescriptorSize > sizeof(ConfigDescriptorData)) ||
76 (USB_GetDeviceConfigDescriptor(1, &ConfigDescriptorSize, ConfigDescriptorData)))
77 {
78 printf("Error Retrieving Configuration Descriptor.\r\n");
79 LEDs_SetAllLEDs(LEDMASK_USB_ERROR);
80 USB_HostState = HOST_STATE_WaitForDeviceRemoval;
81 break;
82 }
83
84 if (MS_Host_ConfigurePipes(&FlashDisk_MS_Interface,
85 ConfigDescriptorSize, ConfigDescriptorData) != MS_ENUMERROR_NoError)
86 {
87 printf("Attached Device Not a Valid Mouse.\r\n");
88 LEDs_SetAllLEDs(LEDMASK_USB_ERROR);
89 USB_HostState = HOST_STATE_WaitForDeviceRemoval;
90 break;
91 }
92
93 if (USB_Host_SetDeviceConfiguration(1) != HOST_SENDCONTROL_Successful)
94 {
95 printf("Error Setting Device Configuration.\r\n");
96 LEDs_SetAllLEDs(LEDMASK_USB_ERROR);
97 USB_HostState = HOST_STATE_WaitForDeviceRemoval;
98 break;
99 }
100
101 printf("Mouse Enumerated.\r\n");
102 USB_HostState = HOST_STATE_Configured;
103 break;
104 case HOST_STATE_Configured:
105 LEDs_SetAllLEDs(LEDMASK_USB_BUSY);
106
107 uint8_t MaxLUNIndex;
108 if (MS_Host_GetMaxLUN(&FlashDisk_MS_Interface, &MaxLUNIndex))
109 {
110 printf("Error retrieving max LUN index.\r\n");
111 LEDs_SetAllLEDs(LEDMASK_USB_ERROR);
112 USB_HostState = HOST_STATE_WaitForDeviceRemoval;
113 break;
114 }
115
116 if (MS_Host_ResetMSInterface(&FlashDisk_MS_Interface))
117 {
118 printf("Error resetting Mass Storage interface.\r\n");
119 LEDs_SetAllLEDs(LEDMASK_USB_ERROR);
120 USB_HostState = HOST_STATE_WaitForDeviceRemoval;
121 break;
122 }
123
124 SCSI_Request_Sense_Response_t SenseData;
125 if (MS_Host_RequestSense(&FlashDisk_MS_Interface, 0, &SenseData) != 0)
126 {
127 printf("Error retrieving device sense.\r\n");
128 LEDs_SetAllLEDs(LEDMASK_USB_ERROR);
129 USB_HostState = HOST_STATE_WaitForDeviceRemoval;
130 break;
131 }
132
133 if (MS_Host_PreventAllowMediumRemoval(&FlashDisk_MS_Interface, 0, true))
134 {
135 printf("Error setting Prevent Device Removal bit.\r\n");
136 LEDs_SetAllLEDs(LEDMASK_USB_ERROR);
137 USB_HostState = HOST_STATE_WaitForDeviceRemoval;
138 break;
139 }
140
141 SCSI_Inquiry_Response_t InquiryData;
142 if (MS_Host_GetInquiryData(&FlashDisk_MS_Interface, 0, &InquiryData))
143 {
144 printf("Error retreiving device Inquiry data.\r\n");
145 LEDs_SetAllLEDs(LEDMASK_USB_ERROR);
146 USB_HostState = HOST_STATE_WaitForDeviceRemoval;
147 break;
148 }
149
150 printf("Vendor \"%.8s\", Product \"%.16s\"\r\n", InquiryData.VendorID, InquiryData.ProductID);
151
152 printf("Waiting until ready...\r\n");
153
154 for (;;)
155 {
156 uint8_t ErrorCode = MS_Host_TestUnitReady(&FlashDisk_MS_Interface, 0);
157
158 if (!(ErrorCode))
159 break;
160
161 /* Check if an error other than a logical command error (device busy) received */
162 if (ErrorCode != MS_ERROR_LOGICAL_CMD_FAILED)
163 {
164 printf("Error waiting for device to be ready.\r\n");
165 LEDs_SetAllLEDs(LEDMASK_USB_ERROR);
166 USB_HostState = HOST_STATE_WaitForDeviceRemoval;
167 break;
168 }
169 }
170
171 printf("Retrieving Capacity... ");
172
173 SCSI_Capacity_t DiskCapacity;
174 if (MS_Host_ReadDeviceCapacity(&FlashDisk_MS_Interface, 0, &DiskCapacity))
175 {
176 printf("Error retrieving device capacity.\r\n");
177 LEDs_SetAllLEDs(LEDMASK_USB_ERROR);
178 USB_HostState = HOST_STATE_WaitForDeviceRemoval;
179 break;
180 }
181
182 printf("%lu blocks of %lu bytes.\r\n", DiskCapacity.Blocks, DiskCapacity.BlockSize);
183
184 uint8_t BlockBuffer[DiskCapacity.BlockSize];
185
186 if (MS_Host_ReadDeviceBlocks(&FlashDisk_MS_Interface, 0, 0x00000000, 1, DiskCapacity.BlockSize, BlockBuffer))
187 {
188 printf("Error reading device block.\r\n");
189 LEDs_SetAllLEDs(LEDMASK_USB_ERROR);
190 USB_HostState = HOST_STATE_WaitForDeviceRemoval;
191 break;
192 }
193
194 printf("\r\nContents of first block:\r\n");
195
196 for (uint16_t Chunk = 0; Chunk < (DiskCapacity.BlockSize >> 4); Chunk++)
197 {
198 uint8_t* ChunkPtr = &BlockBuffer[Chunk << 4];
199
200 /* Print out the 16 bytes of the chunk in HEX format */
201 for (uint8_t ByteOffset = 0; ByteOffset < (1 << 4); ByteOffset++)
202 {
203 char CurrByte = *(ChunkPtr + ByteOffset);
204 printf_P(PSTR("%.2X "), CurrByte);
205 }
206
207 printf(" ");
208
209 /* Print out the 16 bytes of the chunk in ASCII format */
210 for (uint8_t ByteOffset = 0; ByteOffset < (1 << 4); ByteOffset++)
211 {
212 char CurrByte = *(ChunkPtr + ByteOffset);
213 putchar(isprint(CurrByte) ? CurrByte : '.');
214 }
215
216 printf("\r\n");
217 }
218
219 LEDs_SetAllLEDs(LEDMASK_USB_READY);
220 USB_HostState = HOST_STATE_WaitForDeviceRemoval;
221 break;
222 }
223
224 MS_Host_USBTask(&FlashDisk_MS_Interface);
225 USB_USBTask();
226 }
227 }
228
229 /** Configures the board hardware and chip peripherals for the demo's functionality. */
230 void SetupHardware(void)
231 {
232 /* Disable watchdog if enabled by bootloader/fuses */
233 MCUSR &= ~(1 << WDRF);
234 wdt_disable();
235
236 /* Disable clock division */
237 clock_prescale_set(clock_div_1);
238
239 /* Hardware Initialization */
240 SerialStream_Init(9600, false);
241 LEDs_Init();
242 USB_Init();
243 }
244
245 /** Event handler for the USB_DeviceAttached event. This indicates that a device has been attached to the host, and
246 * starts the library USB task to begin the enumeration and USB management process.
247 */
248 void EVENT_USB_Host_DeviceAttached(void)
249 {
250 puts_P(PSTR("Device Attached.\r\n"));
251 LEDs_SetAllLEDs(LEDMASK_USB_ENUMERATING);
252 }
253
254 /** Event handler for the USB_DeviceUnattached event. This indicates that a device has been removed from the host, and
255 * stops the library USB task management process.
256 */
257 void EVENT_USB_Host_DeviceUnattached(void)
258 {
259 puts_P(PSTR("\r\nDevice Unattached.\r\n"));
260 LEDs_SetAllLEDs(LEDMASK_USB_NOTREADY);
261 }
262
263 /** Event handler for the USB_DeviceEnumerationComplete event. This indicates that a device has been successfully
264 * enumerated by the host and is now ready to be used by the application.
265 */
266 void EVENT_USB_Host_DeviceEnumerationComplete(void)
267 {
268 LEDs_SetAllLEDs(LEDMASK_USB_READY);
269 }
270
271 /** Event handler for the USB_HostError event. This indicates that a hardware error occurred while in host mode. */
272 void EVENT_USB_Host_HostError(const uint8_t ErrorCode)
273 {
274 USB_ShutDown();
275
276 printf_P(PSTR(ESC_FG_RED "Host Mode Error\r\n"
277 " -- Error Code %d\r\n" ESC_FG_WHITE), ErrorCode);
278
279 LEDs_SetAllLEDs(LEDMASK_USB_ERROR);
280 for(;;);
281 }
282
283 /** Event handler for the USB_DeviceEnumerationFailed event. This indicates that a problem occurred while
284 * enumerating an attached USB device.
285 */
286 void EVENT_USB_Host_DeviceEnumerationFailed(const uint8_t ErrorCode, const uint8_t SubErrorCode)
287 {
288 printf_P(PSTR(ESC_FG_RED "Dev Enum Error\r\n"
289 " -- Error Code %d\r\n"
290 " -- Sub Error Code %d\r\n"
291 " -- In State %d\r\n" ESC_FG_WHITE), ErrorCode, SubErrorCode, USB_HostState);
292
293 LEDs_SetAllLEDs(LEDMASK_USB_ERROR);
294 }