void mvUsbCh9SetFeature(_usb_device_handle handle, boolean setup, SETUP_STRUCT* setup_ptr) { uint_16 usb_status; uint_8 endpoint, direction; USB_DEV_STATE_STRUCT* usb_dev_ptr = (USB_DEV_STATE_STRUCT*)handle; ARC_DEBUG_TRACE(ARC_DEBUG_FLAG_SETUP, "%s: setup=%d\n", __FUNCTION__, (int)setup); if (setup) { switch (setup_ptr->REQUESTTYPE) { case (REQ_DIR_OUT | REQ_RECIP_DEVICE): /* DEVICE */ switch (setup_ptr->VALUE) { case DEVICE_REMOTE_WAKEUP: /* set remote wakeup */ _usb_device_get_status(handle, ARC_USB_STATUS_DEVICE, &usb_status); usb_status |= ARC_USB_REMOTE_WAKEUP; _usb_device_set_status(handle, ARC_USB_STATUS_DEVICE, usb_status); USB_printf("Set REMOTE_WAKEUP feature\n"); break; case DEVICE_TEST_MODE: /* Test Mode */ if( (setup_ptr->INDEX & 0x00FF) || (usb_dev_ptr->SPEED != ARC_USB_SPEED_HIGH) ) { USB_printf("SetFeature: Wrong Test mode parameters: mode=%d, speed=%d\n", (setup_ptr->INDEX & 0x00FF), usb_dev_ptr->SPEED); _usb_device_stall_endpoint(handle, 0, ARC_USB_RECV); return; } /* Endif */ _usb_device_get_status(handle, ARC_USB_STATUS_DEVICE_STATE, &usb_status); if( (usb_status == ARC_USB_STATE_CONFIG) || (usb_status == ARC_USB_STATE_ADDRESS) || (usb_status == ARC_USB_STATE_DEFAULT)) { /* wait with Set Test mode */ ENTER_TEST_MODE = TRUE; test_mode_index = (setup_ptr->INDEX & 0xFF00); USB_printf("SetFeature: Prepare for Test mode 0x%x\n", test_mode_index); } else { USB_printf("SetFeature: Wrong USB state for Test mode: state=%d\n", usb_status); _usb_device_stall_endpoint(handle, 0, ARC_USB_RECV); return; } /* Endif */ break; default: USB_printf("SetFeature: Unknown Device feature %d\n", setup_ptr->VALUE); _usb_device_stall_endpoint(handle, 0, ARC_USB_RECV); return; } /* Endswitch */ break; case (REQ_DIR_OUT | REQ_RECIP_ENDPOINT): /* ENDPOINT */ if (setup_ptr->VALUE != ENDPOINT_HALT) { USB_printf("SetFeature: Unknown Endpoint feature %d\n", setup_ptr->VALUE); _usb_device_stall_endpoint(handle, 0, ARC_USB_RECV); return; } /* Endif */ endpoint = setup_ptr->INDEX & ARC_USB_STATUS_ENDPOINT_NUMBER_MASK; if( (setup_ptr->INDEX & (1 << REQ_DIR_OFFSET)) == REQ_DIR_IN) direction = ARC_USB_SEND; else direction = ARC_USB_RECV; _usb_device_stall_endpoint(handle, endpoint, direction); break; default: USB_printf("SetFeature: Unknown REQUEST_TYPE %d\n", setup_ptr->REQUESTTYPE); _usb_device_stall_endpoint(handle, 0, ARC_USB_RECV); return; } /* Endswitch */ /* status phase */ _usb_device_send_data(handle, 0, 0, 0); } else { if (ENTER_TEST_MODE) { /* Enter Test Mode */ USB_printf("SetFeature: Activate Test mode 0x%x\n", test_mode_index); _usb_device_set_status(handle, ARC_USB_STATUS_TEST_MODE, test_mode_index); } /* Endif */ } /* Endif */ }
void mvUsbCh9ClearFeature(_usb_device_handle handle, boolean setup, SETUP_STRUCT* setup_ptr) { /* Body */ uint_8 endpoint, direction; uint_16 usb_status; ARC_DEBUG_TRACE(ARC_DEBUG_FLAG_SETUP, "%s: setup=%d\n", __FUNCTION__, (int)setup); _usb_device_get_status(handle, ARC_USB_STATUS_DEVICE_STATE, &usb_status); if ((usb_status != ARC_USB_STATE_CONFIG) && (usb_status != ARC_USB_STATE_ADDRESS)) { USB_printf("ClearFeature: Wrong USB state %d\n", usb_status); _usb_device_stall_endpoint(handle, 0, ARC_USB_RECV); return; } /* Endif */ if(!setup) return; switch (setup_ptr->REQUESTTYPE) { case (REQ_DIR_OUT | REQ_RECIP_DEVICE): /* DEVICE */ switch(setup_ptr->VALUE) { case DEVICE_REMOTE_WAKEUP: /* clear remote wakeup */ _usb_device_get_status(handle, ARC_USB_STATUS_DEVICE, &usb_status); usb_status &= ~ARC_USB_REMOTE_WAKEUP; _usb_device_set_status(handle, ARC_USB_STATUS_DEVICE, usb_status); USB_printf("Clear REMOTE_WAKEUP feature\n"); break; case DEVICE_TEST_MODE: /* Exit Test Mode */ _usb_device_set_status(handle, ARC_USB_STATUS_TEST_MODE, 0); break; default: USB_printf("ClearFeature: Unknown Device feature %d\n", setup_ptr->VALUE); _usb_device_stall_endpoint(handle, 0, ARC_USB_RECV); return; } /* Endif */ break; case (REQ_DIR_OUT | REQ_RECIP_ENDPOINT): /* ENDPOINT */ if (setup_ptr->VALUE != ENDPOINT_HALT) { USB_printf("ClearFeature: Wrong Endpoint feature %d\n", setup_ptr->VALUE); _usb_device_stall_endpoint(handle, 0, ARC_USB_RECV); return; } /* Endif */ endpoint = setup_ptr->INDEX & ARC_USB_STATUS_ENDPOINT_NUMBER_MASK; if( (setup_ptr->INDEX & (1 << REQ_DIR_OFFSET)) == REQ_DIR_IN) direction = ARC_USB_SEND; else direction = ARC_USB_RECV; _usb_device_unstall_endpoint(handle, endpoint, direction); break; default: USB_printf("ClearFeature: Unknown REQUEST_TYPE %d\n", setup_ptr->REQUESTTYPE); _usb_device_stall_endpoint(handle, 0, ARC_USB_RECV); return; } /* Endswitch */ /* status phase */ _usb_device_send_data(handle, 0, 0, 0); }