|
|
@@ -0,0 +1,3344 @@
|
|
|
+/***********************license start***************
|
|
|
+ * Copyright (c) 2003-2010 Cavium Networks (support@cavium.com). All rights
|
|
|
+ * reserved.
|
|
|
+ *
|
|
|
+ *
|
|
|
+ * Redistribution and use in source and binary forms, with or without
|
|
|
+ * modification, are permitted provided that the following conditions are
|
|
|
+ * met:
|
|
|
+ *
|
|
|
+ * * Redistributions of source code must retain the above copyright
|
|
|
+ * notice, this list of conditions and the following disclaimer.
|
|
|
+ *
|
|
|
+ * * Redistributions in binary form must reproduce the above
|
|
|
+ * copyright notice, this list of conditions and the following
|
|
|
+ * disclaimer in the documentation and/or other materials provided
|
|
|
+ * with the distribution.
|
|
|
+
|
|
|
+ * * Neither the name of Cavium Networks nor the names of
|
|
|
+ * its contributors may be used to endorse or promote products
|
|
|
+ * derived from this software without specific prior written
|
|
|
+ * permission.
|
|
|
+
|
|
|
+ * This Software, including technical data, may be subject to U.S. export control
|
|
|
+ * laws, including the U.S. Export Administration Act and its associated
|
|
|
+ * regulations, and may be subject to export or import regulations in other
|
|
|
+ * countries.
|
|
|
+
|
|
|
+ * TO THE MAXIMUM EXTENT PERMITTED BY LAW, THE SOFTWARE IS PROVIDED "AS IS"
|
|
|
+ * AND WITH ALL FAULTS AND CAVIUM NETWORKS MAKES NO PROMISES, REPRESENTATIONS OR
|
|
|
+ * WARRANTIES, EITHER EXPRESS, IMPLIED, STATUTORY, OR OTHERWISE, WITH RESPECT TO
|
|
|
+ * THE SOFTWARE, INCLUDING ITS CONDITION, ITS CONFORMITY TO ANY REPRESENTATION OR
|
|
|
+ * DESCRIPTION, OR THE EXISTENCE OF ANY LATENT OR PATENT DEFECTS, AND CAVIUM
|
|
|
+ * SPECIFICALLY DISCLAIMS ALL IMPLIED (IF ANY) WARRANTIES OF TITLE,
|
|
|
+ * MERCHANTABILITY, NONINFRINGEMENT, FITNESS FOR A PARTICULAR PURPOSE, LACK OF
|
|
|
+ * VIRUSES, ACCURACY OR COMPLETENESS, QUIET ENJOYMENT, QUIET POSSESSION OR
|
|
|
+ * CORRESPONDENCE TO DESCRIPTION. THE ENTIRE RISK ARISING OUT OF USE OR
|
|
|
+ * PERFORMANCE OF THE SOFTWARE LIES WITH YOU.
|
|
|
+ ***********************license end**************************************/
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * @file
|
|
|
+ *
|
|
|
+ * "cvmx-usb.c" defines a set of low level USB functions to help
|
|
|
+ * developers create Octeon USB drivers for various operating
|
|
|
+ * systems. These functions provide a generic API to the Octeon
|
|
|
+ * USB blocks, hiding the internal hardware specific
|
|
|
+ * operations.
|
|
|
+ *
|
|
|
+ * <hr>$Revision: 32636 $<hr>
|
|
|
+ */
|
|
|
+#include <linux/delay.h>
|
|
|
+#include <asm/octeon/cvmx.h>
|
|
|
+#include <asm/octeon/octeon.h>
|
|
|
+#include <asm/octeon/cvmx-sysinfo.h>
|
|
|
+#include "cvmx-usbnx-defs.h"
|
|
|
+#include "cvmx-usbcx-defs.h"
|
|
|
+#include "cvmx-usb.h"
|
|
|
+#include <asm/octeon/cvmx-helper.h>
|
|
|
+#include <asm/octeon/cvmx-helper-board.h>
|
|
|
+
|
|
|
+#define CVMX_PREFETCH0(address) CVMX_PREFETCH(address, 0)
|
|
|
+#define CVMX_PREFETCH128(address) CVMX_PREFETCH(address, 128)
|
|
|
+// a normal prefetch
|
|
|
+#define CVMX_PREFETCH(address, offset) CVMX_PREFETCH_PREF0(address, offset)
|
|
|
+// normal prefetches that use the pref instruction
|
|
|
+#define CVMX_PREFETCH_PREFX(X, address, offset) asm volatile ("pref %[type], %[off](%[rbase])" : : [rbase] "d" (address), [off] "I" (offset), [type] "n" (X))
|
|
|
+#define CVMX_PREFETCH_PREF0(address, offset) CVMX_PREFETCH_PREFX(0, address, offset)
|
|
|
+#define CVMX_CLZ(result, input) asm ("clz %[rd],%[rs]" : [rd] "=d" (result) : [rs] "d" (input))
|
|
|
+
|
|
|
+#define cvmx_likely likely
|
|
|
+#define cvmx_wait_usec udelay
|
|
|
+#define cvmx_unlikely unlikely
|
|
|
+#define cvmx_le16_to_cpu le16_to_cpu
|
|
|
+
|
|
|
+#define MAX_RETRIES 3 /* Maximum number of times to retry failed transactions */
|
|
|
+#define MAX_PIPES 32 /* Maximum number of pipes that can be open at once */
|
|
|
+#define MAX_TRANSACTIONS 256 /* Maximum number of outstanding transactions across all pipes */
|
|
|
+#define MAX_CHANNELS 8 /* Maximum number of hardware channels supported by the USB block */
|
|
|
+#define MAX_USB_ADDRESS 127 /* The highest valid USB device address */
|
|
|
+#define MAX_USB_ENDPOINT 15 /* The highest valid USB endpoint number */
|
|
|
+#define MAX_USB_HUB_PORT 15 /* The highest valid port number on a hub */
|
|
|
+#define MAX_TRANSFER_BYTES ((1<<19)-1) /* The low level hardware can transfer a maximum of this number of bytes in each transfer. The field is 19 bits wide */
|
|
|
+#define MAX_TRANSFER_PACKETS ((1<<10)-1) /* The low level hardware can transfer a maximum of this number of packets in each transfer. The field is 10 bits wide */
|
|
|
+
|
|
|
+/* These defines disable the normal read and write csr. This is so I can add
|
|
|
+ extra debug stuff to the usb specific version and I won't use the normal
|
|
|
+ version by mistake */
|
|
|
+#define cvmx_read_csr use_cvmx_usb_read_csr64_instead_of_cvmx_read_csr
|
|
|
+#define cvmx_write_csr use_cvmx_usb_write_csr64_instead_of_cvmx_write_csr
|
|
|
+
|
|
|
+typedef enum
|
|
|
+{
|
|
|
+ __CVMX_USB_TRANSACTION_FLAGS_IN_USE = 1<<16,
|
|
|
+} cvmx_usb_transaction_flags_t;
|
|
|
+
|
|
|
+enum {
|
|
|
+ USB_CLOCK_TYPE_REF_12,
|
|
|
+ USB_CLOCK_TYPE_REF_24,
|
|
|
+ USB_CLOCK_TYPE_REF_48,
|
|
|
+ USB_CLOCK_TYPE_CRYSTAL_12,
|
|
|
+};
|
|
|
+
|
|
|
+/**
|
|
|
+ * Logical transactions may take numerous low level
|
|
|
+ * transactions, especially when splits are concerned. This
|
|
|
+ * enum represents all of the possible stages a transaction can
|
|
|
+ * be in. Note that split completes are always even. This is so
|
|
|
+ * the NAK handler can backup to the previous low level
|
|
|
+ * transaction with a simple clearing of bit 0.
|
|
|
+ */
|
|
|
+typedef enum
|
|
|
+{
|
|
|
+ CVMX_USB_STAGE_NON_CONTROL,
|
|
|
+ CVMX_USB_STAGE_NON_CONTROL_SPLIT_COMPLETE,
|
|
|
+ CVMX_USB_STAGE_SETUP,
|
|
|
+ CVMX_USB_STAGE_SETUP_SPLIT_COMPLETE,
|
|
|
+ CVMX_USB_STAGE_DATA,
|
|
|
+ CVMX_USB_STAGE_DATA_SPLIT_COMPLETE,
|
|
|
+ CVMX_USB_STAGE_STATUS,
|
|
|
+ CVMX_USB_STAGE_STATUS_SPLIT_COMPLETE,
|
|
|
+} cvmx_usb_stage_t;
|
|
|
+
|
|
|
+/**
|
|
|
+ * This structure describes each pending USB transaction
|
|
|
+ * regardless of type. These are linked together to form a list
|
|
|
+ * of pending requests for a pipe.
|
|
|
+ */
|
|
|
+typedef struct cvmx_usb_transaction
|
|
|
+{
|
|
|
+ struct cvmx_usb_transaction *prev; /**< Transaction before this one in the pipe */
|
|
|
+ struct cvmx_usb_transaction *next; /**< Transaction after this one in the pipe */
|
|
|
+ cvmx_usb_transfer_t type; /**< Type of transaction, duplicated of the pipe */
|
|
|
+ cvmx_usb_transaction_flags_t flags; /**< State flags for this transaction */
|
|
|
+ uint64_t buffer; /**< User's physical buffer address to read/write */
|
|
|
+ int buffer_length; /**< Size of the user's buffer in bytes */
|
|
|
+ uint64_t control_header; /**< For control transactions, physical address of the 8 byte standard header */
|
|
|
+ int iso_start_frame; /**< For ISO transactions, the starting frame number */
|
|
|
+ int iso_number_packets; /**< For ISO transactions, the number of packets in the request */
|
|
|
+ cvmx_usb_iso_packet_t *iso_packets; /**< For ISO transactions, the sub packets in the request */
|
|
|
+ int xfersize;
|
|
|
+ int pktcnt;
|
|
|
+ int retries;
|
|
|
+ int actual_bytes; /**< Actual bytes transfer for this transaction */
|
|
|
+ cvmx_usb_stage_t stage; /**< For control transactions, the current stage */
|
|
|
+ cvmx_usb_callback_func_t callback; /**< User's callback function when complete */
|
|
|
+ void *callback_data; /**< User's data */
|
|
|
+} cvmx_usb_transaction_t;
|
|
|
+
|
|
|
+/**
|
|
|
+ * A pipe represents a virtual connection between Octeon and some
|
|
|
+ * USB device. It contains a list of pending request to the device.
|
|
|
+ */
|
|
|
+typedef struct cvmx_usb_pipe
|
|
|
+{
|
|
|
+ struct cvmx_usb_pipe *prev; /**< Pipe before this one in the list */
|
|
|
+ struct cvmx_usb_pipe *next; /**< Pipe after this one in the list */
|
|
|
+ cvmx_usb_transaction_t *head; /**< The first pending transaction */
|
|
|
+ cvmx_usb_transaction_t *tail; /**< The last pending transaction */
|
|
|
+ uint64_t interval; /**< For periodic pipes, the interval between packets in frames */
|
|
|
+ uint64_t next_tx_frame; /**< The next frame this pipe is allowed to transmit on */
|
|
|
+ cvmx_usb_pipe_flags_t flags; /**< State flags for this pipe */
|
|
|
+ cvmx_usb_speed_t device_speed; /**< Speed of device connected to this pipe */
|
|
|
+ cvmx_usb_transfer_t transfer_type; /**< Type of transaction supported by this pipe */
|
|
|
+ cvmx_usb_direction_t transfer_dir; /**< IN or OUT. Ignored for Control */
|
|
|
+ int multi_count; /**< Max packet in a row for the device */
|
|
|
+ uint16_t max_packet; /**< The device's maximum packet size in bytes */
|
|
|
+ uint8_t device_addr; /**< USB device address at other end of pipe */
|
|
|
+ uint8_t endpoint_num; /**< USB endpoint number at other end of pipe */
|
|
|
+ uint8_t hub_device_addr; /**< Hub address this device is connected to */
|
|
|
+ uint8_t hub_port; /**< Hub port this device is connected to */
|
|
|
+ uint8_t pid_toggle; /**< This toggles between 0/1 on every packet send to track the data pid needed */
|
|
|
+ uint8_t channel; /**< Hardware DMA channel for this pipe */
|
|
|
+ int8_t split_sc_frame; /**< The low order bits of the frame number the split complete should be sent on */
|
|
|
+} cvmx_usb_pipe_t;
|
|
|
+
|
|
|
+typedef struct
|
|
|
+{
|
|
|
+ cvmx_usb_pipe_t *head; /**< Head of the list, or NULL if empty */
|
|
|
+ cvmx_usb_pipe_t *tail; /**< Tail if the list, or NULL if empty */
|
|
|
+} cvmx_usb_pipe_list_t;
|
|
|
+
|
|
|
+typedef struct
|
|
|
+{
|
|
|
+ struct
|
|
|
+ {
|
|
|
+ int channel;
|
|
|
+ int size;
|
|
|
+ uint64_t address;
|
|
|
+ } entry[MAX_CHANNELS+1];
|
|
|
+ int head;
|
|
|
+ int tail;
|
|
|
+} cvmx_usb_tx_fifo_t;
|
|
|
+
|
|
|
+/**
|
|
|
+ * The state of the USB block is stored in this structure
|
|
|
+ */
|
|
|
+typedef struct
|
|
|
+{
|
|
|
+ int init_flags; /**< Flags passed to initialize */
|
|
|
+ int index; /**< Which USB block this is for */
|
|
|
+ int idle_hardware_channels; /**< Bit set for every idle hardware channel */
|
|
|
+ cvmx_usbcx_hprt_t usbcx_hprt; /**< Stored port status so we don't need to read a CSR to determine splits */
|
|
|
+ cvmx_usb_pipe_t *pipe_for_channel[MAX_CHANNELS]; /**< Map channels to pipes */
|
|
|
+ cvmx_usb_transaction_t *free_transaction_head; /**< List of free transactions head */
|
|
|
+ cvmx_usb_transaction_t *free_transaction_tail; /**< List of free transactions tail */
|
|
|
+ cvmx_usb_pipe_t pipe[MAX_PIPES]; /**< Storage for pipes */
|
|
|
+ cvmx_usb_transaction_t transaction[MAX_TRANSACTIONS]; /**< Storage for transactions */
|
|
|
+ cvmx_usb_callback_func_t callback[__CVMX_USB_CALLBACK_END]; /**< User global callbacks */
|
|
|
+ void *callback_data[__CVMX_USB_CALLBACK_END]; /**< User data for each callback */
|
|
|
+ int indent; /**< Used by debug output to indent functions */
|
|
|
+ cvmx_usb_port_status_t port_status; /**< Last port status used for change notification */
|
|
|
+ cvmx_usb_pipe_list_t free_pipes; /**< List of all pipes that are currently closed */
|
|
|
+ cvmx_usb_pipe_list_t idle_pipes; /**< List of open pipes that have no transactions */
|
|
|
+ cvmx_usb_pipe_list_t active_pipes[4]; /**< Active pipes indexed by transfer type */
|
|
|
+ uint64_t frame_number; /**< Increments every SOF interrupt for time keeping */
|
|
|
+ cvmx_usb_transaction_t *active_split; /**< Points to the current active split, or NULL */
|
|
|
+ cvmx_usb_tx_fifo_t periodic;
|
|
|
+ cvmx_usb_tx_fifo_t nonperiodic;
|
|
|
+} cvmx_usb_internal_state_t;
|
|
|
+
|
|
|
+/* This macro logs out whenever a function is called if debugging is on */
|
|
|
+#define CVMX_USB_LOG_CALLED() \
|
|
|
+ if (cvmx_unlikely(usb->init_flags & CVMX_USB_INITIALIZE_FLAGS_DEBUG_CALLS)) \
|
|
|
+ cvmx_dprintf("%*s%s: called\n", 2*usb->indent++, "", __FUNCTION__);
|
|
|
+
|
|
|
+/* This macro logs out each function parameter if debugging is on */
|
|
|
+#define CVMX_USB_LOG_PARAM(format, param) \
|
|
|
+ if (cvmx_unlikely(usb->init_flags & CVMX_USB_INITIALIZE_FLAGS_DEBUG_CALLS)) \
|
|
|
+ cvmx_dprintf("%*s%s: param %s = " format "\n", 2*usb->indent, "", __FUNCTION__, #param, param);
|
|
|
+
|
|
|
+/* This macro logs out when a function returns a value */
|
|
|
+#define CVMX_USB_RETURN(v) \
|
|
|
+ do { \
|
|
|
+ typeof(v) r = v; \
|
|
|
+ if (cvmx_unlikely(usb->init_flags & CVMX_USB_INITIALIZE_FLAGS_DEBUG_CALLS)) \
|
|
|
+ cvmx_dprintf("%*s%s: returned %s(%d)\n", 2*--usb->indent, "", __FUNCTION__, #v, r); \
|
|
|
+ return r; \
|
|
|
+ } while (0);
|
|
|
+
|
|
|
+/* This macro logs out when a function doesn't return a value */
|
|
|
+#define CVMX_USB_RETURN_NOTHING() \
|
|
|
+ do { \
|
|
|
+ if (cvmx_unlikely(usb->init_flags & CVMX_USB_INITIALIZE_FLAGS_DEBUG_CALLS)) \
|
|
|
+ cvmx_dprintf("%*s%s: returned\n", 2*--usb->indent, "", __FUNCTION__); \
|
|
|
+ return; \
|
|
|
+ } while (0);
|
|
|
+
|
|
|
+/* This macro spins on a field waiting for it to reach a value */
|
|
|
+#define CVMX_WAIT_FOR_FIELD32(address, type, field, op, value, timeout_usec)\
|
|
|
+ ({int result; \
|
|
|
+ do { \
|
|
|
+ uint64_t done = cvmx_get_cycle() + (uint64_t)timeout_usec * \
|
|
|
+ octeon_get_clock_rate() / 1000000; \
|
|
|
+ type c; \
|
|
|
+ while (1) \
|
|
|
+ { \
|
|
|
+ c.u32 = __cvmx_usb_read_csr32(usb, address); \
|
|
|
+ if (c.s.field op (value)) { \
|
|
|
+ result = 0; \
|
|
|
+ break; \
|
|
|
+ } else if (cvmx_get_cycle() > done) { \
|
|
|
+ result = -1; \
|
|
|
+ break; \
|
|
|
+ } else \
|
|
|
+ cvmx_wait(100); \
|
|
|
+ } \
|
|
|
+ } while (0); \
|
|
|
+ result;})
|
|
|
+
|
|
|
+/* This macro logically sets a single field in a CSR. It does the sequence
|
|
|
+ read, modify, and write */
|
|
|
+#define USB_SET_FIELD32(address, type, field, value)\
|
|
|
+ do { \
|
|
|
+ type c; \
|
|
|
+ c.u32 = __cvmx_usb_read_csr32(usb, address);\
|
|
|
+ c.s.field = value; \
|
|
|
+ __cvmx_usb_write_csr32(usb, address, c.u32);\
|
|
|
+ } while (0)
|
|
|
+
|
|
|
+/* Returns the IO address to push/pop stuff data from the FIFOs */
|
|
|
+#define USB_FIFO_ADDRESS(channel, usb_index) (CVMX_USBCX_GOTGCTL(usb_index) + ((channel)+1)*0x1000)
|
|
|
+
|
|
|
+static int octeon_usb_get_clock_type(void)
|
|
|
+{
|
|
|
+ switch (cvmx_sysinfo_get()->board_type) {
|
|
|
+ case CVMX_BOARD_TYPE_BBGW_REF:
|
|
|
+ case CVMX_BOARD_TYPE_LANAI2_A:
|
|
|
+ case CVMX_BOARD_TYPE_LANAI2_U:
|
|
|
+ case CVMX_BOARD_TYPE_LANAI2_G:
|
|
|
+ return USB_CLOCK_TYPE_CRYSTAL_12;
|
|
|
+ }
|
|
|
+
|
|
|
+ /* FIXME: This should use CVMX_BOARD_TYPE_UBNT_E100 */
|
|
|
+ if (OCTEON_IS_MODEL(OCTEON_CN50XX) &&
|
|
|
+ cvmx_sysinfo_get()->board_type == 20002)
|
|
|
+ return USB_CLOCK_TYPE_CRYSTAL_12;
|
|
|
+
|
|
|
+ return USB_CLOCK_TYPE_REF_48;
|
|
|
+}
|
|
|
+
|
|
|
+/**
|
|
|
+ * @INTERNAL
|
|
|
+ * Read a USB 32bit CSR. It performs the necessary address swizzle
|
|
|
+ * for 32bit CSRs and logs the value in a readable format if
|
|
|
+ * debugging is on.
|
|
|
+ *
|
|
|
+ * @param usb USB block this access is for
|
|
|
+ * @param address 64bit address to read
|
|
|
+ *
|
|
|
+ * @return Result of the read
|
|
|
+ */
|
|
|
+static inline uint32_t __cvmx_usb_read_csr32(cvmx_usb_internal_state_t *usb,
|
|
|
+ uint64_t address)
|
|
|
+{
|
|
|
+ uint32_t result = cvmx_read64_uint32(address ^ 4);
|
|
|
+ return result;
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * @INTERNAL
|
|
|
+ * Write a USB 32bit CSR. It performs the necessary address
|
|
|
+ * swizzle for 32bit CSRs and logs the value in a readable format
|
|
|
+ * if debugging is on.
|
|
|
+ *
|
|
|
+ * @param usb USB block this access is for
|
|
|
+ * @param address 64bit address to write
|
|
|
+ * @param value Value to write
|
|
|
+ */
|
|
|
+static inline void __cvmx_usb_write_csr32(cvmx_usb_internal_state_t *usb,
|
|
|
+ uint64_t address, uint32_t value)
|
|
|
+{
|
|
|
+ cvmx_write64_uint32(address ^ 4, value);
|
|
|
+ cvmx_read64_uint64(CVMX_USBNX_DMA0_INB_CHN0(usb->index));
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * @INTERNAL
|
|
|
+ * Read a USB 64bit CSR. It logs the value in a readable format if
|
|
|
+ * debugging is on.
|
|
|
+ *
|
|
|
+ * @param usb USB block this access is for
|
|
|
+ * @param address 64bit address to read
|
|
|
+ *
|
|
|
+ * @return Result of the read
|
|
|
+ */
|
|
|
+static inline uint64_t __cvmx_usb_read_csr64(cvmx_usb_internal_state_t *usb,
|
|
|
+ uint64_t address)
|
|
|
+{
|
|
|
+ uint64_t result = cvmx_read64_uint64(address);
|
|
|
+ return result;
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * @INTERNAL
|
|
|
+ * Write a USB 64bit CSR. It logs the value in a readable format
|
|
|
+ * if debugging is on.
|
|
|
+ *
|
|
|
+ * @param usb USB block this access is for
|
|
|
+ * @param address 64bit address to write
|
|
|
+ * @param value Value to write
|
|
|
+ */
|
|
|
+static inline void __cvmx_usb_write_csr64(cvmx_usb_internal_state_t *usb,
|
|
|
+ uint64_t address, uint64_t value)
|
|
|
+{
|
|
|
+ cvmx_write64_uint64(address, value);
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * @INTERNAL
|
|
|
+ * Utility function to convert complete codes into strings
|
|
|
+ *
|
|
|
+ * @param complete_code
|
|
|
+ * Code to convert
|
|
|
+ *
|
|
|
+ * @return Human readable string
|
|
|
+ */
|
|
|
+static const char *__cvmx_usb_complete_to_string(cvmx_usb_complete_t complete_code)
|
|
|
+{
|
|
|
+ switch (complete_code)
|
|
|
+ {
|
|
|
+ case CVMX_USB_COMPLETE_SUCCESS: return "SUCCESS";
|
|
|
+ case CVMX_USB_COMPLETE_SHORT: return "SHORT";
|
|
|
+ case CVMX_USB_COMPLETE_CANCEL: return "CANCEL";
|
|
|
+ case CVMX_USB_COMPLETE_ERROR: return "ERROR";
|
|
|
+ case CVMX_USB_COMPLETE_STALL: return "STALL";
|
|
|
+ case CVMX_USB_COMPLETE_XACTERR: return "XACTERR";
|
|
|
+ case CVMX_USB_COMPLETE_DATATGLERR: return "DATATGLERR";
|
|
|
+ case CVMX_USB_COMPLETE_BABBLEERR: return "BABBLEERR";
|
|
|
+ case CVMX_USB_COMPLETE_FRAMEERR: return "FRAMEERR";
|
|
|
+ }
|
|
|
+ return "Update __cvmx_usb_complete_to_string";
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * @INTERNAL
|
|
|
+ * Return non zero if this pipe connects to a non HIGH speed
|
|
|
+ * device through a high speed hub.
|
|
|
+ *
|
|
|
+ * @param usb USB block this access is for
|
|
|
+ * @param pipe Pipe to check
|
|
|
+ *
|
|
|
+ * @return Non zero if we need to do split transactions
|
|
|
+ */
|
|
|
+static inline int __cvmx_usb_pipe_needs_split(cvmx_usb_internal_state_t *usb, cvmx_usb_pipe_t *pipe)
|
|
|
+{
|
|
|
+ return ((pipe->device_speed != CVMX_USB_SPEED_HIGH) && (usb->usbcx_hprt.s.prtspd == CVMX_USB_SPEED_HIGH));
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * @INTERNAL
|
|
|
+ * Trivial utility function to return the correct PID for a pipe
|
|
|
+ *
|
|
|
+ * @param pipe pipe to check
|
|
|
+ *
|
|
|
+ * @return PID for pipe
|
|
|
+ */
|
|
|
+static inline int __cvmx_usb_get_data_pid(cvmx_usb_pipe_t *pipe)
|
|
|
+{
|
|
|
+ if (pipe->pid_toggle)
|
|
|
+ return 2; /* Data1 */
|
|
|
+ else
|
|
|
+ return 0; /* Data0 */
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * Return the number of USB ports supported by this Octeon
|
|
|
+ * chip. If the chip doesn't support USB, or is not supported
|
|
|
+ * by this API, a zero will be returned. Most Octeon chips
|
|
|
+ * support one usb port, but some support two ports.
|
|
|
+ * cvmx_usb_initialize() must be called on independent
|
|
|
+ * cvmx_usb_state_t structures.
|
|
|
+ *
|
|
|
+ * @return Number of port, zero if usb isn't supported
|
|
|
+ */
|
|
|
+int cvmx_usb_get_num_ports(void)
|
|
|
+{
|
|
|
+ int arch_ports = 0;
|
|
|
+
|
|
|
+ if (OCTEON_IS_MODEL(OCTEON_CN56XX))
|
|
|
+ arch_ports = 1;
|
|
|
+ else if (OCTEON_IS_MODEL(OCTEON_CN52XX))
|
|
|
+ arch_ports = 2;
|
|
|
+ else if (OCTEON_IS_MODEL(OCTEON_CN50XX))
|
|
|
+ arch_ports = 1;
|
|
|
+ else if (OCTEON_IS_MODEL(OCTEON_CN31XX))
|
|
|
+ arch_ports = 1;
|
|
|
+ else if (OCTEON_IS_MODEL(OCTEON_CN30XX))
|
|
|
+ arch_ports = 1;
|
|
|
+ else
|
|
|
+ arch_ports = 0;
|
|
|
+
|
|
|
+ return arch_ports;
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * @INTERNAL
|
|
|
+ * Allocate a usb transaction for use
|
|
|
+ *
|
|
|
+ * @param usb USB device state populated by
|
|
|
+ * cvmx_usb_initialize().
|
|
|
+ *
|
|
|
+ * @return Transaction or NULL
|
|
|
+ */
|
|
|
+static inline cvmx_usb_transaction_t *__cvmx_usb_alloc_transaction(cvmx_usb_internal_state_t *usb)
|
|
|
+{
|
|
|
+ cvmx_usb_transaction_t *t;
|
|
|
+ t = usb->free_transaction_head;
|
|
|
+ if (t)
|
|
|
+ {
|
|
|
+ usb->free_transaction_head = t->next;
|
|
|
+ if (!usb->free_transaction_head)
|
|
|
+ usb->free_transaction_tail = NULL;
|
|
|
+ }
|
|
|
+ else if (cvmx_unlikely(usb->init_flags & CVMX_USB_INITIALIZE_FLAGS_DEBUG_INFO))
|
|
|
+ cvmx_dprintf("%s: Failed to allocate a transaction\n", __FUNCTION__);
|
|
|
+ if (t)
|
|
|
+ {
|
|
|
+ memset(t, 0, sizeof(*t));
|
|
|
+ t->flags = __CVMX_USB_TRANSACTION_FLAGS_IN_USE;
|
|
|
+ }
|
|
|
+ return t;
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * @INTERNAL
|
|
|
+ * Free a usb transaction
|
|
|
+ *
|
|
|
+ * @param usb USB device state populated by
|
|
|
+ * cvmx_usb_initialize().
|
|
|
+ * @param transaction
|
|
|
+ * Transaction to free
|
|
|
+ */
|
|
|
+static inline void __cvmx_usb_free_transaction(cvmx_usb_internal_state_t *usb,
|
|
|
+ cvmx_usb_transaction_t *transaction)
|
|
|
+{
|
|
|
+ transaction->flags = 0;
|
|
|
+ transaction->prev = NULL;
|
|
|
+ transaction->next = NULL;
|
|
|
+ if (usb->free_transaction_tail)
|
|
|
+ usb->free_transaction_tail->next = transaction;
|
|
|
+ else
|
|
|
+ usb->free_transaction_head = transaction;
|
|
|
+ usb->free_transaction_tail = transaction;
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * @INTERNAL
|
|
|
+ * Add a pipe to the tail of a list
|
|
|
+ * @param list List to add pipe to
|
|
|
+ * @param pipe Pipe to add
|
|
|
+ */
|
|
|
+static inline void __cvmx_usb_append_pipe(cvmx_usb_pipe_list_t *list, cvmx_usb_pipe_t *pipe)
|
|
|
+{
|
|
|
+ pipe->next = NULL;
|
|
|
+ pipe->prev = list->tail;
|
|
|
+ if (list->tail)
|
|
|
+ list->tail->next = pipe;
|
|
|
+ else
|
|
|
+ list->head = pipe;
|
|
|
+ list->tail = pipe;
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * @INTERNAL
|
|
|
+ * Remove a pipe from a list
|
|
|
+ * @param list List to remove pipe from
|
|
|
+ * @param pipe Pipe to remove
|
|
|
+ */
|
|
|
+static inline void __cvmx_usb_remove_pipe(cvmx_usb_pipe_list_t *list, cvmx_usb_pipe_t *pipe)
|
|
|
+{
|
|
|
+ if (list->head == pipe)
|
|
|
+ {
|
|
|
+ list->head = pipe->next;
|
|
|
+ pipe->next = NULL;
|
|
|
+ if (list->head)
|
|
|
+ list->head->prev = NULL;
|
|
|
+ else
|
|
|
+ list->tail = NULL;
|
|
|
+ }
|
|
|
+ else if (list->tail == pipe)
|
|
|
+ {
|
|
|
+ list->tail = pipe->prev;
|
|
|
+ list->tail->next = NULL;
|
|
|
+ pipe->prev = NULL;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ pipe->prev->next = pipe->next;
|
|
|
+ pipe->next->prev = pipe->prev;
|
|
|
+ pipe->prev = NULL;
|
|
|
+ pipe->next = NULL;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * Initialize a USB port for use. This must be called before any
|
|
|
+ * other access to the Octeon USB port is made. The port starts
|
|
|
+ * off in the disabled state.
|
|
|
+ *
|
|
|
+ * @param state Pointer to an empty cvmx_usb_state_t structure
|
|
|
+ * that will be populated by the initialize call.
|
|
|
+ * This structure is then passed to all other USB
|
|
|
+ * functions.
|
|
|
+ * @param usb_port_number
|
|
|
+ * Which Octeon USB port to initialize.
|
|
|
+ * @param flags Flags to control hardware initialization. See
|
|
|
+ * cvmx_usb_initialize_flags_t for the flag
|
|
|
+ * definitions. Some flags are mandatory.
|
|
|
+ *
|
|
|
+ * @return CVMX_USB_SUCCESS or a negative error code defined in
|
|
|
+ * cvmx_usb_status_t.
|
|
|
+ */
|
|
|
+cvmx_usb_status_t cvmx_usb_initialize(cvmx_usb_state_t *state,
|
|
|
+ int usb_port_number,
|
|
|
+ cvmx_usb_initialize_flags_t flags)
|
|
|
+{
|
|
|
+ cvmx_usbnx_clk_ctl_t usbn_clk_ctl;
|
|
|
+ cvmx_usbnx_usbp_ctl_status_t usbn_usbp_ctl_status;
|
|
|
+ cvmx_usb_internal_state_t *usb = (cvmx_usb_internal_state_t*)state;
|
|
|
+
|
|
|
+ usb->init_flags = flags;
|
|
|
+ CVMX_USB_LOG_CALLED();
|
|
|
+ CVMX_USB_LOG_PARAM("%p", state);
|
|
|
+ CVMX_USB_LOG_PARAM("%d", usb_port_number);
|
|
|
+ CVMX_USB_LOG_PARAM("0x%x", flags);
|
|
|
+
|
|
|
+ /* Make sure that state is large enough to store the internal state */
|
|
|
+ if (sizeof(*state) < sizeof(*usb))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+ /* At first allow 0-1 for the usb port number */
|
|
|
+ if ((usb_port_number < 0) || (usb_port_number > 1))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+ /* For all chips except 52XX there is only one port */
|
|
|
+ if (!OCTEON_IS_MODEL(OCTEON_CN52XX) && (usb_port_number > 0))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+ /* Try to determine clock type automatically */
|
|
|
+ if ((flags & (CVMX_USB_INITIALIZE_FLAGS_CLOCK_XO_XI |
|
|
|
+ CVMX_USB_INITIALIZE_FLAGS_CLOCK_XO_GND)) == 0)
|
|
|
+ {
|
|
|
+ if (octeon_usb_get_clock_type() == USB_CLOCK_TYPE_CRYSTAL_12)
|
|
|
+ flags |= CVMX_USB_INITIALIZE_FLAGS_CLOCK_XO_XI; /* Only 12 MHZ crystals are supported */
|
|
|
+ else
|
|
|
+ flags |= CVMX_USB_INITIALIZE_FLAGS_CLOCK_XO_GND;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (flags & CVMX_USB_INITIALIZE_FLAGS_CLOCK_XO_GND)
|
|
|
+ {
|
|
|
+ /* Check for auto ref clock frequency */
|
|
|
+ if (!(flags & CVMX_USB_INITIALIZE_FLAGS_CLOCK_MHZ_MASK))
|
|
|
+ switch (octeon_usb_get_clock_type())
|
|
|
+ {
|
|
|
+ case USB_CLOCK_TYPE_REF_12:
|
|
|
+ flags |= CVMX_USB_INITIALIZE_FLAGS_CLOCK_12MHZ;
|
|
|
+ break;
|
|
|
+ case USB_CLOCK_TYPE_REF_24:
|
|
|
+ flags |= CVMX_USB_INITIALIZE_FLAGS_CLOCK_24MHZ;
|
|
|
+ break;
|
|
|
+ case USB_CLOCK_TYPE_REF_48:
|
|
|
+ flags |= CVMX_USB_INITIALIZE_FLAGS_CLOCK_48MHZ;
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ memset(usb, 0, sizeof(usb));
|
|
|
+ usb->init_flags = flags;
|
|
|
+
|
|
|
+ /* Initialize the USB state structure */
|
|
|
+ {
|
|
|
+ int i;
|
|
|
+ usb->index = usb_port_number;
|
|
|
+
|
|
|
+ /* Initialize the transaction double linked list */
|
|
|
+ usb->free_transaction_head = NULL;
|
|
|
+ usb->free_transaction_tail = NULL;
|
|
|
+ for (i=0; i<MAX_TRANSACTIONS; i++)
|
|
|
+ __cvmx_usb_free_transaction(usb, usb->transaction + i);
|
|
|
+ for (i=0; i<MAX_PIPES; i++)
|
|
|
+ __cvmx_usb_append_pipe(&usb->free_pipes, usb->pipe + i);
|
|
|
+ }
|
|
|
+
|
|
|
+ /* Power On Reset and PHY Initialization */
|
|
|
+
|
|
|
+ /* 1. Wait for DCOK to assert (nothing to do) */
|
|
|
+ /* 2a. Write USBN0/1_CLK_CTL[POR] = 1 and
|
|
|
+ USBN0/1_CLK_CTL[HRST,PRST,HCLK_RST] = 0 */
|
|
|
+ usbn_clk_ctl.u64 = __cvmx_usb_read_csr64(usb, CVMX_USBNX_CLK_CTL(usb->index));
|
|
|
+ usbn_clk_ctl.s.por = 1;
|
|
|
+ usbn_clk_ctl.s.hrst = 0;
|
|
|
+ usbn_clk_ctl.s.prst = 0;
|
|
|
+ usbn_clk_ctl.s.hclk_rst = 0;
|
|
|
+ usbn_clk_ctl.s.enable = 0;
|
|
|
+ /* 2b. Select the USB reference clock/crystal parameters by writing
|
|
|
+ appropriate values to USBN0/1_CLK_CTL[P_C_SEL, P_RTYPE, P_COM_ON] */
|
|
|
+ if (usb->init_flags & CVMX_USB_INITIALIZE_FLAGS_CLOCK_XO_GND)
|
|
|
+ {
|
|
|
+ /* The USB port uses 12/24/48MHz 2.5V board clock
|
|
|
+ source at USB_XO. USB_XI should be tied to GND.
|
|
|
+ Most Octeon evaluation boards require this setting */
|
|
|
+ if (OCTEON_IS_MODEL(OCTEON_CN3XXX))
|
|
|
+ {
|
|
|
+ usbn_clk_ctl.cn31xx.p_rclk = 1; /* From CN31XX,CN30XX manual */
|
|
|
+ usbn_clk_ctl.cn31xx.p_xenbn = 0;
|
|
|
+ }
|
|
|
+ else if (OCTEON_IS_MODEL(OCTEON_CN56XX) || OCTEON_IS_MODEL(OCTEON_CN50XX))
|
|
|
+ usbn_clk_ctl.cn56xx.p_rtype = 2; /* From CN56XX,CN50XX manual */
|
|
|
+ else
|
|
|
+ usbn_clk_ctl.cn52xx.p_rtype = 1; /* From CN52XX manual */
|
|
|
+
|
|
|
+ switch (flags & CVMX_USB_INITIALIZE_FLAGS_CLOCK_MHZ_MASK)
|
|
|
+ {
|
|
|
+ case CVMX_USB_INITIALIZE_FLAGS_CLOCK_12MHZ:
|
|
|
+ usbn_clk_ctl.s.p_c_sel = 0;
|
|
|
+ break;
|
|
|
+ case CVMX_USB_INITIALIZE_FLAGS_CLOCK_24MHZ:
|
|
|
+ usbn_clk_ctl.s.p_c_sel = 1;
|
|
|
+ break;
|
|
|
+ case CVMX_USB_INITIALIZE_FLAGS_CLOCK_48MHZ:
|
|
|
+ usbn_clk_ctl.s.p_c_sel = 2;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ /* The USB port uses a 12MHz crystal as clock source
|
|
|
+ at USB_XO and USB_XI */
|
|
|
+ if (OCTEON_IS_MODEL(OCTEON_CN3XXX))
|
|
|
+ {
|
|
|
+ usbn_clk_ctl.cn31xx.p_rclk = 1; /* From CN31XX,CN30XX manual */
|
|
|
+ usbn_clk_ctl.cn31xx.p_xenbn = 1;
|
|
|
+ }
|
|
|
+ else if (OCTEON_IS_MODEL(OCTEON_CN56XX) || OCTEON_IS_MODEL(OCTEON_CN50XX))
|
|
|
+ usbn_clk_ctl.cn56xx.p_rtype = 0; /* From CN56XX,CN50XX manual */
|
|
|
+ else
|
|
|
+ usbn_clk_ctl.cn52xx.p_rtype = 0; /* From CN52XX manual */
|
|
|
+
|
|
|
+ usbn_clk_ctl.s.p_c_sel = 0;
|
|
|
+ }
|
|
|
+ /* 2c. Select the HCLK via writing USBN0/1_CLK_CTL[DIVIDE, DIVIDE2] and
|
|
|
+ setting USBN0/1_CLK_CTL[ENABLE] = 1. Divide the core clock down such
|
|
|
+ that USB is as close as possible to 125Mhz */
|
|
|
+ {
|
|
|
+ int divisor = (octeon_get_clock_rate()+125000000-1)/125000000;
|
|
|
+ if (divisor < 4) /* Lower than 4 doesn't seem to work properly */
|
|
|
+ divisor = 4;
|
|
|
+ usbn_clk_ctl.s.divide = divisor;
|
|
|
+ usbn_clk_ctl.s.divide2 = 0;
|
|
|
+ }
|
|
|
+ __cvmx_usb_write_csr64(usb, CVMX_USBNX_CLK_CTL(usb->index),
|
|
|
+ usbn_clk_ctl.u64);
|
|
|
+ /* 2d. Write USBN0/1_CLK_CTL[HCLK_RST] = 1 */
|
|
|
+ usbn_clk_ctl.s.hclk_rst = 1;
|
|
|
+ __cvmx_usb_write_csr64(usb, CVMX_USBNX_CLK_CTL(usb->index),
|
|
|
+ usbn_clk_ctl.u64);
|
|
|
+ /* 2e. Wait 64 core-clock cycles for HCLK to stabilize */
|
|
|
+ cvmx_wait(64);
|
|
|
+ /* 3. Program the power-on reset field in the USBN clock-control register:
|
|
|
+ USBN_CLK_CTL[POR] = 0 */
|
|
|
+ usbn_clk_ctl.s.por = 0;
|
|
|
+ __cvmx_usb_write_csr64(usb, CVMX_USBNX_CLK_CTL(usb->index),
|
|
|
+ usbn_clk_ctl.u64);
|
|
|
+ /* 4. Wait 1 ms for PHY clock to start */
|
|
|
+ cvmx_wait_usec(1000);
|
|
|
+ /* 5. Program the Reset input from automatic test equipment field in the
|
|
|
+ USBP control and status register: USBN_USBP_CTL_STATUS[ATE_RESET] = 1 */
|
|
|
+ usbn_usbp_ctl_status.u64 = __cvmx_usb_read_csr64(usb, CVMX_USBNX_USBP_CTL_STATUS(usb->index));
|
|
|
+ usbn_usbp_ctl_status.s.ate_reset = 1;
|
|
|
+ __cvmx_usb_write_csr64(usb, CVMX_USBNX_USBP_CTL_STATUS(usb->index),
|
|
|
+ usbn_usbp_ctl_status.u64);
|
|
|
+ /* 6. Wait 10 cycles */
|
|
|
+ cvmx_wait(10);
|
|
|
+ /* 7. Clear ATE_RESET field in the USBN clock-control register:
|
|
|
+ USBN_USBP_CTL_STATUS[ATE_RESET] = 0 */
|
|
|
+ usbn_usbp_ctl_status.s.ate_reset = 0;
|
|
|
+ __cvmx_usb_write_csr64(usb, CVMX_USBNX_USBP_CTL_STATUS(usb->index),
|
|
|
+ usbn_usbp_ctl_status.u64);
|
|
|
+ /* 8. Program the PHY reset field in the USBN clock-control register:
|
|
|
+ USBN_CLK_CTL[PRST] = 1 */
|
|
|
+ usbn_clk_ctl.s.prst = 1;
|
|
|
+ __cvmx_usb_write_csr64(usb, CVMX_USBNX_CLK_CTL(usb->index),
|
|
|
+ usbn_clk_ctl.u64);
|
|
|
+ /* 9. Program the USBP control and status register to select host or
|
|
|
+ device mode. USBN_USBP_CTL_STATUS[HST_MODE] = 0 for host, = 1 for
|
|
|
+ device */
|
|
|
+ usbn_usbp_ctl_status.s.hst_mode = 0;
|
|
|
+ __cvmx_usb_write_csr64(usb, CVMX_USBNX_USBP_CTL_STATUS(usb->index),
|
|
|
+ usbn_usbp_ctl_status.u64);
|
|
|
+ /* 10. Wait 1 us */
|
|
|
+ cvmx_wait_usec(1);
|
|
|
+ /* 11. Program the hreset_n field in the USBN clock-control register:
|
|
|
+ USBN_CLK_CTL[HRST] = 1 */
|
|
|
+ usbn_clk_ctl.s.hrst = 1;
|
|
|
+ __cvmx_usb_write_csr64(usb, CVMX_USBNX_CLK_CTL(usb->index),
|
|
|
+ usbn_clk_ctl.u64);
|
|
|
+ /* 12. Proceed to USB core initialization */
|
|
|
+ usbn_clk_ctl.s.enable = 1;
|
|
|
+ __cvmx_usb_write_csr64(usb, CVMX_USBNX_CLK_CTL(usb->index),
|
|
|
+ usbn_clk_ctl.u64);
|
|
|
+ cvmx_wait_usec(1);
|
|
|
+
|
|
|
+ /* USB Core Initialization */
|
|
|
+
|
|
|
+ /* 1. Read USBC_GHWCFG1, USBC_GHWCFG2, USBC_GHWCFG3, USBC_GHWCFG4 to
|
|
|
+ determine USB core configuration parameters. */
|
|
|
+ /* Nothing needed */
|
|
|
+ /* 2. Program the following fields in the global AHB configuration
|
|
|
+ register (USBC_GAHBCFG)
|
|
|
+ DMA mode, USBC_GAHBCFG[DMAEn]: 1 = DMA mode, 0 = slave mode
|
|
|
+ Burst length, USBC_GAHBCFG[HBSTLEN] = 0
|
|
|
+ Nonperiodic TxFIFO empty level (slave mode only),
|
|
|
+ USBC_GAHBCFG[NPTXFEMPLVL]
|
|
|
+ Periodic TxFIFO empty level (slave mode only),
|
|
|
+ USBC_GAHBCFG[PTXFEMPLVL]
|
|
|
+ Global interrupt mask, USBC_GAHBCFG[GLBLINTRMSK] = 1 */
|
|
|
+ {
|
|
|
+ cvmx_usbcx_gahbcfg_t usbcx_gahbcfg;
|
|
|
+ /* Due to an errata, CN31XX doesn't support DMA */
|
|
|
+ if (OCTEON_IS_MODEL(OCTEON_CN31XX))
|
|
|
+ usb->init_flags |= CVMX_USB_INITIALIZE_FLAGS_NO_DMA;
|
|
|
+ usbcx_gahbcfg.u32 = 0;
|
|
|
+ usbcx_gahbcfg.s.dmaen = !(usb->init_flags & CVMX_USB_INITIALIZE_FLAGS_NO_DMA);
|
|
|
+ if (usb->init_flags & CVMX_USB_INITIALIZE_FLAGS_NO_DMA)
|
|
|
+ usb->idle_hardware_channels = 0x1; /* Only use one channel with non DMA */
|
|
|
+ else if (OCTEON_IS_MODEL(OCTEON_CN5XXX))
|
|
|
+ usb->idle_hardware_channels = 0xf7; /* CN5XXX have an errata with channel 3 */
|
|
|
+ else
|
|
|
+ usb->idle_hardware_channels = 0xff;
|
|
|
+ usbcx_gahbcfg.s.hbstlen = 0;
|
|
|
+ usbcx_gahbcfg.s.nptxfemplvl = 1;
|
|
|
+ usbcx_gahbcfg.s.ptxfemplvl = 1;
|
|
|
+ usbcx_gahbcfg.s.glblintrmsk = 1;
|
|
|
+ __cvmx_usb_write_csr32(usb, CVMX_USBCX_GAHBCFG(usb->index),
|
|
|
+ usbcx_gahbcfg.u32);
|
|
|
+ }
|
|
|
+ /* 3. Program the following fields in USBC_GUSBCFG register.
|
|
|
+ HS/FS timeout calibration, USBC_GUSBCFG[TOUTCAL] = 0
|
|
|
+ ULPI DDR select, USBC_GUSBCFG[DDRSEL] = 0
|
|
|
+ USB turnaround time, USBC_GUSBCFG[USBTRDTIM] = 0x5
|
|
|
+ PHY low-power clock select, USBC_GUSBCFG[PHYLPWRCLKSEL] = 0 */
|
|
|
+ {
|
|
|
+ cvmx_usbcx_gusbcfg_t usbcx_gusbcfg;
|
|
|
+ usbcx_gusbcfg.u32 = __cvmx_usb_read_csr32(usb, CVMX_USBCX_GUSBCFG(usb->index));
|
|
|
+ usbcx_gusbcfg.s.toutcal = 0;
|
|
|
+ usbcx_gusbcfg.s.ddrsel = 0;
|
|
|
+ usbcx_gusbcfg.s.usbtrdtim = 0x5;
|
|
|
+ usbcx_gusbcfg.s.phylpwrclksel = 0;
|
|
|
+ __cvmx_usb_write_csr32(usb, CVMX_USBCX_GUSBCFG(usb->index),
|
|
|
+ usbcx_gusbcfg.u32);
|
|
|
+ }
|
|
|
+ /* 4. The software must unmask the following bits in the USBC_GINTMSK
|
|
|
+ register.
|
|
|
+ OTG interrupt mask, USBC_GINTMSK[OTGINTMSK] = 1
|
|
|
+ Mode mismatch interrupt mask, USBC_GINTMSK[MODEMISMSK] = 1 */
|
|
|
+ {
|
|
|
+ cvmx_usbcx_gintmsk_t usbcx_gintmsk;
|
|
|
+ int channel;
|
|
|
+
|
|
|
+ usbcx_gintmsk.u32 = __cvmx_usb_read_csr32(usb, CVMX_USBCX_GINTMSK(usb->index));
|
|
|
+ usbcx_gintmsk.s.otgintmsk = 1;
|
|
|
+ usbcx_gintmsk.s.modemismsk = 1;
|
|
|
+ usbcx_gintmsk.s.hchintmsk = 1;
|
|
|
+ usbcx_gintmsk.s.sofmsk = 0;
|
|
|
+ /* We need RX FIFO interrupts if we don't have DMA */
|
|
|
+ if (usb->init_flags & CVMX_USB_INITIALIZE_FLAGS_NO_DMA)
|
|
|
+ usbcx_gintmsk.s.rxflvlmsk = 1;
|
|
|
+ __cvmx_usb_write_csr32(usb, CVMX_USBCX_GINTMSK(usb->index),
|
|
|
+ usbcx_gintmsk.u32);
|
|
|
+
|
|
|
+ /* Disable all channel interrupts. We'll enable them per channel later */
|
|
|
+ for (channel=0; channel<8; channel++)
|
|
|
+ __cvmx_usb_write_csr32(usb, CVMX_USBCX_HCINTMSKX(channel, usb->index), 0);
|
|
|
+ }
|
|
|
+
|
|
|
+ {
|
|
|
+ /* Host Port Initialization */
|
|
|
+ if (cvmx_unlikely(usb->init_flags & CVMX_USB_INITIALIZE_FLAGS_DEBUG_INFO))
|
|
|
+ cvmx_dprintf("%s: USB%d is in host mode\n", __FUNCTION__, usb->index);
|
|
|
+
|
|
|
+ /* 1. Program the host-port interrupt-mask field to unmask,
|
|
|
+ USBC_GINTMSK[PRTINT] = 1 */
|
|
|
+ USB_SET_FIELD32(CVMX_USBCX_GINTMSK(usb->index), cvmx_usbcx_gintmsk_t,
|
|
|
+ prtintmsk, 1);
|
|
|
+ USB_SET_FIELD32(CVMX_USBCX_GINTMSK(usb->index), cvmx_usbcx_gintmsk_t,
|
|
|
+ disconnintmsk, 1);
|
|
|
+ /* 2. Program the USBC_HCFG register to select full-speed host or
|
|
|
+ high-speed host. */
|
|
|
+ {
|
|
|
+ cvmx_usbcx_hcfg_t usbcx_hcfg;
|
|
|
+ usbcx_hcfg.u32 = __cvmx_usb_read_csr32(usb, CVMX_USBCX_HCFG(usb->index));
|
|
|
+ usbcx_hcfg.s.fslssupp = 0;
|
|
|
+ usbcx_hcfg.s.fslspclksel = 0;
|
|
|
+ __cvmx_usb_write_csr32(usb, CVMX_USBCX_HCFG(usb->index), usbcx_hcfg.u32);
|
|
|
+ }
|
|
|
+ /* 3. Program the port power bit to drive VBUS on the USB,
|
|
|
+ USBC_HPRT[PRTPWR] = 1 */
|
|
|
+ USB_SET_FIELD32(CVMX_USBCX_HPRT(usb->index), cvmx_usbcx_hprt_t, prtpwr, 1);
|
|
|
+
|
|
|
+ /* Steps 4-15 from the manual are done later in the port enable */
|
|
|
+ }
|
|
|
+
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_SUCCESS);
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * Shutdown a USB port after a call to cvmx_usb_initialize().
|
|
|
+ * The port should be disabled with all pipes closed when this
|
|
|
+ * function is called.
|
|
|
+ *
|
|
|
+ * @param state USB device state populated by
|
|
|
+ * cvmx_usb_initialize().
|
|
|
+ *
|
|
|
+ * @return CVMX_USB_SUCCESS or a negative error code defined in
|
|
|
+ * cvmx_usb_status_t.
|
|
|
+ */
|
|
|
+cvmx_usb_status_t cvmx_usb_shutdown(cvmx_usb_state_t *state)
|
|
|
+{
|
|
|
+ cvmx_usbnx_clk_ctl_t usbn_clk_ctl;
|
|
|
+ cvmx_usb_internal_state_t *usb = (cvmx_usb_internal_state_t*)state;
|
|
|
+
|
|
|
+ CVMX_USB_LOG_CALLED();
|
|
|
+ CVMX_USB_LOG_PARAM("%p", state);
|
|
|
+
|
|
|
+ /* Make sure all pipes are closed */
|
|
|
+ if (usb->idle_pipes.head ||
|
|
|
+ usb->active_pipes[CVMX_USB_TRANSFER_ISOCHRONOUS].head ||
|
|
|
+ usb->active_pipes[CVMX_USB_TRANSFER_INTERRUPT].head ||
|
|
|
+ usb->active_pipes[CVMX_USB_TRANSFER_CONTROL].head ||
|
|
|
+ usb->active_pipes[CVMX_USB_TRANSFER_BULK].head)
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_BUSY);
|
|
|
+
|
|
|
+ /* Disable the clocks and put them in power on reset */
|
|
|
+ usbn_clk_ctl.u64 = __cvmx_usb_read_csr64(usb, CVMX_USBNX_CLK_CTL(usb->index));
|
|
|
+ usbn_clk_ctl.s.enable = 1;
|
|
|
+ usbn_clk_ctl.s.por = 1;
|
|
|
+ usbn_clk_ctl.s.hclk_rst = 1;
|
|
|
+ usbn_clk_ctl.s.prst = 0;
|
|
|
+ usbn_clk_ctl.s.hrst = 0;
|
|
|
+ __cvmx_usb_write_csr64(usb, CVMX_USBNX_CLK_CTL(usb->index),
|
|
|
+ usbn_clk_ctl.u64);
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_SUCCESS);
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * Enable a USB port. After this call succeeds, the USB port is
|
|
|
+ * online and servicing requests.
|
|
|
+ *
|
|
|
+ * @param state USB device state populated by
|
|
|
+ * cvmx_usb_initialize().
|
|
|
+ *
|
|
|
+ * @return CVMX_USB_SUCCESS or a negative error code defined in
|
|
|
+ * cvmx_usb_status_t.
|
|
|
+ */
|
|
|
+cvmx_usb_status_t cvmx_usb_enable(cvmx_usb_state_t *state)
|
|
|
+{
|
|
|
+ cvmx_usbcx_ghwcfg3_t usbcx_ghwcfg3;
|
|
|
+ cvmx_usb_internal_state_t *usb = (cvmx_usb_internal_state_t*)state;
|
|
|
+
|
|
|
+ CVMX_USB_LOG_CALLED();
|
|
|
+ CVMX_USB_LOG_PARAM("%p", state);
|
|
|
+
|
|
|
+ usb->usbcx_hprt.u32 = __cvmx_usb_read_csr32(usb, CVMX_USBCX_HPRT(usb->index));
|
|
|
+
|
|
|
+ /* If the port is already enabled the just return. We don't need to do
|
|
|
+ anything */
|
|
|
+ if (usb->usbcx_hprt.s.prtena)
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_SUCCESS);
|
|
|
+
|
|
|
+ /* If there is nothing plugged into the port then fail immediately */
|
|
|
+ if (!usb->usbcx_hprt.s.prtconnsts)
|
|
|
+ {
|
|
|
+ if (cvmx_unlikely(usb->init_flags & CVMX_USB_INITIALIZE_FLAGS_DEBUG_INFO))
|
|
|
+ cvmx_dprintf("%s: USB%d Nothing plugged into the port\n", __FUNCTION__, usb->index);
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_TIMEOUT);
|
|
|
+ }
|
|
|
+
|
|
|
+ /* Program the port reset bit to start the reset process */
|
|
|
+ USB_SET_FIELD32(CVMX_USBCX_HPRT(usb->index), cvmx_usbcx_hprt_t, prtrst, 1);
|
|
|
+
|
|
|
+ /* Wait at least 50ms (high speed), or 10ms (full speed) for the reset
|
|
|
+ process to complete. */
|
|
|
+ cvmx_wait_usec(50000);
|
|
|
+
|
|
|
+ /* Program the port reset bit to 0, USBC_HPRT[PRTRST] = 0 */
|
|
|
+ USB_SET_FIELD32(CVMX_USBCX_HPRT(usb->index), cvmx_usbcx_hprt_t, prtrst, 0);
|
|
|
+
|
|
|
+ /* Wait for the USBC_HPRT[PRTENA]. */
|
|
|
+ if (CVMX_WAIT_FOR_FIELD32(CVMX_USBCX_HPRT(usb->index), cvmx_usbcx_hprt_t,
|
|
|
+ prtena, ==, 1, 100000))
|
|
|
+ {
|
|
|
+ if (cvmx_unlikely(usb->init_flags & CVMX_USB_INITIALIZE_FLAGS_DEBUG_INFO))
|
|
|
+ cvmx_dprintf("%s: Timeout waiting for the port to finish reset\n",
|
|
|
+ __FUNCTION__);
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_TIMEOUT);
|
|
|
+ }
|
|
|
+
|
|
|
+ /* Read the port speed field to get the enumerated speed, USBC_HPRT[PRTSPD]. */
|
|
|
+ usb->usbcx_hprt.u32 = __cvmx_usb_read_csr32(usb, CVMX_USBCX_HPRT(usb->index));
|
|
|
+ if (cvmx_unlikely(usb->init_flags & CVMX_USB_INITIALIZE_FLAGS_DEBUG_INFO))
|
|
|
+ cvmx_dprintf("%s: USB%d is in %s speed mode\n", __FUNCTION__, usb->index,
|
|
|
+ (usb->usbcx_hprt.s.prtspd == CVMX_USB_SPEED_HIGH) ? "high" :
|
|
|
+ (usb->usbcx_hprt.s.prtspd == CVMX_USB_SPEED_FULL) ? "full" :
|
|
|
+ "low");
|
|
|
+
|
|
|
+ usbcx_ghwcfg3.u32 = __cvmx_usb_read_csr32(usb, CVMX_USBCX_GHWCFG3(usb->index));
|
|
|
+
|
|
|
+ /* 13. Program the USBC_GRXFSIZ register to select the size of the receive
|
|
|
+ FIFO (25%). */
|
|
|
+ USB_SET_FIELD32(CVMX_USBCX_GRXFSIZ(usb->index), cvmx_usbcx_grxfsiz_t,
|
|
|
+ rxfdep, usbcx_ghwcfg3.s.dfifodepth / 4);
|
|
|
+ /* 14. Program the USBC_GNPTXFSIZ register to select the size and the
|
|
|
+ start address of the non- periodic transmit FIFO for nonperiodic
|
|
|
+ transactions (50%). */
|
|
|
+ {
|
|
|
+ cvmx_usbcx_gnptxfsiz_t siz;
|
|
|
+ siz.u32 = __cvmx_usb_read_csr32(usb, CVMX_USBCX_GNPTXFSIZ(usb->index));
|
|
|
+ siz.s.nptxfdep = usbcx_ghwcfg3.s.dfifodepth / 2;
|
|
|
+ siz.s.nptxfstaddr = usbcx_ghwcfg3.s.dfifodepth / 4;
|
|
|
+ __cvmx_usb_write_csr32(usb, CVMX_USBCX_GNPTXFSIZ(usb->index), siz.u32);
|
|
|
+ }
|
|
|
+ /* 15. Program the USBC_HPTXFSIZ register to select the size and start
|
|
|
+ address of the periodic transmit FIFO for periodic transactions (25%). */
|
|
|
+ {
|
|
|
+ cvmx_usbcx_hptxfsiz_t siz;
|
|
|
+ siz.u32 = __cvmx_usb_read_csr32(usb, CVMX_USBCX_HPTXFSIZ(usb->index));
|
|
|
+ siz.s.ptxfsize = usbcx_ghwcfg3.s.dfifodepth / 4;
|
|
|
+ siz.s.ptxfstaddr = 3 * usbcx_ghwcfg3.s.dfifodepth / 4;
|
|
|
+ __cvmx_usb_write_csr32(usb, CVMX_USBCX_HPTXFSIZ(usb->index), siz.u32);
|
|
|
+ }
|
|
|
+ /* Flush all FIFOs */
|
|
|
+ USB_SET_FIELD32(CVMX_USBCX_GRSTCTL(usb->index), cvmx_usbcx_grstctl_t, txfnum, 0x10);
|
|
|
+ USB_SET_FIELD32(CVMX_USBCX_GRSTCTL(usb->index), cvmx_usbcx_grstctl_t, txfflsh, 1);
|
|
|
+ CVMX_WAIT_FOR_FIELD32(CVMX_USBCX_GRSTCTL(usb->index), cvmx_usbcx_grstctl_t,
|
|
|
+ txfflsh, ==, 0, 100);
|
|
|
+ USB_SET_FIELD32(CVMX_USBCX_GRSTCTL(usb->index), cvmx_usbcx_grstctl_t, rxfflsh, 1);
|
|
|
+ CVMX_WAIT_FOR_FIELD32(CVMX_USBCX_GRSTCTL(usb->index), cvmx_usbcx_grstctl_t,
|
|
|
+ rxfflsh, ==, 0, 100);
|
|
|
+
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_SUCCESS);
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * Disable a USB port. After this call the USB port will not
|
|
|
+ * generate data transfers and will not generate events.
|
|
|
+ * Transactions in process will fail and call their
|
|
|
+ * associated callbacks.
|
|
|
+ *
|
|
|
+ * @param state USB device state populated by
|
|
|
+ * cvmx_usb_initialize().
|
|
|
+ *
|
|
|
+ * @return CVMX_USB_SUCCESS or a negative error code defined in
|
|
|
+ * cvmx_usb_status_t.
|
|
|
+ */
|
|
|
+cvmx_usb_status_t cvmx_usb_disable(cvmx_usb_state_t *state)
|
|
|
+{
|
|
|
+ cvmx_usb_internal_state_t *usb = (cvmx_usb_internal_state_t*)state;
|
|
|
+
|
|
|
+ CVMX_USB_LOG_CALLED();
|
|
|
+ CVMX_USB_LOG_PARAM("%p", state);
|
|
|
+
|
|
|
+ /* Disable the port */
|
|
|
+ USB_SET_FIELD32(CVMX_USBCX_HPRT(usb->index), cvmx_usbcx_hprt_t, prtena, 1);
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_SUCCESS);
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * Get the current state of the USB port. Use this call to
|
|
|
+ * determine if the usb port has anything connected, is enabled,
|
|
|
+ * or has some sort of error condition. The return value of this
|
|
|
+ * call has "changed" bits to signal of the value of some fields
|
|
|
+ * have changed between calls. These "changed" fields are based
|
|
|
+ * on the last call to cvmx_usb_set_status(). In order to clear
|
|
|
+ * them, you must update the status through cvmx_usb_set_status().
|
|
|
+ *
|
|
|
+ * @param state USB device state populated by
|
|
|
+ * cvmx_usb_initialize().
|
|
|
+ *
|
|
|
+ * @return Port status information
|
|
|
+ */
|
|
|
+cvmx_usb_port_status_t cvmx_usb_get_status(cvmx_usb_state_t *state)
|
|
|
+{
|
|
|
+ cvmx_usbcx_hprt_t usbc_hprt;
|
|
|
+ cvmx_usb_port_status_t result;
|
|
|
+ cvmx_usb_internal_state_t *usb = (cvmx_usb_internal_state_t*)state;
|
|
|
+
|
|
|
+ memset(&result, 0, sizeof(result));
|
|
|
+
|
|
|
+ CVMX_USB_LOG_CALLED();
|
|
|
+ CVMX_USB_LOG_PARAM("%p", state);
|
|
|
+
|
|
|
+ usbc_hprt.u32 = __cvmx_usb_read_csr32(usb, CVMX_USBCX_HPRT(usb->index));
|
|
|
+ result.port_enabled = usbc_hprt.s.prtena;
|
|
|
+ result.port_over_current = usbc_hprt.s.prtovrcurract;
|
|
|
+ result.port_powered = usbc_hprt.s.prtpwr;
|
|
|
+ result.port_speed = usbc_hprt.s.prtspd;
|
|
|
+ result.connected = usbc_hprt.s.prtconnsts;
|
|
|
+ result.connect_change = (result.connected != usb->port_status.connected);
|
|
|
+
|
|
|
+ if (cvmx_unlikely(usb->init_flags & CVMX_USB_INITIALIZE_FLAGS_DEBUG_CALLS))
|
|
|
+ cvmx_dprintf("%*s%s: returned port enabled=%d, over_current=%d, powered=%d, speed=%d, connected=%d, connect_change=%d\n",
|
|
|
+ 2*(--usb->indent), "", __FUNCTION__,
|
|
|
+ result.port_enabled,
|
|
|
+ result.port_over_current,
|
|
|
+ result.port_powered,
|
|
|
+ result.port_speed,
|
|
|
+ result.connected,
|
|
|
+ result.connect_change);
|
|
|
+ return result;
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * Set the current state of the USB port. The status is used as
|
|
|
+ * a reference for the "changed" bits returned by
|
|
|
+ * cvmx_usb_get_status(). Other than serving as a reference, the
|
|
|
+ * status passed to this function is not used. No fields can be
|
|
|
+ * changed through this call.
|
|
|
+ *
|
|
|
+ * @param state USB device state populated by
|
|
|
+ * cvmx_usb_initialize().
|
|
|
+ * @param port_status
|
|
|
+ * Port status to set, most like returned by cvmx_usb_get_status()
|
|
|
+ */
|
|
|
+void cvmx_usb_set_status(cvmx_usb_state_t *state, cvmx_usb_port_status_t port_status)
|
|
|
+{
|
|
|
+ cvmx_usb_internal_state_t *usb = (cvmx_usb_internal_state_t*)state;
|
|
|
+ CVMX_USB_LOG_CALLED();
|
|
|
+ CVMX_USB_LOG_PARAM("%p", state);
|
|
|
+ usb->port_status = port_status;
|
|
|
+ CVMX_USB_RETURN_NOTHING();
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * @INTERNAL
|
|
|
+ * Convert a USB transaction into a handle
|
|
|
+ *
|
|
|
+ * @param usb USB device state populated by
|
|
|
+ * cvmx_usb_initialize().
|
|
|
+ * @param transaction
|
|
|
+ * Transaction to get handle for
|
|
|
+ *
|
|
|
+ * @return Handle
|
|
|
+ */
|
|
|
+static inline int __cvmx_usb_get_submit_handle(cvmx_usb_internal_state_t *usb,
|
|
|
+ cvmx_usb_transaction_t *transaction)
|
|
|
+{
|
|
|
+ return ((unsigned long)transaction - (unsigned long)usb->transaction) /
|
|
|
+ sizeof(*transaction);
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * @INTERNAL
|
|
|
+ * Convert a USB pipe into a handle
|
|
|
+ *
|
|
|
+ * @param usb USB device state populated by
|
|
|
+ * cvmx_usb_initialize().
|
|
|
+ * @param pipe Pipe to get handle for
|
|
|
+ *
|
|
|
+ * @return Handle
|
|
|
+ */
|
|
|
+static inline int __cvmx_usb_get_pipe_handle(cvmx_usb_internal_state_t *usb,
|
|
|
+ cvmx_usb_pipe_t *pipe)
|
|
|
+{
|
|
|
+ return ((unsigned long)pipe - (unsigned long)usb->pipe) / sizeof(*pipe);
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * Open a virtual pipe between the host and a USB device. A pipe
|
|
|
+ * must be opened before data can be transferred between a device
|
|
|
+ * and Octeon.
|
|
|
+ *
|
|
|
+ * @param state USB device state populated by
|
|
|
+ * cvmx_usb_initialize().
|
|
|
+ * @param flags Optional pipe flags defined in
|
|
|
+ * cvmx_usb_pipe_flags_t.
|
|
|
+ * @param device_addr
|
|
|
+ * USB device address to open the pipe to
|
|
|
+ * (0-127).
|
|
|
+ * @param endpoint_num
|
|
|
+ * USB endpoint number to open the pipe to
|
|
|
+ * (0-15).
|
|
|
+ * @param device_speed
|
|
|
+ * The speed of the device the pipe is going
|
|
|
+ * to. This must match the device's speed,
|
|
|
+ * which may be different than the port speed.
|
|
|
+ * @param max_packet The maximum packet length the device can
|
|
|
+ * transmit/receive (low speed=0-8, full
|
|
|
+ * speed=0-1023, high speed=0-1024). This value
|
|
|
+ * comes from the standard endpoint descriptor
|
|
|
+ * field wMaxPacketSize bits <10:0>.
|
|
|
+ * @param transfer_type
|
|
|
+ * The type of transfer this pipe is for.
|
|
|
+ * @param transfer_dir
|
|
|
+ * The direction the pipe is in. This is not
|
|
|
+ * used for control pipes.
|
|
|
+ * @param interval For ISOCHRONOUS and INTERRUPT transfers,
|
|
|
+ * this is how often the transfer is scheduled
|
|
|
+ * for. All other transfers should specify
|
|
|
+ * zero. The units are in frames (8000/sec at
|
|
|
+ * high speed, 1000/sec for full speed).
|
|
|
+ * @param multi_count
|
|
|
+ * For high speed devices, this is the maximum
|
|
|
+ * allowed number of packet per microframe.
|
|
|
+ * Specify zero for non high speed devices. This
|
|
|
+ * value comes from the standard endpoint descriptor
|
|
|
+ * field wMaxPacketSize bits <12:11>.
|
|
|
+ * @param hub_device_addr
|
|
|
+ * Hub device address this device is connected
|
|
|
+ * to. Devices connected directly to Octeon
|
|
|
+ * use zero. This is only used when the device
|
|
|
+ * is full/low speed behind a high speed hub.
|
|
|
+ * The address will be of the high speed hub,
|
|
|
+ * not and full speed hubs after it.
|
|
|
+ * @param hub_port Which port on the hub the device is
|
|
|
+ * connected. Use zero for devices connected
|
|
|
+ * directly to Octeon. Like hub_device_addr,
|
|
|
+ * this is only used for full/low speed
|
|
|
+ * devices behind a high speed hub.
|
|
|
+ *
|
|
|
+ * @return A non negative value is a pipe handle. Negative
|
|
|
+ * values are failure codes from cvmx_usb_status_t.
|
|
|
+ */
|
|
|
+int cvmx_usb_open_pipe(cvmx_usb_state_t *state, cvmx_usb_pipe_flags_t flags,
|
|
|
+ int device_addr, int endpoint_num,
|
|
|
+ cvmx_usb_speed_t device_speed, int max_packet,
|
|
|
+ cvmx_usb_transfer_t transfer_type,
|
|
|
+ cvmx_usb_direction_t transfer_dir, int interval,
|
|
|
+ int multi_count, int hub_device_addr, int hub_port)
|
|
|
+{
|
|
|
+ cvmx_usb_pipe_t *pipe;
|
|
|
+ cvmx_usb_internal_state_t *usb = (cvmx_usb_internal_state_t*)state;
|
|
|
+
|
|
|
+ CVMX_USB_LOG_CALLED();
|
|
|
+ CVMX_USB_LOG_PARAM("%p", state);
|
|
|
+ CVMX_USB_LOG_PARAM("0x%x", flags);
|
|
|
+ CVMX_USB_LOG_PARAM("%d", device_addr);
|
|
|
+ CVMX_USB_LOG_PARAM("%d", endpoint_num);
|
|
|
+ CVMX_USB_LOG_PARAM("%d", device_speed);
|
|
|
+ CVMX_USB_LOG_PARAM("%d", max_packet);
|
|
|
+ CVMX_USB_LOG_PARAM("%d", transfer_type);
|
|
|
+ CVMX_USB_LOG_PARAM("%d", transfer_dir);
|
|
|
+ CVMX_USB_LOG_PARAM("%d", interval);
|
|
|
+ CVMX_USB_LOG_PARAM("%d", multi_count);
|
|
|
+ CVMX_USB_LOG_PARAM("%d", hub_device_addr);
|
|
|
+ CVMX_USB_LOG_PARAM("%d", hub_port);
|
|
|
+
|
|
|
+ if (cvmx_unlikely((device_addr < 0) || (device_addr > MAX_USB_ADDRESS)))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+ if (cvmx_unlikely((endpoint_num < 0) || (endpoint_num > MAX_USB_ENDPOINT)))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+ if (cvmx_unlikely(device_speed > CVMX_USB_SPEED_LOW))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+ if (cvmx_unlikely((max_packet <= 0) || (max_packet > 1024)))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+ if (cvmx_unlikely(transfer_type > CVMX_USB_TRANSFER_INTERRUPT))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+ if (cvmx_unlikely((transfer_dir != CVMX_USB_DIRECTION_OUT) &&
|
|
|
+ (transfer_dir != CVMX_USB_DIRECTION_IN)))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+ if (cvmx_unlikely(interval < 0))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+ if (cvmx_unlikely((transfer_type == CVMX_USB_TRANSFER_CONTROL) && interval))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+ if (cvmx_unlikely(multi_count < 0))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+ if (cvmx_unlikely((device_speed != CVMX_USB_SPEED_HIGH) &&
|
|
|
+ (multi_count != 0)))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+ if (cvmx_unlikely((hub_device_addr < 0) || (hub_device_addr > MAX_USB_ADDRESS)))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+ if (cvmx_unlikely((hub_port < 0) || (hub_port > MAX_USB_HUB_PORT)))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+
|
|
|
+ /* Find a free pipe */
|
|
|
+ pipe = usb->free_pipes.head;
|
|
|
+ if (!pipe)
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_NO_MEMORY);
|
|
|
+ __cvmx_usb_remove_pipe(&usb->free_pipes, pipe);
|
|
|
+ pipe->flags = flags | __CVMX_USB_PIPE_FLAGS_OPEN;
|
|
|
+ if ((device_speed == CVMX_USB_SPEED_HIGH) &&
|
|
|
+ (transfer_dir == CVMX_USB_DIRECTION_OUT) &&
|
|
|
+ (transfer_type == CVMX_USB_TRANSFER_BULK))
|
|
|
+ pipe->flags |= __CVMX_USB_PIPE_FLAGS_NEED_PING;
|
|
|
+ pipe->device_addr = device_addr;
|
|
|
+ pipe->endpoint_num = endpoint_num;
|
|
|
+ pipe->device_speed = device_speed;
|
|
|
+ pipe->max_packet = max_packet;
|
|
|
+ pipe->transfer_type = transfer_type;
|
|
|
+ pipe->transfer_dir = transfer_dir;
|
|
|
+ /* All pipes use interval to rate limit NAK processing. Force an interval
|
|
|
+ if one wasn't supplied */
|
|
|
+ if (!interval)
|
|
|
+ interval = 1;
|
|
|
+ if (__cvmx_usb_pipe_needs_split(usb, pipe))
|
|
|
+ {
|
|
|
+ pipe->interval = interval*8;
|
|
|
+ /* Force start splits to be schedule on uFrame 0 */
|
|
|
+ pipe->next_tx_frame = ((usb->frame_number+7)&~7) + pipe->interval;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ pipe->interval = interval;
|
|
|
+ pipe->next_tx_frame = usb->frame_number + pipe->interval;
|
|
|
+ }
|
|
|
+ pipe->multi_count = multi_count;
|
|
|
+ pipe->hub_device_addr = hub_device_addr;
|
|
|
+ pipe->hub_port = hub_port;
|
|
|
+ pipe->pid_toggle = 0;
|
|
|
+ pipe->split_sc_frame = -1;
|
|
|
+ __cvmx_usb_append_pipe(&usb->idle_pipes, pipe);
|
|
|
+
|
|
|
+ /* We don't need to tell the hardware about this pipe yet since
|
|
|
+ it doesn't have any submitted requests */
|
|
|
+
|
|
|
+ CVMX_USB_RETURN(__cvmx_usb_get_pipe_handle(usb, pipe));
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * @INTERNAL
|
|
|
+ * Poll the RX FIFOs and remove data as needed. This function is only used
|
|
|
+ * in non DMA mode. It is very important that this function be called quickly
|
|
|
+ * enough to prevent FIFO overflow.
|
|
|
+ *
|
|
|
+ * @param usb USB device state populated by
|
|
|
+ * cvmx_usb_initialize().
|
|
|
+ */
|
|
|
+static void __cvmx_usb_poll_rx_fifo(cvmx_usb_internal_state_t *usb)
|
|
|
+{
|
|
|
+ cvmx_usbcx_grxstsph_t rx_status;
|
|
|
+ int channel;
|
|
|
+ int bytes;
|
|
|
+ uint64_t address;
|
|
|
+ uint32_t *ptr;
|
|
|
+
|
|
|
+ CVMX_USB_LOG_CALLED();
|
|
|
+ CVMX_USB_LOG_PARAM("%p", usb);
|
|
|
+
|
|
|
+ rx_status.u32 = __cvmx_usb_read_csr32(usb, CVMX_USBCX_GRXSTSPH(usb->index));
|
|
|
+ /* Only read data if IN data is there */
|
|
|
+ if (rx_status.s.pktsts != 2)
|
|
|
+ CVMX_USB_RETURN_NOTHING();
|
|
|
+ /* Check if no data is available */
|
|
|
+ if (!rx_status.s.bcnt)
|
|
|
+ CVMX_USB_RETURN_NOTHING();
|
|
|
+
|
|
|
+ channel = rx_status.s.chnum;
|
|
|
+ bytes = rx_status.s.bcnt;
|
|
|
+ if (!bytes)
|
|
|
+ CVMX_USB_RETURN_NOTHING();
|
|
|
+
|
|
|
+ /* Get where the DMA engine would have written this data */
|
|
|
+ address = __cvmx_usb_read_csr64(usb, CVMX_USBNX_DMA0_INB_CHN0(usb->index) + channel*8);
|
|
|
+ ptr = cvmx_phys_to_ptr(address);
|
|
|
+ __cvmx_usb_write_csr64(usb, CVMX_USBNX_DMA0_INB_CHN0(usb->index) + channel*8, address + bytes);
|
|
|
+
|
|
|
+ /* Loop writing the FIFO data for this packet into memory */
|
|
|
+ while (bytes > 0)
|
|
|
+ {
|
|
|
+ *ptr++ = __cvmx_usb_read_csr32(usb, USB_FIFO_ADDRESS(channel, usb->index));
|
|
|
+ bytes -= 4;
|
|
|
+ }
|
|
|
+ CVMX_SYNCW;
|
|
|
+
|
|
|
+ CVMX_USB_RETURN_NOTHING();
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * Fill the TX hardware fifo with data out of the software
|
|
|
+ * fifos
|
|
|
+ *
|
|
|
+ * @param usb USB device state populated by
|
|
|
+ * cvmx_usb_initialize().
|
|
|
+ * @param fifo Software fifo to use
|
|
|
+ * @param available Amount of space in the hardware fifo
|
|
|
+ *
|
|
|
+ * @return Non zero if the hardware fifo was too small and needs
|
|
|
+ * to be serviced again.
|
|
|
+ */
|
|
|
+static int __cvmx_usb_fill_tx_hw(cvmx_usb_internal_state_t *usb, cvmx_usb_tx_fifo_t *fifo, int available)
|
|
|
+{
|
|
|
+ CVMX_USB_LOG_CALLED();
|
|
|
+ CVMX_USB_LOG_PARAM("%p", usb);
|
|
|
+ CVMX_USB_LOG_PARAM("%p", fifo);
|
|
|
+ CVMX_USB_LOG_PARAM("%d", available);
|
|
|
+
|
|
|
+ /* We're done either when there isn't anymore space or the software FIFO
|
|
|
+ is empty */
|
|
|
+ while (available && (fifo->head != fifo->tail))
|
|
|
+ {
|
|
|
+ int i = fifo->tail;
|
|
|
+ const uint32_t *ptr = cvmx_phys_to_ptr(fifo->entry[i].address);
|
|
|
+ uint64_t csr_address = USB_FIFO_ADDRESS(fifo->entry[i].channel, usb->index) ^ 4;
|
|
|
+ int words = available;
|
|
|
+
|
|
|
+ /* Limit the amount of data to waht the SW fifo has */
|
|
|
+ if (fifo->entry[i].size <= available)
|
|
|
+ {
|
|
|
+ words = fifo->entry[i].size;
|
|
|
+ fifo->tail++;
|
|
|
+ if (fifo->tail > MAX_CHANNELS)
|
|
|
+ fifo->tail = 0;
|
|
|
+ }
|
|
|
+
|
|
|
+ /* Update the next locations and counts */
|
|
|
+ available -= words;
|
|
|
+ fifo->entry[i].address += words * 4;
|
|
|
+ fifo->entry[i].size -= words;
|
|
|
+
|
|
|
+ /* Write the HW fifo data. The read every three writes is due
|
|
|
+ to an errata on CN3XXX chips */
|
|
|
+ while (words > 3)
|
|
|
+ {
|
|
|
+ cvmx_write64_uint32(csr_address, *ptr++);
|
|
|
+ cvmx_write64_uint32(csr_address, *ptr++);
|
|
|
+ cvmx_write64_uint32(csr_address, *ptr++);
|
|
|
+ cvmx_read64_uint64(CVMX_USBNX_DMA0_INB_CHN0(usb->index));
|
|
|
+ words -= 3;
|
|
|
+ }
|
|
|
+ cvmx_write64_uint32(csr_address, *ptr++);
|
|
|
+ if (--words)
|
|
|
+ {
|
|
|
+ cvmx_write64_uint32(csr_address, *ptr++);
|
|
|
+ if (--words)
|
|
|
+ cvmx_write64_uint32(csr_address, *ptr++);
|
|
|
+ }
|
|
|
+ cvmx_read64_uint64(CVMX_USBNX_DMA0_INB_CHN0(usb->index));
|
|
|
+ }
|
|
|
+ CVMX_USB_RETURN(fifo->head != fifo->tail);
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * Check the hardware FIFOs and fill them as needed
|
|
|
+ *
|
|
|
+ * @param usb USB device state populated by
|
|
|
+ * cvmx_usb_initialize().
|
|
|
+ */
|
|
|
+static void __cvmx_usb_poll_tx_fifo(cvmx_usb_internal_state_t *usb)
|
|
|
+{
|
|
|
+ CVMX_USB_LOG_CALLED();
|
|
|
+ CVMX_USB_LOG_PARAM("%p", usb);
|
|
|
+
|
|
|
+ if (usb->periodic.head != usb->periodic.tail)
|
|
|
+ {
|
|
|
+ cvmx_usbcx_hptxsts_t tx_status;
|
|
|
+ tx_status.u32 = __cvmx_usb_read_csr32(usb, CVMX_USBCX_HPTXSTS(usb->index));
|
|
|
+ if (__cvmx_usb_fill_tx_hw(usb, &usb->periodic, tx_status.s.ptxfspcavail))
|
|
|
+ USB_SET_FIELD32(CVMX_USBCX_GINTMSK(usb->index), cvmx_usbcx_gintmsk_t, ptxfempmsk, 1);
|
|
|
+ else
|
|
|
+ USB_SET_FIELD32(CVMX_USBCX_GINTMSK(usb->index), cvmx_usbcx_gintmsk_t, ptxfempmsk, 0);
|
|
|
+ }
|
|
|
+
|
|
|
+ if (usb->nonperiodic.head != usb->nonperiodic.tail)
|
|
|
+ {
|
|
|
+ cvmx_usbcx_gnptxsts_t tx_status;
|
|
|
+ tx_status.u32 = __cvmx_usb_read_csr32(usb, CVMX_USBCX_GNPTXSTS(usb->index));
|
|
|
+ if (__cvmx_usb_fill_tx_hw(usb, &usb->nonperiodic, tx_status.s.nptxfspcavail))
|
|
|
+ USB_SET_FIELD32(CVMX_USBCX_GINTMSK(usb->index), cvmx_usbcx_gintmsk_t, nptxfempmsk, 1);
|
|
|
+ else
|
|
|
+ USB_SET_FIELD32(CVMX_USBCX_GINTMSK(usb->index), cvmx_usbcx_gintmsk_t, nptxfempmsk, 0);
|
|
|
+ }
|
|
|
+
|
|
|
+ CVMX_USB_RETURN_NOTHING();
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * @INTERNAL
|
|
|
+ * Fill the TX FIFO with an outgoing packet
|
|
|
+ *
|
|
|
+ * @param usb USB device state populated by
|
|
|
+ * cvmx_usb_initialize().
|
|
|
+ * @param channel Channel number to get packet from
|
|
|
+ */
|
|
|
+static void __cvmx_usb_fill_tx_fifo(cvmx_usb_internal_state_t *usb, int channel)
|
|
|
+{
|
|
|
+ cvmx_usbcx_hccharx_t hcchar;
|
|
|
+ cvmx_usbcx_hcspltx_t usbc_hcsplt;
|
|
|
+ cvmx_usbcx_hctsizx_t usbc_hctsiz;
|
|
|
+ cvmx_usb_tx_fifo_t *fifo;
|
|
|
+
|
|
|
+ CVMX_USB_LOG_CALLED();
|
|
|
+ CVMX_USB_LOG_PARAM("%p", usb);
|
|
|
+ CVMX_USB_LOG_PARAM("%d", channel);
|
|
|
+
|
|
|
+ /* We only need to fill data on outbound channels */
|
|
|
+ hcchar.u32 = __cvmx_usb_read_csr32(usb, CVMX_USBCX_HCCHARX(channel, usb->index));
|
|
|
+ if (hcchar.s.epdir != CVMX_USB_DIRECTION_OUT)
|
|
|
+ CVMX_USB_RETURN_NOTHING();
|
|
|
+
|
|
|
+ /* OUT Splits only have data on the start and not the complete */
|
|
|
+ usbc_hcsplt.u32 = __cvmx_usb_read_csr32(usb, CVMX_USBCX_HCSPLTX(channel, usb->index));
|
|
|
+ if (usbc_hcsplt.s.spltena && usbc_hcsplt.s.compsplt)
|
|
|
+ CVMX_USB_RETURN_NOTHING();
|
|
|
+
|
|
|
+ /* Find out how many bytes we need to fill and convert it into 32bit words */
|
|
|
+ usbc_hctsiz.u32 = __cvmx_usb_read_csr32(usb, CVMX_USBCX_HCTSIZX(channel, usb->index));
|
|
|
+ if (!usbc_hctsiz.s.xfersize)
|
|
|
+ CVMX_USB_RETURN_NOTHING();
|
|
|
+
|
|
|
+ if ((hcchar.s.eptype == CVMX_USB_TRANSFER_INTERRUPT) ||
|
|
|
+ (hcchar.s.eptype == CVMX_USB_TRANSFER_ISOCHRONOUS))
|
|
|
+ fifo = &usb->periodic;
|
|
|
+ else
|
|
|
+ fifo = &usb->nonperiodic;
|
|
|
+
|
|
|
+ fifo->entry[fifo->head].channel = channel;
|
|
|
+ fifo->entry[fifo->head].address = __cvmx_usb_read_csr64(usb, CVMX_USBNX_DMA0_OUTB_CHN0(usb->index) + channel*8);
|
|
|
+ fifo->entry[fifo->head].size = (usbc_hctsiz.s.xfersize+3)>>2;
|
|
|
+ fifo->head++;
|
|
|
+ if (fifo->head > MAX_CHANNELS)
|
|
|
+ fifo->head = 0;
|
|
|
+
|
|
|
+ __cvmx_usb_poll_tx_fifo(usb);
|
|
|
+
|
|
|
+ CVMX_USB_RETURN_NOTHING();
|
|
|
+}
|
|
|
+
|
|
|
+/**
|
|
|
+ * @INTERNAL
|
|
|
+ * Perform channel specific setup for Control transactions. All
|
|
|
+ * the generic stuff will already have been done in
|
|
|
+ * __cvmx_usb_start_channel()
|
|
|
+ *
|
|
|
+ * @param usb USB device state populated by
|
|
|
+ * cvmx_usb_initialize().
|
|
|
+ * @param channel Channel to setup
|
|
|
+ * @param pipe Pipe for control transaction
|
|
|
+ */
|
|
|
+static void __cvmx_usb_start_channel_control(cvmx_usb_internal_state_t *usb,
|
|
|
+ int channel,
|
|
|
+ cvmx_usb_pipe_t *pipe)
|
|
|
+{
|
|
|
+ cvmx_usb_transaction_t *transaction = pipe->head;
|
|
|
+ cvmx_usb_control_header_t *header = cvmx_phys_to_ptr(transaction->control_header);
|
|
|
+ int bytes_to_transfer = transaction->buffer_length - transaction->actual_bytes;
|
|
|
+ int packets_to_transfer;
|
|
|
+ cvmx_usbcx_hctsizx_t usbc_hctsiz;
|
|
|
+
|
|
|
+ CVMX_USB_LOG_CALLED();
|
|
|
+ CVMX_USB_LOG_PARAM("%p", usb);
|
|
|
+ CVMX_USB_LOG_PARAM("%d", channel);
|
|
|
+ CVMX_USB_LOG_PARAM("%p", pipe);
|
|
|
+
|
|
|
+ usbc_hctsiz.u32 = __cvmx_usb_read_csr32(usb, CVMX_USBCX_HCTSIZX(channel, usb->index));
|
|
|
+
|
|
|
+ switch (transaction->stage)
|
|
|
+ {
|
|
|
+ case CVMX_USB_STAGE_NON_CONTROL:
|
|
|
+ case CVMX_USB_STAGE_NON_CONTROL_SPLIT_COMPLETE:
|
|
|
+ cvmx_dprintf("%s: ERROR - Non control stage\n", __FUNCTION__);
|
|
|
+ break;
|
|
|
+ case CVMX_USB_STAGE_SETUP:
|
|
|
+ usbc_hctsiz.s.pid = 3; /* Setup */
|
|
|
+ bytes_to_transfer = sizeof(*header);
|
|
|
+ /* All Control operations start with a setup going OUT */
|
|
|
+ USB_SET_FIELD32(CVMX_USBCX_HCCHARX(channel, usb->index), cvmx_usbcx_hccharx_t, epdir, CVMX_USB_DIRECTION_OUT);
|
|
|
+ /* Setup send the control header instead of the buffer data. The
|
|
|
+ buffer data will be used in the next stage */
|
|
|
+ __cvmx_usb_write_csr64(usb, CVMX_USBNX_DMA0_OUTB_CHN0(usb->index) + channel*8, transaction->control_header);
|
|
|
+ break;
|
|
|
+ case CVMX_USB_STAGE_SETUP_SPLIT_COMPLETE:
|
|
|
+ usbc_hctsiz.s.pid = 3; /* Setup */
|
|
|
+ bytes_to_transfer = 0;
|
|
|
+ /* All Control operations start with a setup going OUT */
|
|
|
+ USB_SET_FIELD32(CVMX_USBCX_HCCHARX(channel, usb->index), cvmx_usbcx_hccharx_t, epdir, CVMX_USB_DIRECTION_OUT);
|
|
|
+ USB_SET_FIELD32(CVMX_USBCX_HCSPLTX(channel, usb->index), cvmx_usbcx_hcspltx_t, compsplt, 1);
|
|
|
+ break;
|
|
|
+ case CVMX_USB_STAGE_DATA:
|
|
|
+ usbc_hctsiz.s.pid = __cvmx_usb_get_data_pid(pipe);
|
|
|
+ if (__cvmx_usb_pipe_needs_split(usb, pipe))
|
|
|
+ {
|
|
|
+ if (header->s.request_type & 0x80)
|
|
|
+ bytes_to_transfer = 0;
|
|
|
+ else if (bytes_to_transfer > pipe->max_packet)
|
|
|
+ bytes_to_transfer = pipe->max_packet;
|
|
|
+ }
|
|
|
+ USB_SET_FIELD32(CVMX_USBCX_HCCHARX(channel, usb->index),
|
|
|
+ cvmx_usbcx_hccharx_t, epdir,
|
|
|
+ ((header->s.request_type & 0x80) ?
|
|
|
+ CVMX_USB_DIRECTION_IN :
|
|
|
+ CVMX_USB_DIRECTION_OUT));
|
|
|
+ break;
|
|
|
+ case CVMX_USB_STAGE_DATA_SPLIT_COMPLETE:
|
|
|
+ usbc_hctsiz.s.pid = __cvmx_usb_get_data_pid(pipe);
|
|
|
+ if (!(header->s.request_type & 0x80))
|
|
|
+ bytes_to_transfer = 0;
|
|
|
+ USB_SET_FIELD32(CVMX_USBCX_HCCHARX(channel, usb->index),
|
|
|
+ cvmx_usbcx_hccharx_t, epdir,
|
|
|
+ ((header->s.request_type & 0x80) ?
|
|
|
+ CVMX_USB_DIRECTION_IN :
|
|
|
+ CVMX_USB_DIRECTION_OUT));
|
|
|
+ USB_SET_FIELD32(CVMX_USBCX_HCSPLTX(channel, usb->index), cvmx_usbcx_hcspltx_t, compsplt, 1);
|
|
|
+ break;
|
|
|
+ case CVMX_USB_STAGE_STATUS:
|
|
|
+ usbc_hctsiz.s.pid = __cvmx_usb_get_data_pid(pipe);
|
|
|
+ bytes_to_transfer = 0;
|
|
|
+ USB_SET_FIELD32(CVMX_USBCX_HCCHARX(channel, usb->index), cvmx_usbcx_hccharx_t, epdir,
|
|
|
+ ((header->s.request_type & 0x80) ?
|
|
|
+ CVMX_USB_DIRECTION_OUT :
|
|
|
+ CVMX_USB_DIRECTION_IN));
|
|
|
+ break;
|
|
|
+ case CVMX_USB_STAGE_STATUS_SPLIT_COMPLETE:
|
|
|
+ usbc_hctsiz.s.pid = __cvmx_usb_get_data_pid(pipe);
|
|
|
+ bytes_to_transfer = 0;
|
|
|
+ USB_SET_FIELD32(CVMX_USBCX_HCCHARX(channel, usb->index), cvmx_usbcx_hccharx_t, epdir,
|
|
|
+ ((header->s.request_type & 0x80) ?
|
|
|
+ CVMX_USB_DIRECTION_OUT :
|
|
|
+ CVMX_USB_DIRECTION_IN));
|
|
|
+ USB_SET_FIELD32(CVMX_USBCX_HCSPLTX(channel, usb->index), cvmx_usbcx_hcspltx_t, compsplt, 1);
|
|
|
+ break;
|
|
|
+ }
|
|
|
+
|
|
|
+ /* Make sure the transfer never exceeds the byte limit of the hardware.
|
|
|
+ Further bytes will be sent as continued transactions */
|
|
|
+ if (bytes_to_transfer > MAX_TRANSFER_BYTES)
|
|
|
+ {
|
|
|
+ /* Round MAX_TRANSFER_BYTES to a multiple of out packet size */
|
|
|
+ bytes_to_transfer = MAX_TRANSFER_BYTES / pipe->max_packet;
|
|
|
+ bytes_to_transfer *= pipe->max_packet;
|
|
|
+ }
|
|
|
+
|
|
|
+ /* Calculate the number of packets to transfer. If the length is zero
|
|
|
+ we still need to transfer one packet */
|
|
|
+ packets_to_transfer = (bytes_to_transfer + pipe->max_packet - 1) / pipe->max_packet;
|
|
|
+ if (packets_to_transfer == 0)
|
|
|
+ packets_to_transfer = 1;
|
|
|
+ else if ((packets_to_transfer>1) && (usb->init_flags & CVMX_USB_INITIALIZE_FLAGS_NO_DMA))
|
|
|
+ {
|
|
|
+ /* Limit to one packet when not using DMA. Channels must be restarted
|
|
|
+ between every packet for IN transactions, so there is no reason to
|
|
|
+ do multiple packets in a row */
|
|
|
+ packets_to_transfer = 1;
|
|
|
+ bytes_to_transfer = packets_to_transfer * pipe->max_packet;
|
|
|
+ }
|
|
|
+ else if (packets_to_transfer > MAX_TRANSFER_PACKETS)
|
|
|
+ {
|
|
|
+ /* Limit the number of packet and data transferred to what the
|
|
|
+ hardware can handle */
|
|
|
+ packets_to_transfer = MAX_TRANSFER_PACKETS;
|
|
|
+ bytes_to_transfer = packets_to_transfer * pipe->max_packet;
|
|
|
+ }
|
|
|
+
|
|
|
+ usbc_hctsiz.s.xfersize = bytes_to_transfer;
|
|
|
+ usbc_hctsiz.s.pktcnt = packets_to_transfer;
|
|
|
+
|
|
|
+ __cvmx_usb_write_csr32(usb, CVMX_USBCX_HCTSIZX(channel, usb->index), usbc_hctsiz.u32);
|
|
|
+ CVMX_USB_RETURN_NOTHING();
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * @INTERNAL
|
|
|
+ * Start a channel to perform the pipe's head transaction
|
|
|
+ *
|
|
|
+ * @param usb USB device state populated by
|
|
|
+ * cvmx_usb_initialize().
|
|
|
+ * @param channel Channel to setup
|
|
|
+ * @param pipe Pipe to start
|
|
|
+ */
|
|
|
+static void __cvmx_usb_start_channel(cvmx_usb_internal_state_t *usb,
|
|
|
+ int channel,
|
|
|
+ cvmx_usb_pipe_t *pipe)
|
|
|
+{
|
|
|
+ cvmx_usb_transaction_t *transaction = pipe->head;
|
|
|
+
|
|
|
+ CVMX_USB_LOG_CALLED();
|
|
|
+ CVMX_USB_LOG_PARAM("%p", usb);
|
|
|
+ CVMX_USB_LOG_PARAM("%d", channel);
|
|
|
+ CVMX_USB_LOG_PARAM("%p", pipe);
|
|
|
+
|
|
|
+ if (cvmx_unlikely((usb->init_flags & CVMX_USB_INITIALIZE_FLAGS_DEBUG_TRANSFERS) ||
|
|
|
+ (pipe->flags & CVMX_USB_PIPE_FLAGS_DEBUG_TRANSFERS)))
|
|
|
+ cvmx_dprintf("%s: Channel %d started. Pipe %d transaction %d stage %d\n",
|
|
|
+ __FUNCTION__, channel, __cvmx_usb_get_pipe_handle(usb, pipe),
|
|
|
+ __cvmx_usb_get_submit_handle(usb, transaction),
|
|
|
+ transaction->stage);
|
|
|
+
|
|
|
+ /* Make sure all writes to the DMA region get flushed */
|
|
|
+ CVMX_SYNCW;
|
|
|
+
|
|
|
+ /* Attach the channel to the pipe */
|
|
|
+ usb->pipe_for_channel[channel] = pipe;
|
|
|
+ pipe->channel = channel;
|
|
|
+ pipe->flags |= __CVMX_USB_PIPE_FLAGS_SCHEDULED;
|
|
|
+
|
|
|
+ /* Mark this channel as in use */
|
|
|
+ usb->idle_hardware_channels &= ~(1<<channel);
|
|
|
+
|
|
|
+ /* Enable the channel interrupt bits */
|
|
|
+ {
|
|
|
+ cvmx_usbcx_hcintx_t usbc_hcint;
|
|
|
+ cvmx_usbcx_hcintmskx_t usbc_hcintmsk;
|
|
|
+ cvmx_usbcx_haintmsk_t usbc_haintmsk;
|
|
|
+
|
|
|
+ /* Clear all channel status bits */
|
|
|
+ usbc_hcint.u32 = __cvmx_usb_read_csr32(usb, CVMX_USBCX_HCINTX(channel, usb->index));
|
|
|
+ __cvmx_usb_write_csr32(usb, CVMX_USBCX_HCINTX(channel, usb->index), usbc_hcint.u32);
|
|
|
+
|
|
|
+ usbc_hcintmsk.u32 = 0;
|
|
|
+ usbc_hcintmsk.s.chhltdmsk = 1;
|
|
|
+ if (usb->init_flags & CVMX_USB_INITIALIZE_FLAGS_NO_DMA)
|
|
|
+ {
|
|
|
+ /* Channels need these extra interrupts when we aren't in DMA mode */
|
|
|
+ usbc_hcintmsk.s.datatglerrmsk = 1;
|
|
|
+ usbc_hcintmsk.s.frmovrunmsk = 1;
|
|
|
+ usbc_hcintmsk.s.bblerrmsk = 1;
|
|
|
+ usbc_hcintmsk.s.xacterrmsk = 1;
|
|
|
+ if (__cvmx_usb_pipe_needs_split(usb, pipe))
|
|
|
+ {
|
|
|
+ /* Splits don't generate xfercompl, so we need ACK and NYET */
|
|
|
+ usbc_hcintmsk.s.nyetmsk = 1;
|
|
|
+ usbc_hcintmsk.s.ackmsk = 1;
|
|
|
+ }
|
|
|
+ usbc_hcintmsk.s.nakmsk = 1;
|
|
|
+ usbc_hcintmsk.s.stallmsk = 1;
|
|
|
+ usbc_hcintmsk.s.xfercomplmsk = 1;
|
|
|
+ }
|
|
|
+ __cvmx_usb_write_csr32(usb, CVMX_USBCX_HCINTMSKX(channel, usb->index), usbc_hcintmsk.u32);
|
|
|
+
|
|
|
+ /* Enable the channel interrupt to propagate */
|
|
|
+ usbc_haintmsk.u32 = __cvmx_usb_read_csr32(usb, CVMX_USBCX_HAINTMSK(usb->index));
|
|
|
+ usbc_haintmsk.s.haintmsk |= 1<<channel;
|
|
|
+ __cvmx_usb_write_csr32(usb, CVMX_USBCX_HAINTMSK(usb->index), usbc_haintmsk.u32);
|
|
|
+ }
|
|
|
+
|
|
|
+ /* Setup the locations the DMA engines use */
|
|
|
+ {
|
|
|
+ uint64_t dma_address = transaction->buffer + transaction->actual_bytes;
|
|
|
+ if (transaction->type == CVMX_USB_TRANSFER_ISOCHRONOUS)
|
|
|
+ dma_address = transaction->buffer + transaction->iso_packets[0].offset + transaction->actual_bytes;
|
|
|
+ __cvmx_usb_write_csr64(usb, CVMX_USBNX_DMA0_OUTB_CHN0(usb->index) + channel*8, dma_address);
|
|
|
+ __cvmx_usb_write_csr64(usb, CVMX_USBNX_DMA0_INB_CHN0(usb->index) + channel*8, dma_address);
|
|
|
+ }
|
|
|
+
|
|
|
+ /* Setup both the size of the transfer and the SPLIT characteristics */
|
|
|
+ {
|
|
|
+ cvmx_usbcx_hcspltx_t usbc_hcsplt = {.u32 = 0};
|
|
|
+ cvmx_usbcx_hctsizx_t usbc_hctsiz = {.u32 = 0};
|
|
|
+ int packets_to_transfer;
|
|
|
+ int bytes_to_transfer = transaction->buffer_length - transaction->actual_bytes;
|
|
|
+
|
|
|
+ /* ISOCHRONOUS transactions store each individual transfer size in the
|
|
|
+ packet structure, not the global buffer_length */
|
|
|
+ if (transaction->type == CVMX_USB_TRANSFER_ISOCHRONOUS)
|
|
|
+ bytes_to_transfer = transaction->iso_packets[0].length - transaction->actual_bytes;
|
|
|
+
|
|
|
+ /* We need to do split transactions when we are talking to non high
|
|
|
+ speed devices that are behind a high speed hub */
|
|
|
+ if (__cvmx_usb_pipe_needs_split(usb, pipe))
|
|
|
+ {
|
|
|
+ /* On the start split phase (stage is even) record the frame number we
|
|
|
+ will need to send the split complete. We only store the lower two bits
|
|
|
+ since the time ahead can only be two frames */
|
|
|
+ if ((transaction->stage&1) == 0)
|
|
|
+ {
|
|
|
+ if (transaction->type == CVMX_USB_TRANSFER_BULK)
|
|
|
+ pipe->split_sc_frame = (usb->frame_number + 1) & 0x7f;
|
|
|
+ else
|
|
|
+ pipe->split_sc_frame = (usb->frame_number + 2) & 0x7f;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ pipe->split_sc_frame = -1;
|
|
|
+
|
|
|
+ usbc_hcsplt.s.spltena = 1;
|
|
|
+ usbc_hcsplt.s.hubaddr = pipe->hub_device_addr;
|
|
|
+ usbc_hcsplt.s.prtaddr = pipe->hub_port;
|
|
|
+ usbc_hcsplt.s.compsplt = (transaction->stage == CVMX_USB_STAGE_NON_CONTROL_SPLIT_COMPLETE);
|
|
|
+
|
|
|
+ /* SPLIT transactions can only ever transmit one data packet so
|
|
|
+ limit the transfer size to the max packet size */
|
|
|
+ if (bytes_to_transfer > pipe->max_packet)
|
|
|
+ bytes_to_transfer = pipe->max_packet;
|
|
|
+
|
|
|
+ /* ISOCHRONOUS OUT splits are unique in that they limit
|
|
|
+ data transfers to 188 byte chunks representing the
|
|
|
+ begin/middle/end of the data or all */
|
|
|
+ if (!usbc_hcsplt.s.compsplt &&
|
|
|
+ (pipe->transfer_dir == CVMX_USB_DIRECTION_OUT) &&
|
|
|
+ (pipe->transfer_type == CVMX_USB_TRANSFER_ISOCHRONOUS))
|
|
|
+ {
|
|
|
+ /* Clear the split complete frame number as there isn't going
|
|
|
+ to be a split complete */
|
|
|
+ pipe->split_sc_frame = -1;
|
|
|
+ /* See if we've started this transfer and sent data */
|
|
|
+ if (transaction->actual_bytes == 0)
|
|
|
+ {
|
|
|
+ /* Nothing sent yet, this is either a begin or the
|
|
|
+ entire payload */
|
|
|
+ if (bytes_to_transfer <= 188)
|
|
|
+ usbc_hcsplt.s.xactpos = 3; /* Entire payload in one go */
|
|
|
+ else
|
|
|
+ usbc_hcsplt.s.xactpos = 2; /* First part of payload */
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ /* Continuing the previous data, we must either be
|
|
|
+ in the middle or at the end */
|
|
|
+ if (bytes_to_transfer <= 188)
|
|
|
+ usbc_hcsplt.s.xactpos = 1; /* End of payload */
|
|
|
+ else
|
|
|
+ usbc_hcsplt.s.xactpos = 0; /* Middle of payload */
|
|
|
+ }
|
|
|
+ /* Again, the transfer size is limited to 188 bytes */
|
|
|
+ if (bytes_to_transfer > 188)
|
|
|
+ bytes_to_transfer = 188;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ /* Make sure the transfer never exceeds the byte limit of the hardware.
|
|
|
+ Further bytes will be sent as continued transactions */
|
|
|
+ if (bytes_to_transfer > MAX_TRANSFER_BYTES)
|
|
|
+ {
|
|
|
+ /* Round MAX_TRANSFER_BYTES to a multiple of out packet size */
|
|
|
+ bytes_to_transfer = MAX_TRANSFER_BYTES / pipe->max_packet;
|
|
|
+ bytes_to_transfer *= pipe->max_packet;
|
|
|
+ }
|
|
|
+
|
|
|
+ /* Calculate the number of packets to transfer. If the length is zero
|
|
|
+ we still need to transfer one packet */
|
|
|
+ packets_to_transfer = (bytes_to_transfer + pipe->max_packet - 1) / pipe->max_packet;
|
|
|
+ if (packets_to_transfer == 0)
|
|
|
+ packets_to_transfer = 1;
|
|
|
+ else if ((packets_to_transfer>1) && (usb->init_flags & CVMX_USB_INITIALIZE_FLAGS_NO_DMA))
|
|
|
+ {
|
|
|
+ /* Limit to one packet when not using DMA. Channels must be restarted
|
|
|
+ between every packet for IN transactions, so there is no reason to
|
|
|
+ do multiple packets in a row */
|
|
|
+ packets_to_transfer = 1;
|
|
|
+ bytes_to_transfer = packets_to_transfer * pipe->max_packet;
|
|
|
+ }
|
|
|
+ else if (packets_to_transfer > MAX_TRANSFER_PACKETS)
|
|
|
+ {
|
|
|
+ /* Limit the number of packet and data transferred to what the
|
|
|
+ hardware can handle */
|
|
|
+ packets_to_transfer = MAX_TRANSFER_PACKETS;
|
|
|
+ bytes_to_transfer = packets_to_transfer * pipe->max_packet;
|
|
|
+ }
|
|
|
+
|
|
|
+ usbc_hctsiz.s.xfersize = bytes_to_transfer;
|
|
|
+ usbc_hctsiz.s.pktcnt = packets_to_transfer;
|
|
|
+
|
|
|
+ /* Update the DATA0/DATA1 toggle */
|
|
|
+ usbc_hctsiz.s.pid = __cvmx_usb_get_data_pid(pipe);
|
|
|
+ /* High speed pipes may need a hardware ping before they start */
|
|
|
+ if (pipe->flags & __CVMX_USB_PIPE_FLAGS_NEED_PING)
|
|
|
+ usbc_hctsiz.s.dopng = 1;
|
|
|
+
|
|
|
+ __cvmx_usb_write_csr32(usb, CVMX_USBCX_HCSPLTX(channel, usb->index), usbc_hcsplt.u32);
|
|
|
+ __cvmx_usb_write_csr32(usb, CVMX_USBCX_HCTSIZX(channel, usb->index), usbc_hctsiz.u32);
|
|
|
+ }
|
|
|
+
|
|
|
+ /* Setup the Host Channel Characteristics Register */
|
|
|
+ {
|
|
|
+ cvmx_usbcx_hccharx_t usbc_hcchar = {.u32 = 0};
|
|
|
+
|
|
|
+ /* Set the startframe odd/even properly. This is only used for periodic */
|
|
|
+ usbc_hcchar.s.oddfrm = usb->frame_number&1;
|
|
|
+
|
|
|
+ /* Set the number of back to back packets allowed by this endpoint.
|
|
|
+ Split transactions interpret "ec" as the number of immediate
|
|
|
+ retries of failure. These retries happen too quickly, so we
|
|
|
+ disable these entirely for splits */
|
|
|
+ if (__cvmx_usb_pipe_needs_split(usb, pipe))
|
|
|
+ usbc_hcchar.s.ec = 1;
|
|
|
+ else if (pipe->multi_count < 1)
|
|
|
+ usbc_hcchar.s.ec = 1;
|
|
|
+ else if (pipe->multi_count > 3)
|
|
|
+ usbc_hcchar.s.ec = 3;
|
|
|
+ else
|
|
|
+ usbc_hcchar.s.ec = pipe->multi_count;
|
|
|
+
|
|
|
+ /* Set the rest of the endpoint specific settings */
|
|
|
+ usbc_hcchar.s.devaddr = pipe->device_addr;
|
|
|
+ usbc_hcchar.s.eptype = transaction->type;
|
|
|
+ usbc_hcchar.s.lspddev = (pipe->device_speed == CVMX_USB_SPEED_LOW);
|
|
|
+ usbc_hcchar.s.epdir = pipe->transfer_dir;
|
|
|
+ usbc_hcchar.s.epnum = pipe->endpoint_num;
|
|
|
+ usbc_hcchar.s.mps = pipe->max_packet;
|
|
|
+ __cvmx_usb_write_csr32(usb, CVMX_USBCX_HCCHARX(channel, usb->index), usbc_hcchar.u32);
|
|
|
+ }
|
|
|
+
|
|
|
+ /* Do transaction type specific fixups as needed */
|
|
|
+ switch (transaction->type)
|
|
|
+ {
|
|
|
+ case CVMX_USB_TRANSFER_CONTROL:
|
|
|
+ __cvmx_usb_start_channel_control(usb, channel, pipe);
|
|
|
+ break;
|
|
|
+ case CVMX_USB_TRANSFER_BULK:
|
|
|
+ case CVMX_USB_TRANSFER_INTERRUPT:
|
|
|
+ break;
|
|
|
+ case CVMX_USB_TRANSFER_ISOCHRONOUS:
|
|
|
+ if (!__cvmx_usb_pipe_needs_split(usb, pipe))
|
|
|
+ {
|
|
|
+ /* ISO transactions require different PIDs depending on direction
|
|
|
+ and how many packets are needed */
|
|
|
+ if (pipe->transfer_dir == CVMX_USB_DIRECTION_OUT)
|
|
|
+ {
|
|
|
+ if (pipe->multi_count < 2) /* Need DATA0 */
|
|
|
+ USB_SET_FIELD32(CVMX_USBCX_HCTSIZX(channel, usb->index), cvmx_usbcx_hctsizx_t, pid, 0);
|
|
|
+ else /* Need MDATA */
|
|
|
+ USB_SET_FIELD32(CVMX_USBCX_HCTSIZX(channel, usb->index), cvmx_usbcx_hctsizx_t, pid, 3);
|
|
|
+ }
|
|
|
+ }
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ {
|
|
|
+ cvmx_usbcx_hctsizx_t usbc_hctsiz = {.u32 = __cvmx_usb_read_csr32(usb, CVMX_USBCX_HCTSIZX(channel, usb->index))};
|
|
|
+ transaction->xfersize = usbc_hctsiz.s.xfersize;
|
|
|
+ transaction->pktcnt = usbc_hctsiz.s.pktcnt;
|
|
|
+ }
|
|
|
+ /* Remeber when we start a split transaction */
|
|
|
+ if (__cvmx_usb_pipe_needs_split(usb, pipe))
|
|
|
+ usb->active_split = transaction;
|
|
|
+ USB_SET_FIELD32(CVMX_USBCX_HCCHARX(channel, usb->index), cvmx_usbcx_hccharx_t, chena, 1);
|
|
|
+ if (usb->init_flags & CVMX_USB_INITIALIZE_FLAGS_NO_DMA)
|
|
|
+ __cvmx_usb_fill_tx_fifo(usb, channel);
|
|
|
+ CVMX_USB_RETURN_NOTHING();
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * @INTERNAL
|
|
|
+ * Find a pipe that is ready to be scheduled to hardware.
|
|
|
+ * @param usb USB device state populated by
|
|
|
+ * cvmx_usb_initialize().
|
|
|
+ * @param list Pipe list to search
|
|
|
+ * @param current_frame
|
|
|
+ * Frame counter to use as a time reference.
|
|
|
+ *
|
|
|
+ * @return Pipe or NULL if none are ready
|
|
|
+ */
|
|
|
+static cvmx_usb_pipe_t *__cvmx_usb_find_ready_pipe(cvmx_usb_internal_state_t *usb, cvmx_usb_pipe_list_t *list, uint64_t current_frame)
|
|
|
+{
|
|
|
+ cvmx_usb_pipe_t *pipe = list->head;
|
|
|
+ while (pipe)
|
|
|
+ {
|
|
|
+ if (!(pipe->flags & __CVMX_USB_PIPE_FLAGS_SCHEDULED) && pipe->head &&
|
|
|
+ (pipe->next_tx_frame <= current_frame) &&
|
|
|
+ ((pipe->split_sc_frame == -1) || ((((int)current_frame - (int)pipe->split_sc_frame) & 0x7f) < 0x40)) &&
|
|
|
+ (!usb->active_split || (usb->active_split == pipe->head)))
|
|
|
+ {
|
|
|
+ CVMX_PREFETCH(pipe, 128);
|
|
|
+ CVMX_PREFETCH(pipe->head, 0);
|
|
|
+ return pipe;
|
|
|
+ }
|
|
|
+ pipe = pipe->next;
|
|
|
+ }
|
|
|
+ return NULL;
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * @INTERNAL
|
|
|
+ * Called whenever a pipe might need to be scheduled to the
|
|
|
+ * hardware.
|
|
|
+ *
|
|
|
+ * @param usb USB device state populated by
|
|
|
+ * cvmx_usb_initialize().
|
|
|
+ * @param is_sof True if this schedule was called on a SOF interrupt.
|
|
|
+ */
|
|
|
+static void __cvmx_usb_schedule(cvmx_usb_internal_state_t *usb, int is_sof)
|
|
|
+{
|
|
|
+ int channel;
|
|
|
+ cvmx_usb_pipe_t *pipe;
|
|
|
+ int need_sof;
|
|
|
+ cvmx_usb_transfer_t ttype;
|
|
|
+
|
|
|
+ CVMX_USB_LOG_CALLED();
|
|
|
+ CVMX_USB_LOG_PARAM("%p", usb);
|
|
|
+
|
|
|
+ if (usb->init_flags & CVMX_USB_INITIALIZE_FLAGS_NO_DMA)
|
|
|
+ {
|
|
|
+ /* Without DMA we need to be careful to not schedule something at the end of a frame and cause an overrun */
|
|
|
+ cvmx_usbcx_hfnum_t hfnum = {.u32 = __cvmx_usb_read_csr32(usb, CVMX_USBCX_HFNUM(usb->index))};
|
|
|
+ cvmx_usbcx_hfir_t hfir = {.u32 = __cvmx_usb_read_csr32(usb, CVMX_USBCX_HFIR(usb->index))};
|
|
|
+ if (hfnum.s.frrem < hfir.s.frint/4)
|
|
|
+ goto done;
|
|
|
+ }
|
|
|
+
|
|
|
+ while (usb->idle_hardware_channels)
|
|
|
+ {
|
|
|
+ /* Find an idle channel */
|
|
|
+ CVMX_CLZ(channel, usb->idle_hardware_channels);
|
|
|
+ channel = 31 - channel;
|
|
|
+ if (cvmx_unlikely(channel > 7))
|
|
|
+ {
|
|
|
+ if (cvmx_unlikely(usb->init_flags & CVMX_USB_INITIALIZE_FLAGS_DEBUG_INFO))
|
|
|
+ cvmx_dprintf("%s: Idle hardware channels has a channel higher than 7. This is wrong\n", __FUNCTION__);
|
|
|
+ break;
|
|
|
+ }
|
|
|
+
|
|
|
+ /* Find a pipe needing service */
|
|
|
+ pipe = NULL;
|
|
|
+ if (is_sof)
|
|
|
+ {
|
|
|
+ /* Only process periodic pipes on SOF interrupts. This way we are
|
|
|
+ sure that the periodic data is sent in the beginning of the
|
|
|
+ frame */
|
|
|
+ pipe = __cvmx_usb_find_ready_pipe(usb, usb->active_pipes + CVMX_USB_TRANSFER_ISOCHRONOUS, usb->frame_number);
|
|
|
+ if (cvmx_likely(!pipe))
|
|
|
+ pipe = __cvmx_usb_find_ready_pipe(usb, usb->active_pipes + CVMX_USB_TRANSFER_INTERRUPT, usb->frame_number);
|
|
|
+ }
|
|
|
+ if (cvmx_likely(!pipe))
|
|
|
+ {
|
|
|
+ pipe = __cvmx_usb_find_ready_pipe(usb, usb->active_pipes + CVMX_USB_TRANSFER_CONTROL, usb->frame_number);
|
|
|
+ if (cvmx_likely(!pipe))
|
|
|
+ pipe = __cvmx_usb_find_ready_pipe(usb, usb->active_pipes + CVMX_USB_TRANSFER_BULK, usb->frame_number);
|
|
|
+ }
|
|
|
+ if (!pipe)
|
|
|
+ break;
|
|
|
+
|
|
|
+ CVMX_USB_LOG_PARAM("%d", channel);
|
|
|
+ CVMX_USB_LOG_PARAM("%p", pipe);
|
|
|
+
|
|
|
+ if (cvmx_unlikely((usb->init_flags & CVMX_USB_INITIALIZE_FLAGS_DEBUG_TRANSFERS) ||
|
|
|
+ (pipe->flags & CVMX_USB_PIPE_FLAGS_DEBUG_TRANSFERS)))
|
|
|
+ {
|
|
|
+ cvmx_usb_transaction_t *transaction = pipe->head;
|
|
|
+ const cvmx_usb_control_header_t *header = (transaction->control_header) ? cvmx_phys_to_ptr(transaction->control_header) : NULL;
|
|
|
+ const char *dir = (pipe->transfer_dir == CVMX_USB_DIRECTION_IN) ? "IN" : "OUT";
|
|
|
+ const char *type;
|
|
|
+ switch (pipe->transfer_type)
|
|
|
+ {
|
|
|
+ case CVMX_USB_TRANSFER_CONTROL:
|
|
|
+ type = "SETUP";
|
|
|
+ dir = (header->s.request_type & 0x80) ? "IN" : "OUT";
|
|
|
+ break;
|
|
|
+ case CVMX_USB_TRANSFER_ISOCHRONOUS:
|
|
|
+ type = "ISOCHRONOUS";
|
|
|
+ break;
|
|
|
+ case CVMX_USB_TRANSFER_BULK:
|
|
|
+ type = "BULK";
|
|
|
+ break;
|
|
|
+ default: /* CVMX_USB_TRANSFER_INTERRUPT */
|
|
|
+ type = "INTERRUPT";
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ cvmx_dprintf("%s: Starting pipe %d, transaction %d on channel %d. %s %s len=%d header=0x%llx\n",
|
|
|
+ __FUNCTION__, __cvmx_usb_get_pipe_handle(usb, pipe),
|
|
|
+ __cvmx_usb_get_submit_handle(usb, transaction),
|
|
|
+ channel, type, dir,
|
|
|
+ transaction->buffer_length,
|
|
|
+ (header) ? (unsigned long long)header->u64 : 0ull);
|
|
|
+ }
|
|
|
+ __cvmx_usb_start_channel(usb, channel, pipe);
|
|
|
+ }
|
|
|
+
|
|
|
+done:
|
|
|
+ /* Only enable SOF interrupts when we have transactions pending in the
|
|
|
+ future that might need to be scheduled */
|
|
|
+ need_sof = 0;
|
|
|
+ for (ttype=CVMX_USB_TRANSFER_CONTROL; ttype<=CVMX_USB_TRANSFER_INTERRUPT; ttype++)
|
|
|
+ {
|
|
|
+ pipe = usb->active_pipes[ttype].head;
|
|
|
+ while (pipe)
|
|
|
+ {
|
|
|
+ if (pipe->next_tx_frame > usb->frame_number)
|
|
|
+ {
|
|
|
+ need_sof = 1;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ pipe=pipe->next;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ USB_SET_FIELD32(CVMX_USBCX_GINTMSK(usb->index), cvmx_usbcx_gintmsk_t, sofmsk, need_sof);
|
|
|
+ CVMX_USB_RETURN_NOTHING();
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * @INTERNAL
|
|
|
+ * Call a user's callback for a specific reason.
|
|
|
+ *
|
|
|
+ * @param usb USB device state populated by
|
|
|
+ * cvmx_usb_initialize().
|
|
|
+ * @param pipe Pipe the callback is for or NULL
|
|
|
+ * @param transaction
|
|
|
+ * Transaction the callback is for or NULL
|
|
|
+ * @param reason Reason this callback is being called
|
|
|
+ * @param complete_code
|
|
|
+ * Completion code for the transaction, if any
|
|
|
+ */
|
|
|
+static void __cvmx_usb_perform_callback(cvmx_usb_internal_state_t *usb,
|
|
|
+ cvmx_usb_pipe_t *pipe,
|
|
|
+ cvmx_usb_transaction_t *transaction,
|
|
|
+ cvmx_usb_callback_t reason,
|
|
|
+ cvmx_usb_complete_t complete_code)
|
|
|
+{
|
|
|
+ cvmx_usb_callback_func_t callback = usb->callback[reason];
|
|
|
+ void *user_data = usb->callback_data[reason];
|
|
|
+ int submit_handle = -1;
|
|
|
+ int pipe_handle = -1;
|
|
|
+ int bytes_transferred = 0;
|
|
|
+
|
|
|
+ if (pipe)
|
|
|
+ pipe_handle = __cvmx_usb_get_pipe_handle(usb, pipe);
|
|
|
+
|
|
|
+ if (transaction)
|
|
|
+ {
|
|
|
+ submit_handle = __cvmx_usb_get_submit_handle(usb, transaction);
|
|
|
+ bytes_transferred = transaction->actual_bytes;
|
|
|
+ /* Transactions are allowed to override the default callback */
|
|
|
+ if ((reason == CVMX_USB_CALLBACK_TRANSFER_COMPLETE) && transaction->callback)
|
|
|
+ {
|
|
|
+ callback = transaction->callback;
|
|
|
+ user_data = transaction->callback_data;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ if (!callback)
|
|
|
+ return;
|
|
|
+
|
|
|
+ if (cvmx_unlikely(usb->init_flags & CVMX_USB_INITIALIZE_FLAGS_DEBUG_CALLBACKS))
|
|
|
+ cvmx_dprintf("%*s%s: calling callback %p(usb=%p, complete_code=%s, "
|
|
|
+ "pipe_handle=%d, submit_handle=%d, bytes_transferred=%d, user_data=%p);\n",
|
|
|
+ 2*usb->indent, "", __FUNCTION__, callback, usb,
|
|
|
+ __cvmx_usb_complete_to_string(complete_code),
|
|
|
+ pipe_handle, submit_handle, bytes_transferred, user_data);
|
|
|
+
|
|
|
+ callback((cvmx_usb_state_t *)usb, reason, complete_code, pipe_handle, submit_handle,
|
|
|
+ bytes_transferred, user_data);
|
|
|
+
|
|
|
+ if (cvmx_unlikely(usb->init_flags & CVMX_USB_INITIALIZE_FLAGS_DEBUG_CALLBACKS))
|
|
|
+ cvmx_dprintf("%*s%s: callback %p complete\n", 2*usb->indent, "",
|
|
|
+ __FUNCTION__, callback);
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * @INTERNAL
|
|
|
+ * Signal the completion of a transaction and free it. The
|
|
|
+ * transaction will be removed from the pipe transaction list.
|
|
|
+ *
|
|
|
+ * @param usb USB device state populated by
|
|
|
+ * cvmx_usb_initialize().
|
|
|
+ * @param pipe Pipe the transaction is on
|
|
|
+ * @param transaction
|
|
|
+ * Transaction that completed
|
|
|
+ * @param complete_code
|
|
|
+ * Completion code
|
|
|
+ */
|
|
|
+static void __cvmx_usb_perform_complete(cvmx_usb_internal_state_t * usb,
|
|
|
+ cvmx_usb_pipe_t *pipe,
|
|
|
+ cvmx_usb_transaction_t *transaction,
|
|
|
+ cvmx_usb_complete_t complete_code)
|
|
|
+{
|
|
|
+ CVMX_USB_LOG_CALLED();
|
|
|
+ CVMX_USB_LOG_PARAM("%p", usb);
|
|
|
+ CVMX_USB_LOG_PARAM("%p", pipe);
|
|
|
+ CVMX_USB_LOG_PARAM("%p", transaction);
|
|
|
+ CVMX_USB_LOG_PARAM("%d", complete_code);
|
|
|
+
|
|
|
+ /* If this was a split then clear our split in progress marker */
|
|
|
+ if (usb->active_split == transaction)
|
|
|
+ usb->active_split = NULL;
|
|
|
+
|
|
|
+ /* Isochronous transactions need extra processing as they might not be done
|
|
|
+ after a single data transfer */
|
|
|
+ if (cvmx_unlikely(transaction->type == CVMX_USB_TRANSFER_ISOCHRONOUS))
|
|
|
+ {
|
|
|
+ /* Update the number of bytes transferred in this ISO packet */
|
|
|
+ transaction->iso_packets[0].length = transaction->actual_bytes;
|
|
|
+ transaction->iso_packets[0].status = complete_code;
|
|
|
+
|
|
|
+ /* If there are more ISOs pending and we succeeded, schedule the next
|
|
|
+ one */
|
|
|
+ if ((transaction->iso_number_packets > 1) && (complete_code == CVMX_USB_COMPLETE_SUCCESS))
|
|
|
+ {
|
|
|
+ transaction->actual_bytes = 0; /* No bytes transferred for this packet as of yet */
|
|
|
+ transaction->iso_number_packets--; /* One less ISO waiting to transfer */
|
|
|
+ transaction->iso_packets++; /* Increment to the next location in our packet array */
|
|
|
+ transaction->stage = CVMX_USB_STAGE_NON_CONTROL;
|
|
|
+ goto done;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ /* Remove the transaction from the pipe list */
|
|
|
+ if (transaction->next)
|
|
|
+ transaction->next->prev = transaction->prev;
|
|
|
+ else
|
|
|
+ pipe->tail = transaction->prev;
|
|
|
+ if (transaction->prev)
|
|
|
+ transaction->prev->next = transaction->next;
|
|
|
+ else
|
|
|
+ pipe->head = transaction->next;
|
|
|
+ if (!pipe->head)
|
|
|
+ {
|
|
|
+ __cvmx_usb_remove_pipe(usb->active_pipes + pipe->transfer_type, pipe);
|
|
|
+ __cvmx_usb_append_pipe(&usb->idle_pipes, pipe);
|
|
|
+
|
|
|
+ }
|
|
|
+ __cvmx_usb_perform_callback(usb, pipe, transaction,
|
|
|
+ CVMX_USB_CALLBACK_TRANSFER_COMPLETE,
|
|
|
+ complete_code);
|
|
|
+ __cvmx_usb_free_transaction(usb, transaction);
|
|
|
+done:
|
|
|
+ CVMX_USB_RETURN_NOTHING();
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * @INTERNAL
|
|
|
+ * Submit a usb transaction to a pipe. Called for all types
|
|
|
+ * of transactions.
|
|
|
+ *
|
|
|
+ * @param usb
|
|
|
+ * @param pipe_handle
|
|
|
+ * Which pipe to submit to. Will be validated in this function.
|
|
|
+ * @param type Transaction type
|
|
|
+ * @param flags Flags for the transaction
|
|
|
+ * @param buffer User buffer for the transaction
|
|
|
+ * @param buffer_length
|
|
|
+ * User buffer's length in bytes
|
|
|
+ * @param control_header
|
|
|
+ * For control transactions, the 8 byte standard header
|
|
|
+ * @param iso_start_frame
|
|
|
+ * For ISO transactions, the start frame
|
|
|
+ * @param iso_number_packets
|
|
|
+ * For ISO, the number of packet in the transaction.
|
|
|
+ * @param iso_packets
|
|
|
+ * A description of each ISO packet
|
|
|
+ * @param callback User callback to call when the transaction completes
|
|
|
+ * @param user_data User's data for the callback
|
|
|
+ *
|
|
|
+ * @return Submit handle or negative on failure. Matches the result
|
|
|
+ * in the external API.
|
|
|
+ */
|
|
|
+static int __cvmx_usb_submit_transaction(cvmx_usb_internal_state_t *usb,
|
|
|
+ int pipe_handle,
|
|
|
+ cvmx_usb_transfer_t type,
|
|
|
+ int flags,
|
|
|
+ uint64_t buffer,
|
|
|
+ int buffer_length,
|
|
|
+ uint64_t control_header,
|
|
|
+ int iso_start_frame,
|
|
|
+ int iso_number_packets,
|
|
|
+ cvmx_usb_iso_packet_t *iso_packets,
|
|
|
+ cvmx_usb_callback_func_t callback,
|
|
|
+ void *user_data)
|
|
|
+{
|
|
|
+ int submit_handle;
|
|
|
+ cvmx_usb_transaction_t *transaction;
|
|
|
+ cvmx_usb_pipe_t *pipe = usb->pipe + pipe_handle;
|
|
|
+
|
|
|
+ CVMX_USB_LOG_CALLED();
|
|
|
+ if (cvmx_unlikely((pipe_handle < 0) || (pipe_handle >= MAX_PIPES)))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+ /* Fail if the pipe isn't open */
|
|
|
+ if (cvmx_unlikely((pipe->flags & __CVMX_USB_PIPE_FLAGS_OPEN) == 0))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+ if (cvmx_unlikely(pipe->transfer_type != type))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+
|
|
|
+ transaction = __cvmx_usb_alloc_transaction(usb);
|
|
|
+ if (cvmx_unlikely(!transaction))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_NO_MEMORY);
|
|
|
+
|
|
|
+ transaction->type = type;
|
|
|
+ transaction->flags |= flags;
|
|
|
+ transaction->buffer = buffer;
|
|
|
+ transaction->buffer_length = buffer_length;
|
|
|
+ transaction->control_header = control_header;
|
|
|
+ transaction->iso_start_frame = iso_start_frame; // FIXME: This is not used, implement it
|
|
|
+ transaction->iso_number_packets = iso_number_packets;
|
|
|
+ transaction->iso_packets = iso_packets;
|
|
|
+ transaction->callback = callback;
|
|
|
+ transaction->callback_data = user_data;
|
|
|
+ if (transaction->type == CVMX_USB_TRANSFER_CONTROL)
|
|
|
+ transaction->stage = CVMX_USB_STAGE_SETUP;
|
|
|
+ else
|
|
|
+ transaction->stage = CVMX_USB_STAGE_NON_CONTROL;
|
|
|
+
|
|
|
+ transaction->next = NULL;
|
|
|
+ if (pipe->tail)
|
|
|
+ {
|
|
|
+ transaction->prev = pipe->tail;
|
|
|
+ transaction->prev->next = transaction;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ if (pipe->next_tx_frame < usb->frame_number)
|
|
|
+ pipe->next_tx_frame = usb->frame_number + pipe->interval -
|
|
|
+ (usb->frame_number - pipe->next_tx_frame) % pipe->interval;
|
|
|
+ transaction->prev = NULL;
|
|
|
+ pipe->head = transaction;
|
|
|
+ __cvmx_usb_remove_pipe(&usb->idle_pipes, pipe);
|
|
|
+ __cvmx_usb_append_pipe(usb->active_pipes + pipe->transfer_type, pipe);
|
|
|
+ }
|
|
|
+ pipe->tail = transaction;
|
|
|
+
|
|
|
+ submit_handle = __cvmx_usb_get_submit_handle(usb, transaction);
|
|
|
+
|
|
|
+ /* We may need to schedule the pipe if this was the head of the pipe */
|
|
|
+ if (!transaction->prev)
|
|
|
+ __cvmx_usb_schedule(usb, 0);
|
|
|
+
|
|
|
+ CVMX_USB_RETURN(submit_handle);
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * Call to submit a USB Bulk transfer to a pipe.
|
|
|
+ *
|
|
|
+ * @param state USB device state populated by
|
|
|
+ * cvmx_usb_initialize().
|
|
|
+ * @param pipe_handle
|
|
|
+ * Handle to the pipe for the transfer.
|
|
|
+ * @param buffer Physical address of the data buffer in
|
|
|
+ * memory. Note that this is NOT A POINTER, but
|
|
|
+ * the full 64bit physical address of the
|
|
|
+ * buffer. This may be zero if buffer_length is
|
|
|
+ * zero.
|
|
|
+ * @param buffer_length
|
|
|
+ * Length of buffer in bytes.
|
|
|
+ * @param callback Function to call when this transaction
|
|
|
+ * completes. If the return value of this
|
|
|
+ * function isn't an error, then this function
|
|
|
+ * is guaranteed to be called when the
|
|
|
+ * transaction completes. If this parameter is
|
|
|
+ * NULL, then the generic callback registered
|
|
|
+ * through cvmx_usb_register_callback is
|
|
|
+ * called. If both are NULL, then there is no
|
|
|
+ * way to know when a transaction completes.
|
|
|
+ * @param user_data User supplied data returned when the
|
|
|
+ * callback is called. This is only used if
|
|
|
+ * callback in not NULL.
|
|
|
+ *
|
|
|
+ * @return A submitted transaction handle or negative on
|
|
|
+ * failure. Negative values are failure codes from
|
|
|
+ * cvmx_usb_status_t.
|
|
|
+ */
|
|
|
+int cvmx_usb_submit_bulk(cvmx_usb_state_t *state, int pipe_handle,
|
|
|
+ uint64_t buffer, int buffer_length,
|
|
|
+ cvmx_usb_callback_func_t callback,
|
|
|
+ void *user_data)
|
|
|
+{
|
|
|
+ int submit_handle;
|
|
|
+ cvmx_usb_internal_state_t *usb = (cvmx_usb_internal_state_t*)state;
|
|
|
+
|
|
|
+ CVMX_USB_LOG_CALLED();
|
|
|
+ CVMX_USB_LOG_PARAM("%p", state);
|
|
|
+ CVMX_USB_LOG_PARAM("%d", pipe_handle);
|
|
|
+ CVMX_USB_LOG_PARAM("0x%llx", (unsigned long long)buffer);
|
|
|
+ CVMX_USB_LOG_PARAM("%d", buffer_length);
|
|
|
+
|
|
|
+ /* Pipe handle checking is done later in a common place */
|
|
|
+ if (cvmx_unlikely(!buffer))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+ if (cvmx_unlikely(buffer_length < 0))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+
|
|
|
+ submit_handle = __cvmx_usb_submit_transaction(usb, pipe_handle,
|
|
|
+ CVMX_USB_TRANSFER_BULK,
|
|
|
+ 0, /* flags */
|
|
|
+ buffer,
|
|
|
+ buffer_length,
|
|
|
+ 0, /* control_header */
|
|
|
+ 0, /* iso_start_frame */
|
|
|
+ 0, /* iso_number_packets */
|
|
|
+ NULL, /* iso_packets */
|
|
|
+ callback,
|
|
|
+ user_data);
|
|
|
+ CVMX_USB_RETURN(submit_handle);
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * Call to submit a USB Interrupt transfer to a pipe.
|
|
|
+ *
|
|
|
+ * @param state USB device state populated by
|
|
|
+ * cvmx_usb_initialize().
|
|
|
+ * @param pipe_handle
|
|
|
+ * Handle to the pipe for the transfer.
|
|
|
+ * @param buffer Physical address of the data buffer in
|
|
|
+ * memory. Note that this is NOT A POINTER, but
|
|
|
+ * the full 64bit physical address of the
|
|
|
+ * buffer. This may be zero if buffer_length is
|
|
|
+ * zero.
|
|
|
+ * @param buffer_length
|
|
|
+ * Length of buffer in bytes.
|
|
|
+ * @param callback Function to call when this transaction
|
|
|
+ * completes. If the return value of this
|
|
|
+ * function isn't an error, then this function
|
|
|
+ * is guaranteed to be called when the
|
|
|
+ * transaction completes. If this parameter is
|
|
|
+ * NULL, then the generic callback registered
|
|
|
+ * through cvmx_usb_register_callback is
|
|
|
+ * called. If both are NULL, then there is no
|
|
|
+ * way to know when a transaction completes.
|
|
|
+ * @param user_data User supplied data returned when the
|
|
|
+ * callback is called. This is only used if
|
|
|
+ * callback in not NULL.
|
|
|
+ *
|
|
|
+ * @return A submitted transaction handle or negative on
|
|
|
+ * failure. Negative values are failure codes from
|
|
|
+ * cvmx_usb_status_t.
|
|
|
+ */
|
|
|
+int cvmx_usb_submit_interrupt(cvmx_usb_state_t *state, int pipe_handle,
|
|
|
+ uint64_t buffer, int buffer_length,
|
|
|
+ cvmx_usb_callback_func_t callback,
|
|
|
+ void *user_data)
|
|
|
+{
|
|
|
+ int submit_handle;
|
|
|
+ cvmx_usb_internal_state_t *usb = (cvmx_usb_internal_state_t*)state;
|
|
|
+
|
|
|
+ CVMX_USB_LOG_CALLED();
|
|
|
+ CVMX_USB_LOG_PARAM("%p", state);
|
|
|
+ CVMX_USB_LOG_PARAM("%d", pipe_handle);
|
|
|
+ CVMX_USB_LOG_PARAM("0x%llx", (unsigned long long)buffer);
|
|
|
+ CVMX_USB_LOG_PARAM("%d", buffer_length);
|
|
|
+
|
|
|
+ /* Pipe handle checking is done later in a common place */
|
|
|
+ if (cvmx_unlikely(!buffer))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+ if (cvmx_unlikely(buffer_length < 0))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+
|
|
|
+ submit_handle = __cvmx_usb_submit_transaction(usb, pipe_handle,
|
|
|
+ CVMX_USB_TRANSFER_INTERRUPT,
|
|
|
+ 0, /* flags */
|
|
|
+ buffer,
|
|
|
+ buffer_length,
|
|
|
+ 0, /* control_header */
|
|
|
+ 0, /* iso_start_frame */
|
|
|
+ 0, /* iso_number_packets */
|
|
|
+ NULL, /* iso_packets */
|
|
|
+ callback,
|
|
|
+ user_data);
|
|
|
+ CVMX_USB_RETURN(submit_handle);
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * Call to submit a USB Control transfer to a pipe.
|
|
|
+ *
|
|
|
+ * @param state USB device state populated by
|
|
|
+ * cvmx_usb_initialize().
|
|
|
+ * @param pipe_handle
|
|
|
+ * Handle to the pipe for the transfer.
|
|
|
+ * @param control_header
|
|
|
+ * USB 8 byte control header physical address.
|
|
|
+ * Note that this is NOT A POINTER, but the
|
|
|
+ * full 64bit physical address of the buffer.
|
|
|
+ * @param buffer Physical address of the data buffer in
|
|
|
+ * memory. Note that this is NOT A POINTER, but
|
|
|
+ * the full 64bit physical address of the
|
|
|
+ * buffer. This may be zero if buffer_length is
|
|
|
+ * zero.
|
|
|
+ * @param buffer_length
|
|
|
+ * Length of buffer in bytes.
|
|
|
+ * @param callback Function to call when this transaction
|
|
|
+ * completes. If the return value of this
|
|
|
+ * function isn't an error, then this function
|
|
|
+ * is guaranteed to be called when the
|
|
|
+ * transaction completes. If this parameter is
|
|
|
+ * NULL, then the generic callback registered
|
|
|
+ * through cvmx_usb_register_callback is
|
|
|
+ * called. If both are NULL, then there is no
|
|
|
+ * way to know when a transaction completes.
|
|
|
+ * @param user_data User supplied data returned when the
|
|
|
+ * callback is called. This is only used if
|
|
|
+ * callback in not NULL.
|
|
|
+ *
|
|
|
+ * @return A submitted transaction handle or negative on
|
|
|
+ * failure. Negative values are failure codes from
|
|
|
+ * cvmx_usb_status_t.
|
|
|
+ */
|
|
|
+int cvmx_usb_submit_control(cvmx_usb_state_t *state, int pipe_handle,
|
|
|
+ uint64_t control_header,
|
|
|
+ uint64_t buffer, int buffer_length,
|
|
|
+ cvmx_usb_callback_func_t callback,
|
|
|
+ void *user_data)
|
|
|
+{
|
|
|
+ int submit_handle;
|
|
|
+ cvmx_usb_internal_state_t *usb = (cvmx_usb_internal_state_t*)state;
|
|
|
+ cvmx_usb_control_header_t *header = cvmx_phys_to_ptr(control_header);
|
|
|
+
|
|
|
+ CVMX_USB_LOG_CALLED();
|
|
|
+ CVMX_USB_LOG_PARAM("%p", state);
|
|
|
+ CVMX_USB_LOG_PARAM("%d", pipe_handle);
|
|
|
+ CVMX_USB_LOG_PARAM("0x%llx", (unsigned long long)control_header);
|
|
|
+ CVMX_USB_LOG_PARAM("0x%llx", (unsigned long long)buffer);
|
|
|
+ CVMX_USB_LOG_PARAM("%d", buffer_length);
|
|
|
+
|
|
|
+ /* Pipe handle checking is done later in a common place */
|
|
|
+ if (cvmx_unlikely(!control_header))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+ /* Some drivers send a buffer with a zero length. God only knows why */
|
|
|
+ if (cvmx_unlikely(buffer && (buffer_length < 0)))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+ if (cvmx_unlikely(!buffer && (buffer_length != 0)))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+ if ((header->s.request_type & 0x80) == 0)
|
|
|
+ buffer_length = cvmx_le16_to_cpu(header->s.length);
|
|
|
+
|
|
|
+ submit_handle = __cvmx_usb_submit_transaction(usb, pipe_handle,
|
|
|
+ CVMX_USB_TRANSFER_CONTROL,
|
|
|
+ 0, /* flags */
|
|
|
+ buffer,
|
|
|
+ buffer_length,
|
|
|
+ control_header,
|
|
|
+ 0, /* iso_start_frame */
|
|
|
+ 0, /* iso_number_packets */
|
|
|
+ NULL, /* iso_packets */
|
|
|
+ callback,
|
|
|
+ user_data);
|
|
|
+ CVMX_USB_RETURN(submit_handle);
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * Call to submit a USB Isochronous transfer to a pipe.
|
|
|
+ *
|
|
|
+ * @param state USB device state populated by
|
|
|
+ * cvmx_usb_initialize().
|
|
|
+ * @param pipe_handle
|
|
|
+ * Handle to the pipe for the transfer.
|
|
|
+ * @param start_frame
|
|
|
+ * Number of frames into the future to schedule
|
|
|
+ * this transaction.
|
|
|
+ * @param flags Flags to control the transfer. See
|
|
|
+ * cvmx_usb_isochronous_flags_t for the flag
|
|
|
+ * definitions.
|
|
|
+ * @param number_packets
|
|
|
+ * Number of sequential packets to transfer.
|
|
|
+ * "packets" is a pointer to an array of this
|
|
|
+ * many packet structures.
|
|
|
+ * @param packets Description of each transfer packet as
|
|
|
+ * defined by cvmx_usb_iso_packet_t. The array
|
|
|
+ * pointed to here must stay valid until the
|
|
|
+ * complete callback is called.
|
|
|
+ * @param buffer Physical address of the data buffer in
|
|
|
+ * memory. Note that this is NOT A POINTER, but
|
|
|
+ * the full 64bit physical address of the
|
|
|
+ * buffer. This may be zero if buffer_length is
|
|
|
+ * zero.
|
|
|
+ * @param buffer_length
|
|
|
+ * Length of buffer in bytes.
|
|
|
+ * @param callback Function to call when this transaction
|
|
|
+ * completes. If the return value of this
|
|
|
+ * function isn't an error, then this function
|
|
|
+ * is guaranteed to be called when the
|
|
|
+ * transaction completes. If this parameter is
|
|
|
+ * NULL, then the generic callback registered
|
|
|
+ * through cvmx_usb_register_callback is
|
|
|
+ * called. If both are NULL, then there is no
|
|
|
+ * way to know when a transaction completes.
|
|
|
+ * @param user_data User supplied data returned when the
|
|
|
+ * callback is called. This is only used if
|
|
|
+ * callback in not NULL.
|
|
|
+ *
|
|
|
+ * @return A submitted transaction handle or negative on
|
|
|
+ * failure. Negative values are failure codes from
|
|
|
+ * cvmx_usb_status_t.
|
|
|
+ */
|
|
|
+int cvmx_usb_submit_isochronous(cvmx_usb_state_t *state, int pipe_handle,
|
|
|
+ int start_frame, int flags,
|
|
|
+ int number_packets,
|
|
|
+ cvmx_usb_iso_packet_t packets[],
|
|
|
+ uint64_t buffer, int buffer_length,
|
|
|
+ cvmx_usb_callback_func_t callback,
|
|
|
+ void *user_data)
|
|
|
+{
|
|
|
+ int submit_handle;
|
|
|
+ cvmx_usb_internal_state_t *usb = (cvmx_usb_internal_state_t*)state;
|
|
|
+
|
|
|
+ CVMX_USB_LOG_CALLED();
|
|
|
+ CVMX_USB_LOG_PARAM("%p", state);
|
|
|
+ CVMX_USB_LOG_PARAM("%d", pipe_handle);
|
|
|
+ CVMX_USB_LOG_PARAM("%d", start_frame);
|
|
|
+ CVMX_USB_LOG_PARAM("0x%x", flags);
|
|
|
+ CVMX_USB_LOG_PARAM("%d", number_packets);
|
|
|
+ CVMX_USB_LOG_PARAM("%p", packets);
|
|
|
+ CVMX_USB_LOG_PARAM("0x%llx", (unsigned long long)buffer);
|
|
|
+ CVMX_USB_LOG_PARAM("%d", buffer_length);
|
|
|
+
|
|
|
+ /* Pipe handle checking is done later in a common place */
|
|
|
+ if (cvmx_unlikely(start_frame < 0))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+ if (cvmx_unlikely(flags & ~(CVMX_USB_ISOCHRONOUS_FLAGS_ALLOW_SHORT | CVMX_USB_ISOCHRONOUS_FLAGS_ASAP)))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+ if (cvmx_unlikely(number_packets < 1))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+ if (cvmx_unlikely(!packets))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+ if (cvmx_unlikely(!buffer))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+ if (cvmx_unlikely(buffer_length < 0))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+
|
|
|
+ submit_handle = __cvmx_usb_submit_transaction(usb, pipe_handle,
|
|
|
+ CVMX_USB_TRANSFER_ISOCHRONOUS,
|
|
|
+ flags,
|
|
|
+ buffer,
|
|
|
+ buffer_length,
|
|
|
+ 0, /* control_header */
|
|
|
+ start_frame,
|
|
|
+ number_packets,
|
|
|
+ packets,
|
|
|
+ callback,
|
|
|
+ user_data);
|
|
|
+ CVMX_USB_RETURN(submit_handle);
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * Cancel one outstanding request in a pipe. Canceling a request
|
|
|
+ * can fail if the transaction has already completed before cancel
|
|
|
+ * is called. Even after a successful cancel call, it may take
|
|
|
+ * a frame or two for the cvmx_usb_poll() function to call the
|
|
|
+ * associated callback.
|
|
|
+ *
|
|
|
+ * @param state USB device state populated by
|
|
|
+ * cvmx_usb_initialize().
|
|
|
+ * @param pipe_handle
|
|
|
+ * Pipe handle to cancel requests in.
|
|
|
+ * @param submit_handle
|
|
|
+ * Handle to transaction to cancel, returned by the submit function.
|
|
|
+ *
|
|
|
+ * @return CVMX_USB_SUCCESS or a negative error code defined in
|
|
|
+ * cvmx_usb_status_t.
|
|
|
+ */
|
|
|
+cvmx_usb_status_t cvmx_usb_cancel(cvmx_usb_state_t *state, int pipe_handle,
|
|
|
+ int submit_handle)
|
|
|
+{
|
|
|
+ cvmx_usb_transaction_t *transaction;
|
|
|
+ cvmx_usb_internal_state_t *usb = (cvmx_usb_internal_state_t*)state;
|
|
|
+ cvmx_usb_pipe_t *pipe = usb->pipe + pipe_handle;
|
|
|
+
|
|
|
+ CVMX_USB_LOG_CALLED();
|
|
|
+ CVMX_USB_LOG_PARAM("%p", state);
|
|
|
+ CVMX_USB_LOG_PARAM("%d", pipe_handle);
|
|
|
+ CVMX_USB_LOG_PARAM("%d", submit_handle);
|
|
|
+
|
|
|
+ if (cvmx_unlikely((pipe_handle < 0) || (pipe_handle >= MAX_PIPES)))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+ if (cvmx_unlikely((submit_handle < 0) || (submit_handle >= MAX_TRANSACTIONS)))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+
|
|
|
+ /* Fail if the pipe isn't open */
|
|
|
+ if (cvmx_unlikely((pipe->flags & __CVMX_USB_PIPE_FLAGS_OPEN) == 0))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+
|
|
|
+ transaction = usb->transaction + submit_handle;
|
|
|
+
|
|
|
+ /* Fail if this transaction already completed */
|
|
|
+ if (cvmx_unlikely((transaction->flags & __CVMX_USB_TRANSACTION_FLAGS_IN_USE) == 0))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+
|
|
|
+ /* If the transaction is the HEAD of the queue and scheduled. We need to
|
|
|
+ treat it special */
|
|
|
+ if ((pipe->head == transaction) &&
|
|
|
+ (pipe->flags & __CVMX_USB_PIPE_FLAGS_SCHEDULED))
|
|
|
+ {
|
|
|
+ cvmx_usbcx_hccharx_t usbc_hcchar;
|
|
|
+
|
|
|
+ usb->pipe_for_channel[pipe->channel] = NULL;
|
|
|
+ pipe->flags &= ~__CVMX_USB_PIPE_FLAGS_SCHEDULED;
|
|
|
+
|
|
|
+ CVMX_SYNCW;
|
|
|
+
|
|
|
+ usbc_hcchar.u32 = __cvmx_usb_read_csr32(usb, CVMX_USBCX_HCCHARX(pipe->channel, usb->index));
|
|
|
+ /* If the channel isn't enabled then the transaction already completed */
|
|
|
+ if (usbc_hcchar.s.chena)
|
|
|
+ {
|
|
|
+ usbc_hcchar.s.chdis = 1;
|
|
|
+ __cvmx_usb_write_csr32(usb, CVMX_USBCX_HCCHARX(pipe->channel, usb->index), usbc_hcchar.u32);
|
|
|
+ }
|
|
|
+ }
|
|
|
+ __cvmx_usb_perform_complete(usb, pipe, transaction, CVMX_USB_COMPLETE_CANCEL);
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_SUCCESS);
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * Cancel all outstanding requests in a pipe. Logically all this
|
|
|
+ * does is call cvmx_usb_cancel() in a loop.
|
|
|
+ *
|
|
|
+ * @param state USB device state populated by
|
|
|
+ * cvmx_usb_initialize().
|
|
|
+ * @param pipe_handle
|
|
|
+ * Pipe handle to cancel requests in.
|
|
|
+ *
|
|
|
+ * @return CVMX_USB_SUCCESS or a negative error code defined in
|
|
|
+ * cvmx_usb_status_t.
|
|
|
+ */
|
|
|
+cvmx_usb_status_t cvmx_usb_cancel_all(cvmx_usb_state_t *state, int pipe_handle)
|
|
|
+{
|
|
|
+ cvmx_usb_internal_state_t *usb = (cvmx_usb_internal_state_t*)state;
|
|
|
+ cvmx_usb_pipe_t *pipe = usb->pipe + pipe_handle;
|
|
|
+
|
|
|
+ CVMX_USB_LOG_CALLED();
|
|
|
+ CVMX_USB_LOG_PARAM("%p", state);
|
|
|
+ CVMX_USB_LOG_PARAM("%d", pipe_handle);
|
|
|
+ if (cvmx_unlikely((pipe_handle < 0) || (pipe_handle >= MAX_PIPES)))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+
|
|
|
+ /* Fail if the pipe isn't open */
|
|
|
+ if (cvmx_unlikely((pipe->flags & __CVMX_USB_PIPE_FLAGS_OPEN) == 0))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+
|
|
|
+ /* Simply loop through and attempt to cancel each transaction */
|
|
|
+ while (pipe->head)
|
|
|
+ {
|
|
|
+ cvmx_usb_status_t result = cvmx_usb_cancel(state, pipe_handle,
|
|
|
+ __cvmx_usb_get_submit_handle(usb, pipe->head));
|
|
|
+ if (cvmx_unlikely(result != CVMX_USB_SUCCESS))
|
|
|
+ CVMX_USB_RETURN(result);
|
|
|
+ }
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_SUCCESS);
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * Close a pipe created with cvmx_usb_open_pipe().
|
|
|
+ *
|
|
|
+ * @param state USB device state populated by
|
|
|
+ * cvmx_usb_initialize().
|
|
|
+ * @param pipe_handle
|
|
|
+ * Pipe handle to close.
|
|
|
+ *
|
|
|
+ * @return CVMX_USB_SUCCESS or a negative error code defined in
|
|
|
+ * cvmx_usb_status_t. CVMX_USB_BUSY is returned if the
|
|
|
+ * pipe has outstanding transfers.
|
|
|
+ */
|
|
|
+cvmx_usb_status_t cvmx_usb_close_pipe(cvmx_usb_state_t *state, int pipe_handle)
|
|
|
+{
|
|
|
+ cvmx_usb_internal_state_t *usb = (cvmx_usb_internal_state_t*)state;
|
|
|
+ cvmx_usb_pipe_t *pipe = usb->pipe + pipe_handle;
|
|
|
+
|
|
|
+ CVMX_USB_LOG_CALLED();
|
|
|
+ CVMX_USB_LOG_PARAM("%p", state);
|
|
|
+ CVMX_USB_LOG_PARAM("%d", pipe_handle);
|
|
|
+ if (cvmx_unlikely((pipe_handle < 0) || (pipe_handle >= MAX_PIPES)))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+
|
|
|
+ /* Fail if the pipe isn't open */
|
|
|
+ if (cvmx_unlikely((pipe->flags & __CVMX_USB_PIPE_FLAGS_OPEN) == 0))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+
|
|
|
+ /* Fail if the pipe has pending transactions */
|
|
|
+ if (cvmx_unlikely(pipe->head))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_BUSY);
|
|
|
+
|
|
|
+ pipe->flags = 0;
|
|
|
+ __cvmx_usb_remove_pipe(&usb->idle_pipes, pipe);
|
|
|
+ __cvmx_usb_append_pipe(&usb->free_pipes, pipe);
|
|
|
+
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_SUCCESS);
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * Register a function to be called when various USB events occur.
|
|
|
+ *
|
|
|
+ * @param state USB device state populated by
|
|
|
+ * cvmx_usb_initialize().
|
|
|
+ * @param reason Which event to register for.
|
|
|
+ * @param callback Function to call when the event occurs.
|
|
|
+ * @param user_data User data parameter to the function.
|
|
|
+ *
|
|
|
+ * @return CVMX_USB_SUCCESS or a negative error code defined in
|
|
|
+ * cvmx_usb_status_t.
|
|
|
+ */
|
|
|
+cvmx_usb_status_t cvmx_usb_register_callback(cvmx_usb_state_t *state,
|
|
|
+ cvmx_usb_callback_t reason,
|
|
|
+ cvmx_usb_callback_func_t callback,
|
|
|
+ void *user_data)
|
|
|
+{
|
|
|
+ cvmx_usb_internal_state_t *usb = (cvmx_usb_internal_state_t*)state;
|
|
|
+
|
|
|
+ CVMX_USB_LOG_CALLED();
|
|
|
+ CVMX_USB_LOG_PARAM("%p", state);
|
|
|
+ CVMX_USB_LOG_PARAM("%d", reason);
|
|
|
+ CVMX_USB_LOG_PARAM("%p", callback);
|
|
|
+ CVMX_USB_LOG_PARAM("%p", user_data);
|
|
|
+ if (cvmx_unlikely(reason >= __CVMX_USB_CALLBACK_END))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+ if (cvmx_unlikely(!callback))
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_INVALID_PARAM);
|
|
|
+
|
|
|
+ usb->callback[reason] = callback;
|
|
|
+ usb->callback_data[reason] = user_data;
|
|
|
+
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_SUCCESS);
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * Get the current USB protocol level frame number. The frame
|
|
|
+ * number is always in the range of 0-0x7ff.
|
|
|
+ *
|
|
|
+ * @param state USB device state populated by
|
|
|
+ * cvmx_usb_initialize().
|
|
|
+ *
|
|
|
+ * @return USB frame number
|
|
|
+ */
|
|
|
+int cvmx_usb_get_frame_number(cvmx_usb_state_t *state)
|
|
|
+{
|
|
|
+ int frame_number;
|
|
|
+ cvmx_usb_internal_state_t *usb = (cvmx_usb_internal_state_t*)state;
|
|
|
+ cvmx_usbcx_hfnum_t usbc_hfnum;
|
|
|
+
|
|
|
+ CVMX_USB_LOG_CALLED();
|
|
|
+ CVMX_USB_LOG_PARAM("%p", state);
|
|
|
+
|
|
|
+ usbc_hfnum.u32 = __cvmx_usb_read_csr32(usb, CVMX_USBCX_HFNUM(usb->index));
|
|
|
+ frame_number = usbc_hfnum.s.frnum;
|
|
|
+
|
|
|
+ CVMX_USB_RETURN(frame_number);
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * @INTERNAL
|
|
|
+ * Poll a channel for status
|
|
|
+ *
|
|
|
+ * @param usb USB device
|
|
|
+ * @param channel Channel to poll
|
|
|
+ *
|
|
|
+ * @return Zero on success
|
|
|
+ */
|
|
|
+static int __cvmx_usb_poll_channel(cvmx_usb_internal_state_t *usb, int channel)
|
|
|
+{
|
|
|
+ cvmx_usbcx_hcintx_t usbc_hcint;
|
|
|
+ cvmx_usbcx_hctsizx_t usbc_hctsiz;
|
|
|
+ cvmx_usbcx_hccharx_t usbc_hcchar;
|
|
|
+ cvmx_usb_pipe_t *pipe;
|
|
|
+ cvmx_usb_transaction_t *transaction;
|
|
|
+ int bytes_this_transfer;
|
|
|
+ int bytes_in_last_packet;
|
|
|
+ int packets_processed;
|
|
|
+ int buffer_space_left;
|
|
|
+ CVMX_USB_LOG_CALLED();
|
|
|
+ CVMX_USB_LOG_PARAM("%p", usb);
|
|
|
+ CVMX_USB_LOG_PARAM("%d", channel);
|
|
|
+
|
|
|
+ /* Read the interrupt status bits for the channel */
|
|
|
+ usbc_hcint.u32 = __cvmx_usb_read_csr32(usb, CVMX_USBCX_HCINTX(channel, usb->index));
|
|
|
+
|
|
|
+ if (usb->init_flags & CVMX_USB_INITIALIZE_FLAGS_NO_DMA)
|
|
|
+ {
|
|
|
+ usbc_hcchar.u32 = __cvmx_usb_read_csr32(usb, CVMX_USBCX_HCCHARX(channel, usb->index));
|
|
|
+
|
|
|
+ if (usbc_hcchar.s.chena && usbc_hcchar.s.chdis)
|
|
|
+ {
|
|
|
+ /* There seems to be a bug in CN31XX which can cause interrupt
|
|
|
+ IN transfers to get stuck until we do a write of HCCHARX
|
|
|
+ without changing things */
|
|
|
+ __cvmx_usb_write_csr32(usb, CVMX_USBCX_HCCHARX(channel, usb->index), usbc_hcchar.u32);
|
|
|
+ CVMX_USB_RETURN(0);
|
|
|
+ }
|
|
|
+
|
|
|
+ /* In non DMA mode the channels don't halt themselves. We need to
|
|
|
+ manually disable channels that are left running */
|
|
|
+ if (!usbc_hcint.s.chhltd)
|
|
|
+ {
|
|
|
+ if (usbc_hcchar.s.chena)
|
|
|
+ {
|
|
|
+ cvmx_usbcx_hcintmskx_t hcintmsk;
|
|
|
+ /* Disable all interrupts except CHHLTD */
|
|
|
+ hcintmsk.u32 = 0;
|
|
|
+ hcintmsk.s.chhltdmsk = 1;
|
|
|
+ __cvmx_usb_write_csr32(usb, CVMX_USBCX_HCINTMSKX(channel, usb->index), hcintmsk.u32);
|
|
|
+ usbc_hcchar.s.chdis = 1;
|
|
|
+ __cvmx_usb_write_csr32(usb, CVMX_USBCX_HCCHARX(channel, usb->index), usbc_hcchar.u32);
|
|
|
+ CVMX_USB_RETURN(0);
|
|
|
+ }
|
|
|
+ else if (usbc_hcint.s.xfercompl)
|
|
|
+ {
|
|
|
+ /* Successful IN/OUT with transfer complete. Channel halt isn't needed */
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ cvmx_dprintf("USB%d: Channel %d interrupt without halt\n", usb->index, channel);
|
|
|
+ CVMX_USB_RETURN(0);
|
|
|
+ }
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ /* There is are no interrupts that we need to process when the channel is
|
|
|
+ still running */
|
|
|
+ if (!usbc_hcint.s.chhltd)
|
|
|
+ CVMX_USB_RETURN(0);
|
|
|
+ }
|
|
|
+
|
|
|
+ /* Disable the channel interrupts now that it is done */
|
|
|
+ __cvmx_usb_write_csr32(usb, CVMX_USBCX_HCINTMSKX(channel, usb->index), 0);
|
|
|
+ usb->idle_hardware_channels |= (1<<channel);
|
|
|
+
|
|
|
+ /* Make sure this channel is tied to a valid pipe */
|
|
|
+ pipe = usb->pipe_for_channel[channel];
|
|
|
+ CVMX_PREFETCH(pipe, 0);
|
|
|
+ CVMX_PREFETCH(pipe, 128);
|
|
|
+ if (!pipe)
|
|
|
+ CVMX_USB_RETURN(0);
|
|
|
+ transaction = pipe->head;
|
|
|
+ CVMX_PREFETCH0(transaction);
|
|
|
+
|
|
|
+ /* Disconnect this pipe from the HW channel. Later the schedule function will
|
|
|
+ figure out which pipe needs to go */
|
|
|
+ usb->pipe_for_channel[channel] = NULL;
|
|
|
+ pipe->flags &= ~__CVMX_USB_PIPE_FLAGS_SCHEDULED;
|
|
|
+
|
|
|
+ /* Read the channel config info so we can figure out how much data
|
|
|
+ transfered */
|
|
|
+ usbc_hcchar.u32 = __cvmx_usb_read_csr32(usb, CVMX_USBCX_HCCHARX(channel, usb->index));
|
|
|
+ usbc_hctsiz.u32 = __cvmx_usb_read_csr32(usb, CVMX_USBCX_HCTSIZX(channel, usb->index));
|
|
|
+
|
|
|
+ /* Calculating the number of bytes successfully transferred is dependent on
|
|
|
+ the transfer direction */
|
|
|
+ packets_processed = transaction->pktcnt - usbc_hctsiz.s.pktcnt;
|
|
|
+ if (usbc_hcchar.s.epdir)
|
|
|
+ {
|
|
|
+ /* IN transactions are easy. For every byte received the hardware
|
|
|
+ decrements xfersize. All we need to do is subtract the current
|
|
|
+ value of xfersize from its starting value and we know how many
|
|
|
+ bytes were written to the buffer */
|
|
|
+ bytes_this_transfer = transaction->xfersize - usbc_hctsiz.s.xfersize;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ /* OUT transaction don't decrement xfersize. Instead pktcnt is
|
|
|
+ decremented on every successful packet send. The hardware does
|
|
|
+ this when it receives an ACK, or NYET. If it doesn't
|
|
|
+ receive one of these responses pktcnt doesn't change */
|
|
|
+ bytes_this_transfer = packets_processed * usbc_hcchar.s.mps;
|
|
|
+ /* The last packet may not be a full transfer if we didn't have
|
|
|
+ enough data */
|
|
|
+ if (bytes_this_transfer > transaction->xfersize)
|
|
|
+ bytes_this_transfer = transaction->xfersize;
|
|
|
+ }
|
|
|
+ /* Figure out how many bytes were in the last packet of the transfer */
|
|
|
+ if (packets_processed)
|
|
|
+ bytes_in_last_packet = bytes_this_transfer - (packets_processed-1) * usbc_hcchar.s.mps;
|
|
|
+ else
|
|
|
+ bytes_in_last_packet = bytes_this_transfer;
|
|
|
+
|
|
|
+ /* As a special case, setup transactions output the setup header, not
|
|
|
+ the user's data. For this reason we don't count setup data as bytes
|
|
|
+ transferred */
|
|
|
+ if ((transaction->stage == CVMX_USB_STAGE_SETUP) ||
|
|
|
+ (transaction->stage == CVMX_USB_STAGE_SETUP_SPLIT_COMPLETE))
|
|
|
+ bytes_this_transfer = 0;
|
|
|
+
|
|
|
+ /* Optional debug output */
|
|
|
+ if (cvmx_unlikely((usb->init_flags & CVMX_USB_INITIALIZE_FLAGS_DEBUG_TRANSFERS) ||
|
|
|
+ (pipe->flags & CVMX_USB_PIPE_FLAGS_DEBUG_TRANSFERS)))
|
|
|
+ cvmx_dprintf("%s: Channel %d halted. Pipe %d transaction %d stage %d bytes=%d\n",
|
|
|
+ __FUNCTION__, channel,
|
|
|
+ __cvmx_usb_get_pipe_handle(usb, pipe),
|
|
|
+ __cvmx_usb_get_submit_handle(usb, transaction),
|
|
|
+ transaction->stage, bytes_this_transfer);
|
|
|
+
|
|
|
+ /* Add the bytes transferred to the running total. It is important that
|
|
|
+ bytes_this_transfer doesn't count any data that needs to be
|
|
|
+ retransmitted */
|
|
|
+ transaction->actual_bytes += bytes_this_transfer;
|
|
|
+ if (transaction->type == CVMX_USB_TRANSFER_ISOCHRONOUS)
|
|
|
+ buffer_space_left = transaction->iso_packets[0].length - transaction->actual_bytes;
|
|
|
+ else
|
|
|
+ buffer_space_left = transaction->buffer_length - transaction->actual_bytes;
|
|
|
+
|
|
|
+ /* We need to remember the PID toggle state for the next transaction. The
|
|
|
+ hardware already updated it for the next transaction */
|
|
|
+ pipe->pid_toggle = !(usbc_hctsiz.s.pid == 0);
|
|
|
+
|
|
|
+ /* For high speed bulk out, assume the next transaction will need to do a
|
|
|
+ ping before proceeding. If this isn't true the ACK processing below
|
|
|
+ will clear this flag */
|
|
|
+ if ((pipe->device_speed == CVMX_USB_SPEED_HIGH) &&
|
|
|
+ (pipe->transfer_type == CVMX_USB_TRANSFER_BULK) &&
|
|
|
+ (pipe->transfer_dir == CVMX_USB_DIRECTION_OUT))
|
|
|
+ pipe->flags |= __CVMX_USB_PIPE_FLAGS_NEED_PING;
|
|
|
+
|
|
|
+ if (usbc_hcint.s.stall)
|
|
|
+ {
|
|
|
+ /* STALL as a response means this transaction cannot be completed
|
|
|
+ because the device can't process transactions. Tell the user. Any
|
|
|
+ data that was transferred will be counted on the actual bytes
|
|
|
+ transferred */
|
|
|
+ pipe->pid_toggle = 0;
|
|
|
+ __cvmx_usb_perform_complete(usb, pipe, transaction, CVMX_USB_COMPLETE_STALL);
|
|
|
+ }
|
|
|
+ else if (usbc_hcint.s.xacterr)
|
|
|
+ {
|
|
|
+ /* We know at least one packet worked if we get a ACK or NAK. Reset the retry counter */
|
|
|
+ if (usbc_hcint.s.nak || usbc_hcint.s.ack)
|
|
|
+ transaction->retries = 0;
|
|
|
+ transaction->retries++;
|
|
|
+ if (transaction->retries > MAX_RETRIES)
|
|
|
+ {
|
|
|
+ /* XactErr as a response means the device signaled something wrong with
|
|
|
+ the transfer. For example, PID toggle errors cause these */
|
|
|
+ __cvmx_usb_perform_complete(usb, pipe, transaction, CVMX_USB_COMPLETE_XACTERR);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ /* If this was a split then clear our split in progress marker */
|
|
|
+ if (usb->active_split == transaction)
|
|
|
+ usb->active_split = NULL;
|
|
|
+ /* Rewind to the beginning of the transaction by anding off the
|
|
|
+ split complete bit */
|
|
|
+ transaction->stage &= ~1;
|
|
|
+ pipe->split_sc_frame = -1;
|
|
|
+ pipe->next_tx_frame += pipe->interval;
|
|
|
+ if (pipe->next_tx_frame < usb->frame_number)
|
|
|
+ pipe->next_tx_frame = usb->frame_number + pipe->interval -
|
|
|
+ (usb->frame_number - pipe->next_tx_frame) % pipe->interval;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else if (usbc_hcint.s.bblerr)
|
|
|
+ {
|
|
|
+ /* Babble Error (BblErr) */
|
|
|
+ __cvmx_usb_perform_complete(usb, pipe, transaction, CVMX_USB_COMPLETE_BABBLEERR);
|
|
|
+ }
|
|
|
+ else if (usbc_hcint.s.datatglerr)
|
|
|
+ {
|
|
|
+ /* We'll retry the exact same transaction again */
|
|
|
+ transaction->retries++;
|
|
|
+ }
|
|
|
+ else if (usbc_hcint.s.nyet)
|
|
|
+ {
|
|
|
+ /* NYET as a response is only allowed in three cases: as a response to
|
|
|
+ a ping, as a response to a split transaction, and as a response to
|
|
|
+ a bulk out. The ping case is handled by hardware, so we only have
|
|
|
+ splits and bulk out */
|
|
|
+ if (!__cvmx_usb_pipe_needs_split(usb, pipe))
|
|
|
+ {
|
|
|
+ transaction->retries = 0;
|
|
|
+ /* If there is more data to go then we need to try again. Otherwise
|
|
|
+ this transaction is complete */
|
|
|
+ if ((buffer_space_left == 0) || (bytes_in_last_packet < pipe->max_packet))
|
|
|
+ __cvmx_usb_perform_complete(usb, pipe, transaction, CVMX_USB_COMPLETE_SUCCESS);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ /* Split transactions retry the split complete 4 times then rewind
|
|
|
+ to the start split and do the entire transactions again */
|
|
|
+ transaction->retries++;
|
|
|
+ if ((transaction->retries & 0x3) == 0)
|
|
|
+ {
|
|
|
+ /* Rewind to the beginning of the transaction by anding off the
|
|
|
+ split complete bit */
|
|
|
+ transaction->stage &= ~1;
|
|
|
+ pipe->split_sc_frame = -1;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else if (usbc_hcint.s.ack)
|
|
|
+ {
|
|
|
+ transaction->retries = 0;
|
|
|
+ /* The ACK bit can only be checked after the other error bits. This is
|
|
|
+ because a multi packet transfer may succeed in a number of packets
|
|
|
+ and then get a different response on the last packet. In this case
|
|
|
+ both ACK and the last response bit will be set. If none of the
|
|
|
+ other response bits is set, then the last packet must have been an
|
|
|
+ ACK */
|
|
|
+
|
|
|
+ /* Since we got an ACK, we know we don't need to do a ping on this
|
|
|
+ pipe */
|
|
|
+ pipe->flags &= ~__CVMX_USB_PIPE_FLAGS_NEED_PING;
|
|
|
+
|
|
|
+ switch (transaction->type)
|
|
|
+ {
|
|
|
+ case CVMX_USB_TRANSFER_CONTROL:
|
|
|
+ switch (transaction->stage)
|
|
|
+ {
|
|
|
+ case CVMX_USB_STAGE_NON_CONTROL:
|
|
|
+ case CVMX_USB_STAGE_NON_CONTROL_SPLIT_COMPLETE:
|
|
|
+ /* This should be impossible */
|
|
|
+ __cvmx_usb_perform_complete(usb, pipe, transaction, CVMX_USB_COMPLETE_ERROR);
|
|
|
+ break;
|
|
|
+ case CVMX_USB_STAGE_SETUP:
|
|
|
+ pipe->pid_toggle = 1;
|
|
|
+ if (__cvmx_usb_pipe_needs_split(usb, pipe))
|
|
|
+ transaction->stage = CVMX_USB_STAGE_SETUP_SPLIT_COMPLETE;
|
|
|
+ else
|
|
|
+ {
|
|
|
+ cvmx_usb_control_header_t *header = cvmx_phys_to_ptr(transaction->control_header);
|
|
|
+ if (header->s.length)
|
|
|
+ transaction->stage = CVMX_USB_STAGE_DATA;
|
|
|
+ else
|
|
|
+ transaction->stage = CVMX_USB_STAGE_STATUS;
|
|
|
+ }
|
|
|
+ break;
|
|
|
+ case CVMX_USB_STAGE_SETUP_SPLIT_COMPLETE:
|
|
|
+ {
|
|
|
+ cvmx_usb_control_header_t *header = cvmx_phys_to_ptr(transaction->control_header);
|
|
|
+ if (header->s.length)
|
|
|
+ transaction->stage = CVMX_USB_STAGE_DATA;
|
|
|
+ else
|
|
|
+ transaction->stage = CVMX_USB_STAGE_STATUS;
|
|
|
+ }
|
|
|
+ break;
|
|
|
+ case CVMX_USB_STAGE_DATA:
|
|
|
+ if (__cvmx_usb_pipe_needs_split(usb, pipe))
|
|
|
+ {
|
|
|
+ transaction->stage = CVMX_USB_STAGE_DATA_SPLIT_COMPLETE;
|
|
|
+ /* For setup OUT data that are splits, the hardware
|
|
|
+ doesn't appear to count transferred data. Here
|
|
|
+ we manually update the data transferred */
|
|
|
+ if (!usbc_hcchar.s.epdir)
|
|
|
+ {
|
|
|
+ if (buffer_space_left < pipe->max_packet)
|
|
|
+ transaction->actual_bytes += buffer_space_left;
|
|
|
+ else
|
|
|
+ transaction->actual_bytes += pipe->max_packet;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else if ((buffer_space_left == 0) || (bytes_in_last_packet < pipe->max_packet))
|
|
|
+ {
|
|
|
+ pipe->pid_toggle = 1;
|
|
|
+ transaction->stage = CVMX_USB_STAGE_STATUS;
|
|
|
+ }
|
|
|
+ break;
|
|
|
+ case CVMX_USB_STAGE_DATA_SPLIT_COMPLETE:
|
|
|
+ if ((buffer_space_left == 0) || (bytes_in_last_packet < pipe->max_packet))
|
|
|
+ {
|
|
|
+ pipe->pid_toggle = 1;
|
|
|
+ transaction->stage = CVMX_USB_STAGE_STATUS;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ transaction->stage = CVMX_USB_STAGE_DATA;
|
|
|
+ }
|
|
|
+ break;
|
|
|
+ case CVMX_USB_STAGE_STATUS:
|
|
|
+ if (__cvmx_usb_pipe_needs_split(usb, pipe))
|
|
|
+ transaction->stage = CVMX_USB_STAGE_STATUS_SPLIT_COMPLETE;
|
|
|
+ else
|
|
|
+ __cvmx_usb_perform_complete(usb, pipe, transaction, CVMX_USB_COMPLETE_SUCCESS);
|
|
|
+ break;
|
|
|
+ case CVMX_USB_STAGE_STATUS_SPLIT_COMPLETE:
|
|
|
+ __cvmx_usb_perform_complete(usb, pipe, transaction, CVMX_USB_COMPLETE_SUCCESS);
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ break;
|
|
|
+ case CVMX_USB_TRANSFER_BULK:
|
|
|
+ case CVMX_USB_TRANSFER_INTERRUPT:
|
|
|
+ /* The only time a bulk transfer isn't complete when
|
|
|
+ it finishes with an ACK is during a split transaction. For
|
|
|
+ splits we need to continue the transfer if more data is
|
|
|
+ needed */
|
|
|
+ if (__cvmx_usb_pipe_needs_split(usb, pipe))
|
|
|
+ {
|
|
|
+ if (transaction->stage == CVMX_USB_STAGE_NON_CONTROL)
|
|
|
+ transaction->stage = CVMX_USB_STAGE_NON_CONTROL_SPLIT_COMPLETE;
|
|
|
+ else
|
|
|
+ {
|
|
|
+ if (buffer_space_left && (bytes_in_last_packet == pipe->max_packet))
|
|
|
+ transaction->stage = CVMX_USB_STAGE_NON_CONTROL;
|
|
|
+ else
|
|
|
+ {
|
|
|
+ if (transaction->type == CVMX_USB_TRANSFER_INTERRUPT)
|
|
|
+ pipe->next_tx_frame += pipe->interval;
|
|
|
+ __cvmx_usb_perform_complete(usb, pipe, transaction, CVMX_USB_COMPLETE_SUCCESS);
|
|
|
+ }
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ if ((pipe->device_speed == CVMX_USB_SPEED_HIGH) &&
|
|
|
+ (pipe->transfer_type == CVMX_USB_TRANSFER_BULK) &&
|
|
|
+ (pipe->transfer_dir == CVMX_USB_DIRECTION_OUT) &&
|
|
|
+ (usbc_hcint.s.nak))
|
|
|
+ pipe->flags |= __CVMX_USB_PIPE_FLAGS_NEED_PING;
|
|
|
+ if (!buffer_space_left || (bytes_in_last_packet < pipe->max_packet))
|
|
|
+ {
|
|
|
+ if (transaction->type == CVMX_USB_TRANSFER_INTERRUPT)
|
|
|
+ pipe->next_tx_frame += pipe->interval;
|
|
|
+ __cvmx_usb_perform_complete(usb, pipe, transaction, CVMX_USB_COMPLETE_SUCCESS);
|
|
|
+ }
|
|
|
+ }
|
|
|
+ break;
|
|
|
+ case CVMX_USB_TRANSFER_ISOCHRONOUS:
|
|
|
+ if (__cvmx_usb_pipe_needs_split(usb, pipe))
|
|
|
+ {
|
|
|
+ /* ISOCHRONOUS OUT splits don't require a complete split stage.
|
|
|
+ Instead they use a sequence of begin OUT splits to transfer
|
|
|
+ the data 188 bytes at a time. Once the transfer is complete,
|
|
|
+ the pipe sleeps until the next schedule interval */
|
|
|
+ if (pipe->transfer_dir == CVMX_USB_DIRECTION_OUT)
|
|
|
+ {
|
|
|
+ /* If no space left or this wasn't a max size packet then
|
|
|
+ this transfer is complete. Otherwise start it again
|
|
|
+ to send the next 188 bytes */
|
|
|
+ if (!buffer_space_left || (bytes_this_transfer < 188))
|
|
|
+ {
|
|
|
+ pipe->next_tx_frame += pipe->interval;
|
|
|
+ __cvmx_usb_perform_complete(usb, pipe, transaction, CVMX_USB_COMPLETE_SUCCESS);
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ if (transaction->stage == CVMX_USB_STAGE_NON_CONTROL_SPLIT_COMPLETE)
|
|
|
+ {
|
|
|
+ /* We are in the incoming data phase. Keep getting
|
|
|
+ data until we run out of space or get a small
|
|
|
+ packet */
|
|
|
+ if ((buffer_space_left == 0) || (bytes_in_last_packet < pipe->max_packet))
|
|
|
+ {
|
|
|
+ pipe->next_tx_frame += pipe->interval;
|
|
|
+ __cvmx_usb_perform_complete(usb, pipe, transaction, CVMX_USB_COMPLETE_SUCCESS);
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else
|
|
|
+ transaction->stage = CVMX_USB_STAGE_NON_CONTROL_SPLIT_COMPLETE;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ pipe->next_tx_frame += pipe->interval;
|
|
|
+ __cvmx_usb_perform_complete(usb, pipe, transaction, CVMX_USB_COMPLETE_SUCCESS);
|
|
|
+ }
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else if (usbc_hcint.s.nak)
|
|
|
+ {
|
|
|
+ /* If this was a split then clear our split in progress marker */
|
|
|
+ if (usb->active_split == transaction)
|
|
|
+ usb->active_split = NULL;
|
|
|
+ /* NAK as a response means the device couldn't accept the transaction,
|
|
|
+ but it should be retried in the future. Rewind to the beginning of
|
|
|
+ the transaction by anding off the split complete bit. Retry in the
|
|
|
+ next interval */
|
|
|
+ transaction->retries = 0;
|
|
|
+ transaction->stage &= ~1;
|
|
|
+ pipe->next_tx_frame += pipe->interval;
|
|
|
+ if (pipe->next_tx_frame < usb->frame_number)
|
|
|
+ pipe->next_tx_frame = usb->frame_number + pipe->interval -
|
|
|
+ (usb->frame_number - pipe->next_tx_frame) % pipe->interval;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ cvmx_usb_port_status_t port;
|
|
|
+ port = cvmx_usb_get_status((cvmx_usb_state_t *)usb);
|
|
|
+ if (port.port_enabled)
|
|
|
+ {
|
|
|
+ /* We'll retry the exact same transaction again */
|
|
|
+ transaction->retries++;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ /* We get channel halted interrupts with no result bits sets when the
|
|
|
+ cable is unplugged */
|
|
|
+ __cvmx_usb_perform_complete(usb, pipe, transaction, CVMX_USB_COMPLETE_ERROR);
|
|
|
+ }
|
|
|
+ }
|
|
|
+ CVMX_USB_RETURN(0);
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+/**
|
|
|
+ * Poll the USB block for status and call all needed callback
|
|
|
+ * handlers. This function is meant to be called in the interrupt
|
|
|
+ * handler for the USB controller. It can also be called
|
|
|
+ * periodically in a loop for non-interrupt based operation.
|
|
|
+ *
|
|
|
+ * @param state USB device state populated by
|
|
|
+ * cvmx_usb_initialize().
|
|
|
+ *
|
|
|
+ * @return CVMX_USB_SUCCESS or a negative error code defined in
|
|
|
+ * cvmx_usb_status_t.
|
|
|
+ */
|
|
|
+cvmx_usb_status_t cvmx_usb_poll(cvmx_usb_state_t *state)
|
|
|
+{
|
|
|
+ cvmx_usbcx_hfnum_t usbc_hfnum;
|
|
|
+ cvmx_usbcx_gintsts_t usbc_gintsts;
|
|
|
+ cvmx_usb_internal_state_t *usb = (cvmx_usb_internal_state_t*)state;
|
|
|
+
|
|
|
+ CVMX_PREFETCH(usb, 0);
|
|
|
+ CVMX_PREFETCH(usb, 1*128);
|
|
|
+ CVMX_PREFETCH(usb, 2*128);
|
|
|
+ CVMX_PREFETCH(usb, 3*128);
|
|
|
+ CVMX_PREFETCH(usb, 4*128);
|
|
|
+
|
|
|
+ CVMX_USB_LOG_CALLED();
|
|
|
+ CVMX_USB_LOG_PARAM("%p", state);
|
|
|
+
|
|
|
+ /* Update the frame counter */
|
|
|
+ usbc_hfnum.u32 = __cvmx_usb_read_csr32(usb, CVMX_USBCX_HFNUM(usb->index));
|
|
|
+ if ((usb->frame_number&0x3fff) > usbc_hfnum.s.frnum)
|
|
|
+ usb->frame_number += 0x4000;
|
|
|
+ usb->frame_number &= ~0x3fffull;
|
|
|
+ usb->frame_number |= usbc_hfnum.s.frnum;
|
|
|
+
|
|
|
+ /* Read the pending interrupts */
|
|
|
+ usbc_gintsts.u32 = __cvmx_usb_read_csr32(usb, CVMX_USBCX_GINTSTS(usb->index));
|
|
|
+
|
|
|
+ /* Clear the interrupts now that we know about them */
|
|
|
+ __cvmx_usb_write_csr32(usb, CVMX_USBCX_GINTSTS(usb->index), usbc_gintsts.u32);
|
|
|
+
|
|
|
+ if (usbc_gintsts.s.rxflvl)
|
|
|
+ {
|
|
|
+ /* RxFIFO Non-Empty (RxFLvl)
|
|
|
+ Indicates that there is at least one packet pending to be read
|
|
|
+ from the RxFIFO. */
|
|
|
+ /* In DMA mode this is handled by hardware */
|
|
|
+ if (usb->init_flags & CVMX_USB_INITIALIZE_FLAGS_NO_DMA)
|
|
|
+ __cvmx_usb_poll_rx_fifo(usb);
|
|
|
+ }
|
|
|
+ if (usbc_gintsts.s.ptxfemp || usbc_gintsts.s.nptxfemp)
|
|
|
+ {
|
|
|
+ /* Fill the Tx FIFOs when not in DMA mode */
|
|
|
+ if (usb->init_flags & CVMX_USB_INITIALIZE_FLAGS_NO_DMA)
|
|
|
+ __cvmx_usb_poll_tx_fifo(usb);
|
|
|
+ }
|
|
|
+ if (usbc_gintsts.s.disconnint || usbc_gintsts.s.prtint)
|
|
|
+ {
|
|
|
+ cvmx_usbcx_hprt_t usbc_hprt;
|
|
|
+ /* Disconnect Detected Interrupt (DisconnInt)
|
|
|
+ Asserted when a device disconnect is detected. */
|
|
|
+
|
|
|
+ /* Host Port Interrupt (PrtInt)
|
|
|
+ The core sets this bit to indicate a change in port status of one
|
|
|
+ of the O2P USB core ports in Host mode. The application must
|
|
|
+ read the Host Port Control and Status (HPRT) register to
|
|
|
+ determine the exact event that caused this interrupt. The
|
|
|
+ application must clear the appropriate status bit in the Host Port
|
|
|
+ Control and Status register to clear this bit. */
|
|
|
+
|
|
|
+ /* Call the user's port callback */
|
|
|
+ __cvmx_usb_perform_callback(usb, NULL, NULL,
|
|
|
+ CVMX_USB_CALLBACK_PORT_CHANGED,
|
|
|
+ CVMX_USB_COMPLETE_SUCCESS);
|
|
|
+ /* Clear the port change bits */
|
|
|
+ usbc_hprt.u32 = __cvmx_usb_read_csr32(usb, CVMX_USBCX_HPRT(usb->index));
|
|
|
+ usbc_hprt.s.prtena = 0;
|
|
|
+ __cvmx_usb_write_csr32(usb, CVMX_USBCX_HPRT(usb->index), usbc_hprt.u32);
|
|
|
+ }
|
|
|
+ if (usbc_gintsts.s.hchint)
|
|
|
+ {
|
|
|
+ /* Host Channels Interrupt (HChInt)
|
|
|
+ The core sets this bit to indicate that an interrupt is pending on
|
|
|
+ one of the channels of the core (in Host mode). The application
|
|
|
+ must read the Host All Channels Interrupt (HAINT) register to
|
|
|
+ determine the exact number of the channel on which the
|
|
|
+ interrupt occurred, and then read the corresponding Host
|
|
|
+ Channel-n Interrupt (HCINTn) register to determine the exact
|
|
|
+ cause of the interrupt. The application must clear the
|
|
|
+ appropriate status bit in the HCINTn register to clear this bit. */
|
|
|
+ cvmx_usbcx_haint_t usbc_haint;
|
|
|
+ usbc_haint.u32 = __cvmx_usb_read_csr32(usb, CVMX_USBCX_HAINT(usb->index));
|
|
|
+ while (usbc_haint.u32)
|
|
|
+ {
|
|
|
+ int channel;
|
|
|
+ CVMX_CLZ(channel, usbc_haint.u32);
|
|
|
+ channel = 31 - channel;
|
|
|
+ __cvmx_usb_poll_channel(usb, channel);
|
|
|
+ usbc_haint.u32 ^= 1<<channel;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ __cvmx_usb_schedule(usb, usbc_gintsts.s.sof);
|
|
|
+
|
|
|
+ CVMX_USB_RETURN(CVMX_USB_SUCCESS);
|
|
|
+}
|
Aaro Koskinen