| // Copyright lowRISC contributors. | |
| // Licensed under the Apache License, Version 2.0, see LICENSE for details. | |
| // SPDX-License-Identifier: Apache-2.0 | |
| #include "sw/device/lib/dif/dif_usbdev.h" | |
| #include "sw/device/lib/base/bitfield.h" | |
| #include "usbdev_regs.h" // Generated. | |
| /** | |
| * Definition in the header file (and probably other places) must be updated if | |
| * there is a hardware change. | |
| */ | |
| _Static_assert(USBDEV_NUM_ENDPOINTS == USBDEV_PARAM_NENDPOINTS, | |
| "Mismatch in number of endpoints"); | |
| /** | |
| * Max packet size is equal to the size of device buffers. | |
| */ | |
| #define USBDEV_BUFFER_ENTRY_SIZE_BYTES USBDEV_MAX_PACKET_SIZE | |
| /** | |
| * Constants used to indicate that a buffer pool is full or empty. | |
| */ | |
| #define BUFFER_POOL_FULL (USBDEV_NUM_BUFFERS - 1) | |
| #define BUFFER_POOL_EMPTY -1 | |
| /** | |
| * Hardware information for endpoints. | |
| */ | |
| typedef struct endpoint_hw_info { | |
| uint32_t config_in_reg_offset; | |
| uint8_t bit_index; | |
| } endpoint_hw_info_t; | |
| /** | |
| * Helper macro to define an `endpoint_hw_info_t` entry for endpoint N. | |
| * | |
| * Note: This uses the bit indices of `USBDEV_IN_SENT` register for the sake | |
| * of conciseness because other endpoint registers use the same layout. | |
| */ | |
| #define ENDPOINT_HW_INFO_ENTRY(N) \ | |
| [N] = {.config_in_reg_offset = USBDEV_CONFIGIN_##N##_REG_OFFSET, \ | |
| .bit_index = USBDEV_IN_SENT_SENT_##N##_BIT} | |
| static const endpoint_hw_info_t kEndpointHwInfos[USBDEV_NUM_ENDPOINTS] = { | |
| ENDPOINT_HW_INFO_ENTRY(0), ENDPOINT_HW_INFO_ENTRY(1), | |
| ENDPOINT_HW_INFO_ENTRY(2), ENDPOINT_HW_INFO_ENTRY(3), | |
| ENDPOINT_HW_INFO_ENTRY(4), ENDPOINT_HW_INFO_ENTRY(5), | |
| ENDPOINT_HW_INFO_ENTRY(6), ENDPOINT_HW_INFO_ENTRY(7), | |
| ENDPOINT_HW_INFO_ENTRY(8), ENDPOINT_HW_INFO_ENTRY(9), | |
| ENDPOINT_HW_INFO_ENTRY(10), ENDPOINT_HW_INFO_ENTRY(11), | |
| }; | |
| #undef ENDPOINT_HW_INFO_ENTRY | |
| /** | |
| * Mapping from `dif_usbdev_irq_t` to bit indices in interrupt registers. | |
| */ | |
| static const uint8_t kIrqEnumToBitIndex[] = { | |
| [kDifUsbdevIrqPktReceived] = USBDEV_INTR_COMMON_PKT_RECEIVED_BIT, | |
| [kDifUsbdevIrqPktSent] = USBDEV_INTR_COMMON_PKT_SENT_BIT, | |
| [kDifUsbdevIrqDisconnected] = USBDEV_INTR_COMMON_DISCONNECTED_BIT, | |
| [kDifUsbdevIrqHostLost] = USBDEV_INTR_COMMON_HOST_LOST_BIT, | |
| [kDifUsbdevIrqLinkReset] = USBDEV_INTR_COMMON_LINK_RESET_BIT, | |
| [kDifUsbdevIrqLinkSuspend] = USBDEV_INTR_COMMON_LINK_SUSPEND_BIT, | |
| [kDifUsbdevIrqLinkResume] = USBDEV_INTR_COMMON_LINK_RESUME_BIT, | |
| [kDifUsbdevIrqAvEmpty] = USBDEV_INTR_COMMON_AV_EMPTY_BIT, | |
| [kDifUsbdevIrqRxFull] = USBDEV_INTR_COMMON_RX_FULL_BIT, | |
| [kDifUsbdevIrqAvOverflow] = USBDEV_INTR_COMMON_AV_OVERFLOW_BIT, | |
| [kDifUsbdevIrqLinkInError] = USBDEV_INTR_COMMON_LINK_IN_ERR_BIT, | |
| [kDifUsbdevIrqRxCrcError] = USBDEV_INTR_COMMON_RX_CRC_ERR_BIT, | |
| [kDifUsbdevIrqRxPidError] = USBDEV_INTR_COMMON_RX_PID_ERR_BIT, | |
| [kDifUsbdevIrqRxBitstuffError] = USBDEV_INTR_COMMON_RX_BITSTUFF_ERR_BIT, | |
| [kDifUsbdevIrqFrame] = USBDEV_INTR_COMMON_FRAME_BIT, | |
| [kDifUsbdevIrqConnected] = USBDEV_INTR_COMMON_CONNECTED_BIT, | |
| }; | |
| /** | |
| * Static functions for the free buffer pool. | |
| */ | |
| /** | |
| * Checks if a buffer pool is full. | |
| * | |
| * A buffer pool is full if it contains `USBDEV_NUM_BUFFERS` buffers. | |
| * | |
| * @param pool A buffer pool. | |
| * @return `true` if the buffer pool if full, `false` otherwise. | |
| */ | |
| DIF_WARN_UNUSED_RESULT | |
| static bool buffer_pool_is_full(dif_usbdev_buffer_pool_t *pool) { | |
| return pool->top == BUFFER_POOL_FULL; | |
| } | |
| /** | |
| * Checks if a buffer pool is empty. | |
| * | |
| * @param pool A buffer pool. | |
| * @return `true` if the buffer pool is empty, `false` otherwise. | |
| */ | |
| DIF_WARN_UNUSED_RESULT | |
| static bool buffer_pool_is_empty(dif_usbdev_buffer_pool_t *pool) { | |
| return pool->top == BUFFER_POOL_EMPTY; | |
| } | |
| /** | |
| * Checks if a buffer id is valid. | |
| * | |
| * A buffer id is valid if it is less than `USBDEV_NUM_BUFFERS`. | |
| * | |
| * @param buffer_id A buffer id. | |
| * @return `true` if `buffer_id` is valid, `false` otherwise. | |
| */ | |
| DIF_WARN_UNUSED_RESULT | |
| static bool buffer_pool_is_valid_buffer_id(uint8_t buffer_id) { | |
| return buffer_id < USBDEV_NUM_BUFFERS; | |
| } | |
| /** | |
| * Adds a buffer to a buffer pool. | |
| * | |
| * @param pool A buffer pool. | |
| * @param buffer_id A buffer id. | |
| * @return `true` if the operation was successful, `false` otherwise. | |
| */ | |
| DIF_WARN_UNUSED_RESULT | |
| static bool buffer_pool_add(dif_usbdev_buffer_pool_t *pool, uint8_t buffer_id) { | |
| if (buffer_pool_is_full(pool) || !buffer_pool_is_valid_buffer_id(buffer_id)) { | |
| return false; | |
| } | |
| ++pool->top; | |
| pool->buffers[pool->top] = buffer_id; | |
| return true; | |
| } | |
| /** | |
| * Removes a buffer from a buffer pool. | |
| * | |
| * @param pool A buffer pool. | |
| * @param buffer_id A buffer id. | |
| * @return `true` if the operation was successful, `false` otherwise. | |
| */ | |
| DIF_WARN_UNUSED_RESULT | |
| static bool buffer_pool_remove(dif_usbdev_buffer_pool_t *pool, | |
| uint8_t *buffer_id) { | |
| if (buffer_pool_is_empty(pool) || buffer_id == NULL) { | |
| return false; | |
| } | |
| *buffer_id = pool->buffers[pool->top]; | |
| --pool->top; | |
| return true; | |
| } | |
| /** | |
| * Initializes the buffer pool. | |
| * | |
| * At the end of this operation, the buffer pool contains `USBDEV_NUM_BUFFERS` | |
| * buffers. | |
| * | |
| * @param pool A buffer pool. | |
| * @return `true` if the operation was successful, `false` otherwise. | |
| */ | |
| DIF_WARN_UNUSED_RESULT | |
| static bool buffer_pool_init(dif_usbdev_buffer_pool_t *pool) { | |
| // Start with an empty pool | |
| pool->top = -1; | |
| // Add all buffers | |
| for (uint8_t i = 0; i < USBDEV_NUM_BUFFERS; ++i) { | |
| if (!buffer_pool_add(pool, i)) { | |
| return false; | |
| } | |
| } | |
| return true; | |
| } | |
| /** | |
| * Utility functions | |
| */ | |
| /** | |
| * Checks if the given value is a valid `dif_usbdev_toggle_t` variant. | |
| */ | |
| DIF_WARN_UNUSED_RESULT | |
| static bool is_valid_toggle(dif_usbdev_toggle_t val) { | |
| return val == kDifUsbdevToggleEnable || val == kDifUsbdevToggleDisable; | |
| } | |
| /** | |
| * Checks if the given value is a valid `dif_usbdev_power_sense_override_t` | |
| * variant. | |
| */ | |
| DIF_WARN_UNUSED_RESULT | |
| static bool is_valid_power_sense_override( | |
| dif_usbdev_power_sense_override_t val) { | |
| return val == kDifUsbdevPowerSenseOverrideDisabled || | |
| val == kDifUsbdevPowerSenseOverridePresent || | |
| val == kDifUsbdevPowerSenseOverrideNotPresent; | |
| } | |
| /** | |
| * Checks if the given value is a valid endpoint number. | |
| */ | |
| DIF_WARN_UNUSED_RESULT | |
| static bool is_valid_endpoint(uint8_t endpoint) { | |
| return endpoint < USBDEV_NUM_ENDPOINTS; | |
| } | |
| /** | |
| * Checks if the given value is a valid `dif_usbdev_irq_t` variant. | |
| */ | |
| DIF_WARN_UNUSED_RESULT | |
| static bool is_valid_irq(dif_usbdev_irq_t irq) { | |
| return irq >= kDifUsbdevIrqFirst && irq <= kDifUsbdevIrqLast; | |
| } | |
| /** | |
| * Enables/disables the functionality controlled by the register at `reg_offset` | |
| * for an endpoint. | |
| */ | |
| DIF_WARN_UNUSED_RESULT | |
| static dif_usbdev_result_t endpoint_functionality_enable( | |
| dif_usbdev_t *usbdev, uint32_t reg_offset, uint8_t endpoint, | |
| dif_usbdev_toggle_t new_state) { | |
| if (usbdev == NULL || !is_valid_endpoint(endpoint) || | |
| !is_valid_toggle(new_state)) { | |
| return kDifUsbdevBadArg; | |
| } | |
| if (kDifUsbdevToggleEnable) { | |
| mmio_region_nonatomic_set_bit32(usbdev->base_addr, reg_offset, | |
| kEndpointHwInfos[endpoint].bit_index); | |
| } else { | |
| mmio_region_nonatomic_clear_bit32(usbdev->base_addr, reg_offset, | |
| kEndpointHwInfos[endpoint].bit_index); | |
| } | |
| return kDifUsbdevOK; | |
| } | |
| /** | |
| * Returns the address that corresponds to the given buffer and offset | |
| * into that buffer. | |
| */ | |
| DIF_WARN_UNUSED_RESULT | |
| static uint32_t get_buffer_addr(uint8_t buffer_id, size_t offset) { | |
| return USBDEV_BUFFER_REG_OFFSET + | |
| (buffer_id * USBDEV_BUFFER_ENTRY_SIZE_BYTES) + offset; | |
| } | |
| /** | |
| * USBDEV DIF library functions. | |
| */ | |
| dif_usbdev_result_t dif_usbdev_init(dif_usbdev_config_t *config, | |
| dif_usbdev_t *usbdev) { | |
| if (usbdev == NULL || config == NULL) { | |
| return kDifUsbdevBadArg; | |
| } | |
| // Check enum fields | |
| if (!is_valid_toggle(config->differential_rx) || | |
| !is_valid_toggle(config->differential_tx) || | |
| !is_valid_toggle(config->single_bit_eop) || | |
| !is_valid_power_sense_override(config->power_sense_override) || | |
| !is_valid_toggle(config->pin_flip) || | |
| !is_valid_toggle(config->clock_sync_signals)) { | |
| return kDifUsbdevBadArg; | |
| } | |
| // Store base address | |
| usbdev->base_addr = config->base_addr; | |
| // Initialize the free buffer pool | |
| if (!buffer_pool_init(&usbdev->buffer_pool)) { | |
| return kDifUsbdevError; | |
| } | |
| // Determine the value of the PHY_CONFIG register. | |
| uint32_t phy_config_val = 0; | |
| if (config->differential_rx == kDifUsbdevToggleEnable) { | |
| phy_config_val = bitfield_field32_write( | |
| phy_config_val, | |
| (bitfield_field32_t){ | |
| .mask = 1, | |
| .index = USBDEV_PHY_CONFIG_RX_DIFFERENTIAL_MODE_BIT, | |
| }, | |
| 1); | |
| } | |
| if (config->differential_tx == kDifUsbdevToggleEnable) { | |
| phy_config_val = bitfield_field32_write( | |
| phy_config_val, | |
| (bitfield_field32_t){ | |
| .mask = 1, | |
| .index = USBDEV_PHY_CONFIG_TX_DIFFERENTIAL_MODE_BIT, | |
| }, | |
| 1); | |
| } | |
| if (config->single_bit_eop == kDifUsbdevToggleEnable) { | |
| phy_config_val = bitfield_field32_write( | |
| phy_config_val, | |
| (bitfield_field32_t){ | |
| .mask = 1, | |
| .index = USBDEV_PHY_CONFIG_EOP_SINGLE_BIT_BIT, | |
| }, | |
| 1); | |
| } | |
| if (config->power_sense_override == kDifUsbdevPowerSenseOverridePresent) { | |
| phy_config_val = bitfield_field32_write( | |
| phy_config_val, | |
| (bitfield_field32_t){ | |
| .mask = 1, | |
| .index = USBDEV_PHY_CONFIG_OVERRIDE_PWR_SENSE_EN_BIT, | |
| }, | |
| 1); | |
| phy_config_val = bitfield_field32_write( | |
| phy_config_val, | |
| (bitfield_field32_t){ | |
| .mask = 1, | |
| .index = USBDEV_PHY_CONFIG_OVERRIDE_PWR_SENSE_VAL_BIT, | |
| }, | |
| 1); | |
| } else if (config->power_sense_override == | |
| kDifUsbdevPowerSenseOverrideNotPresent) { | |
| phy_config_val = bitfield_field32_write( | |
| phy_config_val, | |
| (bitfield_field32_t){ | |
| .mask = 1, | |
| .index = USBDEV_PHY_CONFIG_OVERRIDE_PWR_SENSE_EN_BIT, | |
| }, | |
| 1); | |
| } | |
| if (config->pin_flip == kDifUsbdevToggleEnable) { | |
| phy_config_val = | |
| bitfield_field32_write(phy_config_val, | |
| (bitfield_field32_t){ | |
| .mask = 1, | |
| .index = USBDEV_PHY_CONFIG_PINFLIP_BIT, | |
| }, | |
| 1); | |
| } | |
| if (config->clock_sync_signals == kDifUsbdevToggleDisable) { | |
| phy_config_val = bitfield_field32_write( | |
| phy_config_val, | |
| (bitfield_field32_t){ | |
| .mask = 1, | |
| .index = USBDEV_PHY_CONFIG_USB_REF_DISABLE_BIT, | |
| }, | |
| 1); | |
| } | |
| // Write configuration to PHY_CONFIG register | |
| mmio_region_write32(usbdev->base_addr, USBDEV_PHY_CONFIG_REG_OFFSET, | |
| phy_config_val); | |
| return kDifUsbdevOK; | |
| } | |
| dif_usbdev_result_t dif_usbdev_fill_available_fifo(dif_usbdev_t *usbdev) { | |
| if (usbdev == NULL) { | |
| return kDifUsbdevBadArg; | |
| } | |
| // Remove buffers from the pool and write them to the AV FIFO until it is full | |
| while (!mmio_region_get_bit32(usbdev->base_addr, USBDEV_USBSTAT_REG_OFFSET, | |
| USBDEV_USBSTAT_AV_FULL_BIT) && | |
| !buffer_pool_is_empty(&usbdev->buffer_pool)) { | |
| uint8_t buffer_id; | |
| if (!buffer_pool_remove(&usbdev->buffer_pool, &buffer_id)) { | |
| return kDifUsbdevError; | |
| } | |
| mmio_region_write_only_set_field32(usbdev->base_addr, | |
| USBDEV_AVBUFFER_REG_OFFSET, | |
| USBDEV_AVBUFFER_BUFFER_FIELD, buffer_id); | |
| } | |
| return kDifUsbdevOK; | |
| } | |
| dif_usbdev_result_t dif_usbdev_endpoint_setup_enable( | |
| dif_usbdev_t *usbdev, uint8_t endpoint, dif_usbdev_toggle_t new_state) { | |
| return endpoint_functionality_enable(usbdev, USBDEV_RXENABLE_SETUP_REG_OFFSET, | |
| endpoint, new_state); | |
| } | |
| dif_usbdev_result_t dif_usbdev_endpoint_out_enable( | |
| dif_usbdev_t *usbdev, uint8_t endpoint, dif_usbdev_toggle_t new_state) { | |
| return endpoint_functionality_enable(usbdev, USBDEV_RXENABLE_OUT_REG_OFFSET, | |
| endpoint, new_state); | |
| } | |
| dif_usbdev_result_t dif_usbdev_endpoint_stall_enable( | |
| dif_usbdev_t *usbdev, uint8_t endpoint, dif_usbdev_toggle_t new_state) { | |
| return endpoint_functionality_enable(usbdev, USBDEV_STALL_REG_OFFSET, | |
| endpoint, new_state); | |
| } | |
| dif_usbdev_result_t dif_usbdev_endpoint_stall_get(dif_usbdev_t *usbdev, | |
| uint8_t endpoint, | |
| bool *state) { | |
| if (usbdev == NULL || state == NULL || !is_valid_endpoint(endpoint)) { | |
| return kDifUsbdevBadArg; | |
| } | |
| *state = mmio_region_get_bit32(usbdev->base_addr, USBDEV_STALL_REG_OFFSET, | |
| kEndpointHwInfos[endpoint].bit_index); | |
| return kDifUsbdevOK; | |
| } | |
| dif_usbdev_result_t dif_usbdev_endpoint_iso_enable( | |
| dif_usbdev_t *usbdev, uint8_t endpoint, dif_usbdev_toggle_t new_state) { | |
| return endpoint_functionality_enable(usbdev, USBDEV_ISO_REG_OFFSET, endpoint, | |
| new_state); | |
| } | |
| dif_usbdev_result_t dif_usbdev_interface_enable(dif_usbdev_t *usbdev, | |
| dif_usbdev_toggle_t new_state) { | |
| if (usbdev == NULL || !is_valid_toggle(new_state)) { | |
| return kDifUsbdevBadArg; | |
| } | |
| if (new_state == kDifUsbdevToggleEnable) { | |
| mmio_region_nonatomic_set_bit32(usbdev->base_addr, | |
| USBDEV_USBCTRL_REG_OFFSET, | |
| USBDEV_USBCTRL_ENABLE_BIT); | |
| } else { | |
| mmio_region_nonatomic_clear_bit32(usbdev->base_addr, | |
| USBDEV_USBCTRL_REG_OFFSET, | |
| USBDEV_USBCTRL_ENABLE_BIT); | |
| } | |
| return kDifUsbdevOK; | |
| } | |
| dif_usbdev_recv_result_t dif_usbdev_recv(dif_usbdev_t *usbdev, | |
| dif_usbdev_rx_packet_info_t *info, | |
| dif_usbdev_buffer_t *buffer) { | |
| if (usbdev == NULL || info == NULL || buffer == NULL) { | |
| return kDifUsbdevRecvResultBadArg; | |
| } | |
| // Check if the RX FIFO is empty | |
| if (mmio_region_get_bit32(usbdev->base_addr, USBDEV_USBSTAT_REG_OFFSET, | |
| USBDEV_USBSTAT_RX_EMPTY_BIT)) { | |
| return kDifUsbdevRecvResultNoNewPacket; | |
| } | |
| // Read fifo entry | |
| const uint32_t fifo_entry = | |
| mmio_region_read32(usbdev->base_addr, USBDEV_RXFIFO_REG_OFFSET); | |
| // Init packet info | |
| *info = (dif_usbdev_rx_packet_info_t){ | |
| .endpoint = bitfield_field32_read(fifo_entry, USBDEV_RXFIFO_EP_FIELD), | |
| .is_setup = bitfield_bit32_read(fifo_entry, USBDEV_RXFIFO_SETUP_BIT), | |
| .length = bitfield_field32_read(fifo_entry, USBDEV_RXFIFO_SIZE_FIELD), | |
| }; | |
| // Init buffer struct | |
| *buffer = (dif_usbdev_buffer_t){ | |
| .id = bitfield_field32_read(fifo_entry, USBDEV_RXFIFO_BUFFER_FIELD), | |
| .offset = 0, | |
| .remaining_bytes = info->length, | |
| .type = kDifUsbdevBufferTypeRead, | |
| }; | |
| return kDifUsbdevRecvResultOK; | |
| } | |
| dif_usbdev_buffer_request_result_t dif_usbdev_buffer_request( | |
| dif_usbdev_t *usbdev, dif_usbdev_buffer_t *buffer) { | |
| if (usbdev == NULL || buffer == NULL) { | |
| return kDifUsbdevBufferRequestResultBadArg; | |
| } | |
| if (buffer_pool_is_empty(&usbdev->buffer_pool)) { | |
| return kDifUsbdevBufferRequestResultNoBuffers; | |
| } | |
| uint8_t buffer_id; | |
| if (!buffer_pool_remove(&usbdev->buffer_pool, &buffer_id)) { | |
| return kDifUsbdevBufferRequestResultError; | |
| } | |
| *buffer = (dif_usbdev_buffer_t){ | |
| .id = buffer_id, | |
| .offset = 0, | |
| .remaining_bytes = USBDEV_BUFFER_ENTRY_SIZE_BYTES, | |
| .type = kDifUsbdevBufferTypeWrite, | |
| }; | |
| return kDifUsbdevBufferRequestResultOK; | |
| } | |
| dif_usbdev_result_t dif_usbdev_buffer_return(dif_usbdev_t *usbdev, | |
| dif_usbdev_buffer_t *buffer) { | |
| if (usbdev == NULL || buffer == NULL) { | |
| return kDifUsbdevBadArg; | |
| } | |
| switch (buffer->type) { | |
| case kDifUsbdevBufferTypeRead: | |
| case kDifUsbdevBufferTypeWrite: | |
| // Return the buffer to the free buffer pool | |
| if (!buffer_pool_add(&usbdev->buffer_pool, buffer->id)) { | |
| return kDifUsbdevError; | |
| } | |
| // Mark the buffer as stale | |
| buffer->type = kDifUsbdevBufferTypeStale; | |
| return kDifUsbdevOK; | |
| default: | |
| return kDifUsbdevBadArg; | |
| } | |
| } | |
| dif_usbdev_buffer_read_result_t dif_usbdev_buffer_read( | |
| dif_usbdev_t *usbdev, dif_usbdev_buffer_t *buffer, uint8_t *dst, | |
| size_t dst_len, size_t *bytes_written) { | |
| if (usbdev == NULL || buffer == NULL || | |
| buffer->type != kDifUsbdevBufferTypeRead || dst == NULL) { | |
| return kDifUsbdevBufferReadResultBadArg; | |
| } | |
| // bytes_to_copy is the minimum of remaining_bytes and dst_len | |
| size_t bytes_to_copy = buffer->remaining_bytes; | |
| if (bytes_to_copy > dst_len) { | |
| bytes_to_copy = dst_len; | |
| } | |
| // Copy from buffer to dst | |
| const uint32_t buffer_addr = get_buffer_addr(buffer->id, buffer->offset); | |
| mmio_region_memcpy_from_mmio32(usbdev->base_addr, buffer_addr, dst, | |
| bytes_to_copy); | |
| // Update buffer state | |
| buffer->offset += bytes_to_copy; | |
| buffer->remaining_bytes -= bytes_to_copy; | |
| if (bytes_written != NULL) { | |
| *bytes_written = bytes_to_copy; | |
| } | |
| // Check if there are any remaining bytes | |
| if (buffer->remaining_bytes > 0) { | |
| return kDifUsbdevBufferReadResultContinue; | |
| } | |
| // Return the buffer to the free buffer pool | |
| if (!buffer_pool_add(&usbdev->buffer_pool, buffer->id)) { | |
| return kDifUsbdevBufferReadResultError; | |
| } | |
| // Mark the buffer as stale | |
| buffer->type = kDifUsbdevBufferTypeStale; | |
| return kDifUsbdevBufferReadResultOK; | |
| } | |
| dif_usbdev_buffer_write_result_t dif_usbdev_buffer_write( | |
| dif_usbdev_t *usbdev, dif_usbdev_buffer_t *buffer, uint8_t *src, | |
| size_t src_len, size_t *bytes_written) { | |
| if (usbdev == NULL || buffer == NULL || | |
| buffer->type != kDifUsbdevBufferTypeWrite || src == NULL) { | |
| return kDifUsbdevBufferWriteResultBadArg; | |
| } | |
| // bytes_to_copy is the minimum of remaining_bytes and src_len. | |
| size_t bytes_to_copy = buffer->remaining_bytes; | |
| if (bytes_to_copy > src_len) { | |
| bytes_to_copy = src_len; | |
| } | |
| // Write bytes to the buffer | |
| uint32_t buffer_addr = get_buffer_addr(buffer->id, buffer->offset); | |
| mmio_region_memcpy_to_mmio32(usbdev->base_addr, buffer_addr, src, | |
| bytes_to_copy); | |
| buffer->offset += bytes_to_copy; | |
| buffer->remaining_bytes -= bytes_to_copy; | |
| if (bytes_written) { | |
| *bytes_written = bytes_to_copy; | |
| } | |
| if (buffer->remaining_bytes == 0 && bytes_to_copy < src_len) { | |
| return kDifUsbdevBufferWriteResultFull; | |
| } | |
| return kDifUsbdevBufferWriteResultOK; | |
| } | |
| dif_usbdev_result_t dif_usbdev_send(dif_usbdev_t *usbdev, uint8_t endpoint, | |
| dif_usbdev_buffer_t *buffer) { | |
| if (usbdev == NULL || !is_valid_endpoint(endpoint) || buffer == NULL || | |
| buffer->type != kDifUsbdevBufferTypeWrite) { | |
| return kDifUsbdevBadArg; | |
| } | |
| // Get the configin register offset of the endpoint. | |
| const uint32_t config_in_reg_offset = | |
| kEndpointHwInfos[endpoint].config_in_reg_offset; | |
| // Configure USBDEV_CONFIGINX register. | |
| // Note: Using mask and offset values for the USBDEV_CONFIGIN0 register | |
| // for all endpoints because all USBDEV_CONFIGINX registers have the same | |
| // layout. | |
| uint32_t config_in_val = | |
| mmio_region_read32(usbdev->base_addr, config_in_reg_offset); | |
| config_in_val = bitfield_field32_write( | |
| config_in_val, USBDEV_CONFIGIN_0_BUFFER_0_FIELD, buffer->id); | |
| config_in_val = bitfield_field32_write( | |
| config_in_val, USBDEV_CONFIGIN_0_SIZE_0_FIELD, buffer->offset); | |
| mmio_region_write32(usbdev->base_addr, config_in_reg_offset, config_in_val); | |
| // Mark the packet as ready for transmission | |
| mmio_region_nonatomic_set_bit32(usbdev->base_addr, config_in_reg_offset, | |
| USBDEV_CONFIGIN_0_RDY_0_BIT); | |
| // Mark the buffer as stale. It will be returned to the free buffer pool | |
| // in dif_usbdev_get_tx_status once transmission is complete. | |
| buffer->type = kDifUsbdevBufferTypeStale; | |
| return kDifUsbdevOK; | |
| } | |
| dif_usbdev_result_t dif_usbdev_get_tx_status(dif_usbdev_t *usbdev, | |
| uint8_t endpoint, | |
| dif_usbdev_tx_status_t *status) { | |
| if (usbdev == NULL || status == NULL || !is_valid_endpoint(endpoint)) { | |
| return kDifUsbdevBadArg; | |
| } | |
| // Get the configin register offset and bit index of the endpoint | |
| uint32_t config_in_reg_offset = | |
| kEndpointHwInfos[endpoint].config_in_reg_offset; | |
| uint8_t endpoint_bit_index = kEndpointHwInfos[endpoint].bit_index; | |
| // Read the configin register | |
| uint32_t config_in_val = | |
| mmio_region_read32(usbdev->base_addr, config_in_reg_offset); | |
| // Buffer used by this endpoint | |
| uint8_t buffer = | |
| bitfield_field32_read(config_in_val, USBDEV_CONFIGIN_0_BUFFER_0_FIELD); | |
| // Check the status of the packet | |
| if (bitfield_field32_read(config_in_val, | |
| (bitfield_field32_t){ | |
| .mask = 1, | |
| .index = USBDEV_CONFIGIN_0_RDY_0_BIT, | |
| })) { | |
| // Packet is marked as ready to be sent and pending transmission | |
| *status = kDifUsbdevTxStatusPending; | |
| } else if (mmio_region_get_bit32(usbdev->base_addr, USBDEV_IN_SENT_REG_OFFSET, | |
| endpoint_bit_index)) { | |
| // Packet was sent successfully | |
| // Clear IN_SENT bit (rw1c) | |
| mmio_region_write_only_set_bit32( | |
| usbdev->base_addr, USBDEV_IN_SENT_REG_OFFSET, endpoint_bit_index); | |
| // Return the buffer back to the free buffer pool | |
| if (!buffer_pool_add(&usbdev->buffer_pool, buffer)) { | |
| return kDifUsbdevError; | |
| } | |
| *status = kDifUsbdevTxStatusSent; | |
| } else if (bitfield_field32_read(config_in_val, | |
| (bitfield_field32_t){ | |
| .mask = 1, | |
| .index = USBDEV_CONFIGIN_0_PEND_0_BIT, | |
| })) { | |
| // Canceled due to an IN SETUP packet or link reset | |
| // Clear pending bit (rw1c) | |
| mmio_region_write_only_set_bit32(usbdev->base_addr, config_in_reg_offset, | |
| USBDEV_CONFIGIN_0_PEND_0_BIT); | |
| // Return the buffer back to the free buffer pool | |
| if (!buffer_pool_add(&usbdev->buffer_pool, buffer)) { | |
| return kDifUsbdevError; | |
| } | |
| *status = kDifUsbdevTxStatusCancelled; | |
| } else { | |
| // No packet has been queued for this endpoint | |
| *status = kDifUsbdevTxStatusNoPacket; | |
| } | |
| return kDifUsbdevOK; | |
| } | |
| dif_usbdev_result_t dif_usbdev_address_set(dif_usbdev_t *usbdev, uint8_t addr) { | |
| if (usbdev == NULL) { | |
| return kDifUsbdevBadArg; | |
| } | |
| mmio_region_nonatomic_set_field32(usbdev->base_addr, | |
| USBDEV_USBCTRL_REG_OFFSET, | |
| USBDEV_USBCTRL_DEVICE_ADDRESS_FIELD, addr); | |
| return kDifUsbdevOK; | |
| } | |
| dif_usbdev_result_t dif_usbdev_address_get(dif_usbdev_t *usbdev, | |
| uint8_t *addr) { | |
| if (usbdev == NULL || addr == NULL) { | |
| return kDifUsbdevBadArg; | |
| } | |
| // Note: Size of address is 7 bits. | |
| *addr = mmio_region_read_mask32(usbdev->base_addr, USBDEV_USBCTRL_REG_OFFSET, | |
| USBDEV_USBCTRL_DEVICE_ADDRESS_MASK, | |
| USBDEV_USBCTRL_DEVICE_ADDRESS_OFFSET); | |
| return kDifUsbdevOK; | |
| } | |
| dif_usbdev_result_t dif_usbdev_status_get_frame(dif_usbdev_t *usbdev, | |
| uint16_t *frame_index) { | |
| if (usbdev == NULL || frame_index == NULL) { | |
| return kDifUsbdevBadArg; | |
| } | |
| // Note: size of frame index is 11 bits. | |
| *frame_index = mmio_region_read_mask32( | |
| usbdev->base_addr, USBDEV_USBSTAT_REG_OFFSET, USBDEV_USBSTAT_FRAME_MASK, | |
| USBDEV_USBSTAT_FRAME_OFFSET); | |
| return kDifUsbdevOK; | |
| } | |
| dif_usbdev_result_t dif_usbdev_status_get_host_lost(dif_usbdev_t *usbdev, | |
| bool *host_lost) { | |
| if (usbdev == NULL || host_lost == NULL) { | |
| return kDifUsbdevBadArg; | |
| } | |
| *host_lost = | |
| mmio_region_get_bit32(usbdev->base_addr, USBDEV_USBSTAT_REG_OFFSET, | |
| USBDEV_USBSTAT_HOST_LOST_BIT); | |
| return kDifUsbdevOK; | |
| } | |
| dif_usbdev_result_t dif_usbdev_status_get_link_state( | |
| dif_usbdev_t *usbdev, dif_usbdev_link_state_t *link_state) { | |
| if (usbdev == NULL || link_state == NULL) { | |
| return kDifUsbdevBadArg; | |
| } | |
| uint32_t val = mmio_region_read_mask32( | |
| usbdev->base_addr, USBDEV_USBSTAT_REG_OFFSET, | |
| USBDEV_USBSTAT_LINK_STATE_MASK, USBDEV_USBSTAT_LINK_STATE_OFFSET); | |
| switch (val) { | |
| case USBDEV_USBSTAT_LINK_STATE_VALUE_DISCONNECT: | |
| *link_state = kDifUsbdevLinkStateDisconnected; | |
| break; | |
| case USBDEV_USBSTAT_LINK_STATE_VALUE_POWERED: | |
| *link_state = kDifUsbdevLinkStatePowered; | |
| break; | |
| case USBDEV_USBSTAT_LINK_STATE_VALUE_POWERED_SUSPEND: | |
| *link_state = kDifUsbdevLinkStatePoweredSuspend; | |
| break; | |
| case USBDEV_USBSTAT_LINK_STATE_VALUE_ACTIVE: | |
| *link_state = kDifUsbdevLinkStateActive; | |
| break; | |
| case USBDEV_USBSTAT_LINK_STATE_VALUE_SUSPEND: | |
| *link_state = kDifUsbdevLinkStateSuspend; | |
| break; | |
| default: | |
| return kDifUsbdevError; | |
| } | |
| return kDifUsbdevOK; | |
| } | |
| dif_usbdev_result_t dif_usbdev_status_get_sense(dif_usbdev_t *usbdev, | |
| bool *sense) { | |
| if (usbdev == NULL || sense == NULL) { | |
| return kDifUsbdevBadArg; | |
| } | |
| *sense = mmio_region_get_bit32(usbdev->base_addr, USBDEV_USBSTAT_REG_OFFSET, | |
| USBDEV_USBSTAT_SENSE_BIT); | |
| return kDifUsbdevOK; | |
| } | |
| dif_usbdev_result_t dif_usbdev_status_get_available_fifo_depth( | |
| dif_usbdev_t *usbdev, uint8_t *depth) { | |
| if (usbdev == NULL || depth == NULL) { | |
| return kDifUsbdevBadArg; | |
| } | |
| // Note: Size of available FIFO depth is 3 bits. | |
| *depth = mmio_region_read_mask32(usbdev->base_addr, USBDEV_USBSTAT_REG_OFFSET, | |
| USBDEV_USBSTAT_AV_DEPTH_MASK, | |
| USBDEV_USBSTAT_AV_DEPTH_OFFSET); | |
| return kDifUsbdevOK; | |
| } | |
| dif_usbdev_result_t dif_usbdev_status_get_available_fifo_full( | |
| dif_usbdev_t *usbdev, bool *is_full) { | |
| if (usbdev == NULL || is_full == NULL) { | |
| return kDifUsbdevBadArg; | |
| } | |
| *is_full = mmio_region_get_bit32(usbdev->base_addr, USBDEV_USBSTAT_REG_OFFSET, | |
| USBDEV_USBSTAT_AV_FULL_BIT); | |
| return kDifUsbdevOK; | |
| } | |
| dif_usbdev_result_t dif_usbdev_status_get_rx_fifo_depth(dif_usbdev_t *usbdev, | |
| uint8_t *depth) { | |
| if (usbdev == NULL || depth == NULL) { | |
| return kDifUsbdevBadArg; | |
| } | |
| // Note: Size of RX FIFO depth is 3 bits. | |
| *depth = mmio_region_read_mask32(usbdev->base_addr, USBDEV_USBSTAT_REG_OFFSET, | |
| USBDEV_USBSTAT_RX_DEPTH_MASK, | |
| USBDEV_USBSTAT_RX_DEPTH_OFFSET); | |
| return kDifUsbdevOK; | |
| } | |
| dif_usbdev_result_t dif_usbdev_status_get_rx_fifo_empty(dif_usbdev_t *usbdev, | |
| bool *is_full) { | |
| if (usbdev == NULL || is_full == NULL) { | |
| return kDifUsbdevBadArg; | |
| } | |
| *is_full = mmio_region_get_bit32(usbdev->base_addr, USBDEV_USBSTAT_REG_OFFSET, | |
| USBDEV_USBSTAT_RX_EMPTY_BIT); | |
| return kDifUsbdevOK; | |
| } | |
| dif_usbdev_result_t dif_usbdev_irq_enable(dif_usbdev_t *usbdev, | |
| dif_usbdev_irq_t irq, | |
| dif_usbdev_toggle_t state) { | |
| if (usbdev == NULL || !is_valid_irq(irq) || !is_valid_toggle(state)) { | |
| return kDifUsbdevBadArg; | |
| } | |
| if (state == kDifUsbdevToggleEnable) { | |
| mmio_region_nonatomic_set_bit32(usbdev->base_addr, | |
| USBDEV_INTR_ENABLE_REG_OFFSET, | |
| kIrqEnumToBitIndex[irq]); | |
| } else { | |
| mmio_region_nonatomic_clear_bit32(usbdev->base_addr, | |
| USBDEV_INTR_ENABLE_REG_OFFSET, | |
| kIrqEnumToBitIndex[irq]); | |
| } | |
| return kDifUsbdevOK; | |
| } | |
| dif_usbdev_result_t dif_usbdev_irq_get(dif_usbdev_t *usbdev, | |
| dif_usbdev_irq_t irq, bool *state) { | |
| if (usbdev == NULL || state == NULL || !is_valid_irq(irq)) { | |
| return kDifUsbdevBadArg; | |
| } | |
| *state = mmio_region_get_bit32( | |
| usbdev->base_addr, USBDEV_INTR_STATE_REG_OFFSET, kIrqEnumToBitIndex[irq]); | |
| return kDifUsbdevOK; | |
| } | |
| dif_usbdev_result_t dif_usbdev_irq_clear(dif_usbdev_t *usbdev, | |
| dif_usbdev_irq_t irq) { | |
| if (usbdev == NULL || !is_valid_irq(irq)) { | |
| return kDifUsbdevBadArg; | |
| } | |
| mmio_region_write_only_set_bit32( | |
| usbdev->base_addr, USBDEV_INTR_STATE_REG_OFFSET, kIrqEnumToBitIndex[irq]); | |
| return kDifUsbdevOK; | |
| } | |
| dif_usbdev_result_t dif_usbdev_irq_clear_all(dif_usbdev_t *usbdev) { | |
| if (usbdev == NULL) { | |
| return kDifUsbdevBadArg; | |
| } | |
| mmio_region_write32(usbdev->base_addr, USBDEV_INTR_STATE_REG_OFFSET, | |
| UINT32_MAX); | |
| return kDifUsbdevOK; | |
| } | |
| dif_usbdev_result_t dif_usbdev_irq_disable_all(dif_usbdev_t *usbdev, | |
| uint32_t *cur_config) { | |
| if (usbdev == NULL) { | |
| return kDifUsbdevBadArg; | |
| } | |
| if (cur_config != NULL) { | |
| *cur_config = | |
| mmio_region_read32(usbdev->base_addr, USBDEV_INTR_ENABLE_REG_OFFSET); | |
| } | |
| mmio_region_write32(usbdev->base_addr, USBDEV_INTR_ENABLE_REG_OFFSET, 0); | |
| return kDifUsbdevOK; | |
| } | |
| dif_usbdev_result_t dif_usbdev_irq_restore(dif_usbdev_t *usbdev, | |
| uint32_t new_config) { | |
| if (usbdev == NULL) { | |
| return kDifUsbdevBadArg; | |
| } | |
| mmio_region_write32(usbdev->base_addr, USBDEV_INTR_ENABLE_REG_OFFSET, | |
| new_config); | |
| return kDifUsbdevOK; | |
| } | |
| dif_usbdev_result_t dif_usbdev_irq_test(dif_usbdev_t *usbdev, | |
| dif_usbdev_irq_t irq) { | |
| if (usbdev == NULL || !is_valid_irq(irq)) { | |
| return kDifUsbdevBadArg; | |
| } | |
| mmio_region_write_only_set_bit32( | |
| usbdev->base_addr, USBDEV_INTR_TEST_REG_OFFSET, kIrqEnumToBitIndex[irq]); | |
| return kDifUsbdevOK; | |
| } |