XTouch-djay-bridge - X-TOUCH to djay bridge

Users » okini3939 » Code » XTouch-djay-bridge

Suga koubou / Mbed 2 deprecated XTouch-djay-bridge

X-TOUCH to djay bridge

Dependencies: mbed mbed-rtos FATFileSystem

USBHost/targets/TARGET_RENESAS/TARGET_RZ_A1H/ohci_wrapp_RZ_A1.c@1:0dac72ab5910, 2019-06-05 (annotated)

Committer:: okini3939
Date:: Wed Jun 05 04:54:37 2019 +0000
Revision:: 1:0dac72ab5910

sample

Who changed what in which revision?

User	Revision	Line number	New contents of line
okini3939	1:0dac72ab5910	1	/* Copyright (c) 2010-2011 mbed.org, MIT License
okini3939	1:0dac72ab5910	2	*
okini3939	1:0dac72ab5910	3	* Permission is hereby granted, free of charge, to any person obtaining a copy of this software
okini3939	1:0dac72ab5910	4	* and associated documentation files (the "Software"), to deal in the Software without
okini3939	1:0dac72ab5910	5	* restriction, including without limitation the rights to use, copy, modify, merge, publish,
okini3939	1:0dac72ab5910	6	* distribute, sublicense, and/or sell copies of the Software, and to permit persons to whom the
okini3939	1:0dac72ab5910	7	* Software is furnished to do so, subject to the following conditions:
okini3939	1:0dac72ab5910	8	*
okini3939	1:0dac72ab5910	9	* The above copyright notice and this permission notice shall be included in all copies or
okini3939	1:0dac72ab5910	10	* substantial portions of the Software.
okini3939	1:0dac72ab5910	11	*
okini3939	1:0dac72ab5910	12	* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING
okini3939	1:0dac72ab5910	13	* BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
okini3939	1:0dac72ab5910	14	* NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,
okini3939	1:0dac72ab5910	15	* DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
okini3939	1:0dac72ab5910	16	* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
okini3939	1:0dac72ab5910	17	*/
okini3939	1:0dac72ab5910	18
okini3939	1:0dac72ab5910	19	#include <string.h>
okini3939	1:0dac72ab5910	20	#include "cmsis.h"
okini3939	1:0dac72ab5910	21	#include "cmsis_os.h"
okini3939	1:0dac72ab5910	22	#include "ohci_wrapp_RZ_A1.h"
okini3939	1:0dac72ab5910	23	#include "ohci_wrapp_RZ_A1_local.h"
okini3939	1:0dac72ab5910	24	#include "rza_io_regrw.h"
okini3939	1:0dac72ab5910	25	#include "usb_host_setting.h"
okini3939	1:0dac72ab5910	26
okini3939	1:0dac72ab5910	27	/* ------------------ HcControl Register --------------------- */
okini3939	1:0dac72ab5910	28	#define OR_CONTROL_PLE (0x00000004)
okini3939	1:0dac72ab5910	29	#define OR_CONTROL_IE (0x00000008)
okini3939	1:0dac72ab5910	30	#define OR_CONTROL_CLE (0x00000010)
okini3939	1:0dac72ab5910	31	#define OR_CONTROL_BLE (0x00000020)
okini3939	1:0dac72ab5910	32	/* ----------------- HcCommandStatus Register ----------------- */
okini3939	1:0dac72ab5910	33	#define OR_CMD_STATUS_HCR (0x00000001)
okini3939	1:0dac72ab5910	34	#define OR_CMD_STATUS_CLF (0x00000002)
okini3939	1:0dac72ab5910	35	#define OR_CMD_STATUS_BLF (0x00000004)
okini3939	1:0dac72ab5910	36	#define OR_CMD_STATUS_OCR (0x00000008)
okini3939	1:0dac72ab5910	37	/* --------------- HcInterruptStatus Register ----------------- */
okini3939	1:0dac72ab5910	38	#define OR_INTR_STATUS_WDH (0x00000002)
okini3939	1:0dac72ab5910	39	#define OR_INTR_STATUS_RHSC (0x00000040)
okini3939	1:0dac72ab5910	40	/* --------------- HcInterruptEnable Register ----------------- */
okini3939	1:0dac72ab5910	41	#define OR_INTR_ENABLE_WDH (0x00000002)
okini3939	1:0dac72ab5910	42	#define OR_INTR_ENABLE_RHSC (0x00000040)
okini3939	1:0dac72ab5910	43	/* -------------- HcRhPortStatus[1:NDP] Register -------------- */
okini3939	1:0dac72ab5910	44	#define OR_RH_PORT_CSC (0x00010000)
okini3939	1:0dac72ab5910	45	#define OR_RH_PORT_LSDA (0x00000200)
okini3939	1:0dac72ab5910	46	#define OR_RH_PORT_PRS (0x00000010)
okini3939	1:0dac72ab5910	47	#define OR_RH_PORT_POCI (0x00000008)
okini3939	1:0dac72ab5910	48	#define OR_RH_PORT_CCS (0x00000001)
okini3939	1:0dac72ab5910	49
okini3939	1:0dac72ab5910	50	#define ED_FORMAT (0x00008000) /* Format */
okini3939	1:0dac72ab5910	51	#define ED_SKIP (0x00004000) /* Skip this ep in queue */
okini3939	1:0dac72ab5910	52	#define ED_TOGLE_CARRY (0x00000002)
okini3939	1:0dac72ab5910	53	#define ED_HALTED (0x00000001)
okini3939	1:0dac72ab5910	54
okini3939	1:0dac72ab5910	55	#define TD_SETUP (0x00000000) /* Direction of Setup Packet */
okini3939	1:0dac72ab5910	56	#define TD_OUT (0x00080000) /* Direction Out */
okini3939	1:0dac72ab5910	57	#define TD_TOGGLE_0 (0x02000000) /* Toggle 0 */
okini3939	1:0dac72ab5910	58	#define TD_TOGGLE_1 (0x03000000) /* Toggle 1 */
okini3939	1:0dac72ab5910	59
okini3939	1:0dac72ab5910	60	/* -------------- USB Standard Requests -------------- */
okini3939	1:0dac72ab5910	61	#define GET_STATUS (0x00)
okini3939	1:0dac72ab5910	62	#define SET_FEATURE (0x03)
okini3939	1:0dac72ab5910	63	#define SET_ADDRESS (0x05)
okini3939	1:0dac72ab5910	64
okini3939	1:0dac72ab5910	65	#define TD_CTL_MSK_DP (0x00180000)
okini3939	1:0dac72ab5910	66	#define TD_CTL_MSK_T (0x03000000)
okini3939	1:0dac72ab5910	67	#define TD_CTL_MSK_CC (0xF0000000)
okini3939	1:0dac72ab5910	68	#define TD_CTL_MSK_EC (0x0C000000)
okini3939	1:0dac72ab5910	69	#define TD_CTL_SHFT_CC (28)
okini3939	1:0dac72ab5910	70	#define TD_CTL_SHFT_EC (26)
okini3939	1:0dac72ab5910	71	#define TD_CTL_SHFT_T (24)
okini3939	1:0dac72ab5910	72	#define ED_SHFT_TOGLE_CARRY (1)
okini3939	1:0dac72ab5910	73	#define SIG_GEN_LIST_REQ (1)
okini3939	1:0dac72ab5910	74	#if (ISO_TRANS_MAX_NUM > 0)
okini3939	1:0dac72ab5910	75	#define TD_PSW_MSK_CC (0xF000)
okini3939	1:0dac72ab5910	76	#define TD_PSW_SHFT_CC (12)
okini3939	1:0dac72ab5910	77	#define TD_CTL_MSK_FC (0x07000000)
okini3939	1:0dac72ab5910	78	#define TD_CTL_SHFT_FC (24)
okini3939	1:0dac72ab5910	79	#endif
okini3939	1:0dac72ab5910	80
okini3939	1:0dac72ab5910	81	#define CTL_TRANS_TIMEOUT (1000)
okini3939	1:0dac72ab5910	82	#define BLK_TRANS_TIMEOUT (5)
okini3939	1:0dac72ab5910	83	#define TOTAL_SEM_NUM (5 + (2 * INT_TRANS_MAX_NUM) + (2 * ISO_TRANS_MAX_NUM))
okini3939	1:0dac72ab5910	84
okini3939	1:0dac72ab5910	85	#define PORT_LOW_SPEED (0x00000200)
okini3939	1:0dac72ab5910	86	#define PORT_HIGH_SPEED (0x00000400)
okini3939	1:0dac72ab5910	87	#define PORT_NUM (16 + 1) /* num + root(1) */
okini3939	1:0dac72ab5910	88
okini3939	1:0dac72ab5910	89	typedef struct tag_hctd {
okini3939	1:0dac72ab5910	90	uint32_t control; /* Transfer descriptor control */
okini3939	1:0dac72ab5910	91	uint8_t currBufPtr; / Physical address of current buffer pointer */
okini3939	1:0dac72ab5910	92	struct tag_hctd nextTD; / Physical pointer to next Transfer Descriptor */
okini3939	1:0dac72ab5910	93	uint8_t bufEnd; / Physical address of end of buffer */
okini3939	1:0dac72ab5910	94	} hctd_t;
okini3939	1:0dac72ab5910	95
okini3939	1:0dac72ab5910	96	#if (ISO_TRANS_MAX_NUM > 0)
okini3939	1:0dac72ab5910	97	#define PSW_NUM (8)
okini3939	1:0dac72ab5910	98	typedef struct tag_hcisotd {
okini3939	1:0dac72ab5910	99	uint32_t control; /* Transfer descriptor control */
okini3939	1:0dac72ab5910	100	uint8_t bufferPage0; / Buffer Page 0 */
okini3939	1:0dac72ab5910	101	struct tag_hcisotd nextTD; / Physical pointer to next Transfer Descriptor */
okini3939	1:0dac72ab5910	102	uint8_t bufEnd; / Physical address of end of buffer */
okini3939	1:0dac72ab5910	103	uint16_t offsetPSW[PSW_NUM]; /* Offset/PSW */
okini3939	1:0dac72ab5910	104	} hcisotd_t;
okini3939	1:0dac72ab5910	105	#endif
okini3939	1:0dac72ab5910	106
okini3939	1:0dac72ab5910	107	typedef struct tag_hced {
okini3939	1:0dac72ab5910	108	uint32_t control; /* Endpoint descriptor control */
okini3939	1:0dac72ab5910	109	uint32_t tailTD; /* Physical address of tail in Transfer descriptor list */
okini3939	1:0dac72ab5910	110	uint32_t headTD; /* Physcial address of head in Transfer descriptor list */
okini3939	1:0dac72ab5910	111	struct tag_hced nextED; / Physical address of next Endpoint descriptor */
okini3939	1:0dac72ab5910	112	} hced_t;
okini3939	1:0dac72ab5910	113
okini3939	1:0dac72ab5910	114	typedef struct tag_hcca {
okini3939	1:0dac72ab5910	115	uint32_t IntTable[32]; /* Interrupt Table */
okini3939	1:0dac72ab5910	116	uint32_t FrameNumber; /* Frame Number */
okini3939	1:0dac72ab5910	117	uint32_t DoneHead; /* Done Head */
okini3939	1:0dac72ab5910	118	volatile uint8_t Reserved[116]; /* Reserved for future use */
okini3939	1:0dac72ab5910	119	volatile uint8_t Unknown[4]; /* Unused */
okini3939	1:0dac72ab5910	120	} hcca_t;
okini3939	1:0dac72ab5910	121
okini3939	1:0dac72ab5910	122	typedef struct tag_usb_ohci_reg {
okini3939	1:0dac72ab5910	123	volatile uint32_t HcRevision;
okini3939	1:0dac72ab5910	124	volatile uint32_t HcControl;
okini3939	1:0dac72ab5910	125	volatile uint32_t HcCommandStatus;
okini3939	1:0dac72ab5910	126	volatile uint32_t HcInterruptStatus;
okini3939	1:0dac72ab5910	127	volatile uint32_t HcInterruptEnable;
okini3939	1:0dac72ab5910	128	volatile uint32_t HcInterruptDisable;
okini3939	1:0dac72ab5910	129	volatile uint32_t HcHCCA;
okini3939	1:0dac72ab5910	130	volatile uint32_t HcPeriodCurrentED;
okini3939	1:0dac72ab5910	131	volatile uint32_t HcControlHeadED;
okini3939	1:0dac72ab5910	132	volatile uint32_t HcControlCurrentED;
okini3939	1:0dac72ab5910	133	volatile uint32_t HcBulkHeadED;
okini3939	1:0dac72ab5910	134	volatile uint32_t HcBulkCurrentED;
okini3939	1:0dac72ab5910	135	volatile uint32_t HcDoneHead;
okini3939	1:0dac72ab5910	136	volatile uint32_t HcFmInterval;
okini3939	1:0dac72ab5910	137	volatile uint32_t HcFmRemaining;
okini3939	1:0dac72ab5910	138	volatile uint32_t HcFmNumber;
okini3939	1:0dac72ab5910	139	volatile uint32_t HcPeriodicStart;
okini3939	1:0dac72ab5910	140	volatile uint32_t HcLSThreshold;
okini3939	1:0dac72ab5910	141	volatile uint32_t HcRhDescriptorA;
okini3939	1:0dac72ab5910	142	volatile uint32_t HcRhDescriptorB;
okini3939	1:0dac72ab5910	143	volatile uint32_t HcRhStatus;
okini3939	1:0dac72ab5910	144	volatile uint32_t HcRhPortStatus1;
okini3939	1:0dac72ab5910	145	} usb_ohci_reg_t;
okini3939	1:0dac72ab5910	146
okini3939	1:0dac72ab5910	147	typedef struct tag_genelal_ed {
okini3939	1:0dac72ab5910	148	osThreadId tskid;
okini3939	1:0dac72ab5910	149	osSemaphoreId semid_wait;
okini3939	1:0dac72ab5910	150	osSemaphoreId semid_list;
okini3939	1:0dac72ab5910	151	void p_curr_td; / pointer of hctd_t or hcisotd_t */
okini3939	1:0dac72ab5910	152	hced_t *p_curr_ed;
okini3939	1:0dac72ab5910	153	uint32_t pipe_no;
okini3939	1:0dac72ab5910	154	uint32_t trans_wait;
okini3939	1:0dac72ab5910	155	uint32_t cycle_time;
okini3939	1:0dac72ab5910	156	uint8_t *p_start_buf;
okini3939	1:0dac72ab5910	157	#if (ISO_TRANS_MAX_NUM > 0)
okini3939	1:0dac72ab5910	158	uint32_t psw_idx;
okini3939	1:0dac72ab5910	159	#endif
okini3939	1:0dac72ab5910	160	} genelal_ed_t;
okini3939	1:0dac72ab5910	161
okini3939	1:0dac72ab5910	162	typedef struct tag_tdinfo {
okini3939	1:0dac72ab5910	163	uint32_t count;
okini3939	1:0dac72ab5910	164	uint32_t direction;
okini3939	1:0dac72ab5910	165	uint32_t msp;
okini3939	1:0dac72ab5910	166	uint16_t devadr;
okini3939	1:0dac72ab5910	167	uint16_t speed; /* 1:Speed = Low */
okini3939	1:0dac72ab5910	168	uint8_t endpoint_no;
okini3939	1:0dac72ab5910	169	} tdinfo_t;
okini3939	1:0dac72ab5910	170
okini3939	1:0dac72ab5910	171	typedef struct tag_split_trans {
okini3939	1:0dac72ab5910	172	uint16_t root_devadr;
okini3939	1:0dac72ab5910	173	uint16_t get_port;
okini3939	1:0dac72ab5910	174	uint16_t port_speed;
okini3939	1:0dac72ab5910	175	uint16_t reset_port;
okini3939	1:0dac72ab5910	176	uint32_t seq_cnt;
okini3939	1:0dac72ab5910	177	uint32_t port_sts_bits[PORT_NUM];
okini3939	1:0dac72ab5910	178	} split_trans_t;
okini3939	1:0dac72ab5910	179
okini3939	1:0dac72ab5910	180	static void callback_task(void const * argument);
okini3939	1:0dac72ab5910	181	static void control_ed_task(void const * argument);
okini3939	1:0dac72ab5910	182	static void bulk_ed_task(void const * argument);
okini3939	1:0dac72ab5910	183	static void int_ed_task(void const * argument);
okini3939	1:0dac72ab5910	184	static int32_t int_trans_doing(hced_t *p_ed, uint32_t index);
okini3939	1:0dac72ab5910	185	static int32_t chk_genelal_ed(genelal_ed_t *p_g_ed);
okini3939	1:0dac72ab5910	186	static void chk_genelal_td_done(genelal_ed_t *p_g_ed);
okini3939	1:0dac72ab5910	187	static void chk_split_trans_setting(genelal_ed_t *p_g_ed);
okini3939	1:0dac72ab5910	188	static void set_split_trans_setting(void);
okini3939	1:0dac72ab5910	189	static void control_trans(genelal_ed_t *p_g_ed);
okini3939	1:0dac72ab5910	190	static void bulk_trans(genelal_ed_t *p_g_ed);
okini3939	1:0dac72ab5910	191	static void int_trans_setting(genelal_ed_t *p_g_ed, uint32_t index);
okini3939	1:0dac72ab5910	192	static uint32_t chk_cycle(hced_t *p_ed);
okini3939	1:0dac72ab5910	193	static void int_trans(genelal_ed_t *p_g_ed);
okini3939	1:0dac72ab5910	194	static void get_td_info(genelal_ed_t p_g_ed, tdinfo_t p_td_info);
okini3939	1:0dac72ab5910	195	static void set_togle(uint32_t pipe, hctd_t p_td, hced_t p_ed);
okini3939	1:0dac72ab5910	196	#if (ISO_TRANS_MAX_NUM > 0)
okini3939	1:0dac72ab5910	197	static void iso_ed_task(void const * argument);
okini3939	1:0dac72ab5910	198	static int32_t iso_trans_doing(hced_t *p_ed, uint32_t index);
okini3939	1:0dac72ab5910	199	static void chk_iso_td_done(genelal_ed_t *p_g_ed);
okini3939	1:0dac72ab5910	200	static int32_t chk_iso_ed(genelal_ed_t *p_g_ed);
okini3939	1:0dac72ab5910	201	static void iso_trans_setting(genelal_ed_t *p_g_ed, uint32_t index);
okini3939	1:0dac72ab5910	202	static void iso_trans(genelal_ed_t *p_g_ed);
okini3939	1:0dac72ab5910	203	#endif
okini3939	1:0dac72ab5910	204	static void connect_check(void);
okini3939	1:0dac72ab5910	205
okini3939	1:0dac72ab5910	206	extern USB_HOST_CFG_PIPETBL_t usb_host_blk_ep_tbl1[];
okini3939	1:0dac72ab5910	207	extern USB_HOST_CFG_PIPETBL_t usb_host_int_ep_tbl1[];
okini3939	1:0dac72ab5910	208	#if (ISO_TRANS_MAX_NUM > 0)
okini3939	1:0dac72ab5910	209	extern USB_HOST_CFG_PIPETBL_t usb_host_iso_ep_tbl1[];
okini3939	1:0dac72ab5910	210	#endif
okini3939	1:0dac72ab5910	211
okini3939	1:0dac72ab5910	212	static usb_ohci_reg_t usb_reg;
okini3939	1:0dac72ab5910	213	static usb_ohci_reg_t *p_usb_reg = &usb_reg;
okini3939	1:0dac72ab5910	214	static usbisr_fnc_t *p_usbisr_cb = NULL;
okini3939	1:0dac72ab5910	215	static osSemaphoreId semid_cb = NULL;
okini3939	1:0dac72ab5910	216	static uint32_t connect_change = 0xFFFFFFFF;
okini3939	1:0dac72ab5910	217	static uint32_t connect_status = 0;
okini3939	1:0dac72ab5910	218	static uint32_t init_end = 0;
okini3939	1:0dac72ab5910	219	static genelal_ed_t ctl_ed;
okini3939	1:0dac72ab5910	220	static genelal_ed_t blk_ed;
okini3939	1:0dac72ab5910	221	static genelal_ed_t int_ed[INT_TRANS_MAX_NUM];
okini3939	1:0dac72ab5910	222	static split_trans_t split_ctl;
okini3939	1:0dac72ab5910	223
okini3939	1:0dac72ab5910	224	#if (ISO_TRANS_MAX_NUM > 0)
okini3939	1:0dac72ab5910	225	static genelal_ed_t iso_ed[ISO_TRANS_MAX_NUM];
okini3939	1:0dac72ab5910	226	#endif
okini3939	1:0dac72ab5910	227
okini3939	1:0dac72ab5910	228	osSemaphoreDef(ohciwrapp_sem_01);
okini3939	1:0dac72ab5910	229	osSemaphoreDef(ohciwrapp_sem_02);
okini3939	1:0dac72ab5910	230	osSemaphoreDef(ohciwrapp_sem_03);
okini3939	1:0dac72ab5910	231	osSemaphoreDef(ohciwrapp_sem_04);
okini3939	1:0dac72ab5910	232	osSemaphoreDef(ohciwrapp_sem_05);
okini3939	1:0dac72ab5910	233	osSemaphoreDef(ohciwrapp_sem_06);
okini3939	1:0dac72ab5910	234	osSemaphoreDef(ohciwrapp_sem_07);
okini3939	1:0dac72ab5910	235	#if (INT_TRANS_MAX_NUM >= 2)
okini3939	1:0dac72ab5910	236	osSemaphoreDef(ohciwrapp_sem_08);
okini3939	1:0dac72ab5910	237	osSemaphoreDef(ohciwrapp_sem_09);
okini3939	1:0dac72ab5910	238	#endif
okini3939	1:0dac72ab5910	239	#if (INT_TRANS_MAX_NUM >= 3)
okini3939	1:0dac72ab5910	240	osSemaphoreDef(ohciwrapp_sem_10);
okini3939	1:0dac72ab5910	241	osSemaphoreDef(ohciwrapp_sem_11);
okini3939	1:0dac72ab5910	242	#endif
okini3939	1:0dac72ab5910	243	#if (INT_TRANS_MAX_NUM >= 4)
okini3939	1:0dac72ab5910	244	osSemaphoreDef(ohciwrapp_sem_12);
okini3939	1:0dac72ab5910	245	osSemaphoreDef(ohciwrapp_sem_13);
okini3939	1:0dac72ab5910	246	#endif
okini3939	1:0dac72ab5910	247	#if (ISO_TRANS_MAX_NUM >= 1)
okini3939	1:0dac72ab5910	248	osSemaphoreDef(ohciwrapp_sem_14);
okini3939	1:0dac72ab5910	249	osSemaphoreDef(ohciwrapp_sem_15);
okini3939	1:0dac72ab5910	250	#endif
okini3939	1:0dac72ab5910	251	#if (ISO_TRANS_MAX_NUM >= 2)
okini3939	1:0dac72ab5910	252	osSemaphoreDef(ohciwrapp_sem_16);
okini3939	1:0dac72ab5910	253	osSemaphoreDef(ohciwrapp_sem_17);
okini3939	1:0dac72ab5910	254	#endif
okini3939	1:0dac72ab5910	255
okini3939	1:0dac72ab5910	256	osThreadDef(callback_task, osPriorityHigh, 512);
okini3939	1:0dac72ab5910	257	osThreadDef(control_ed_task, osPriorityNormal, 512);
okini3939	1:0dac72ab5910	258	osThreadDef(bulk_ed_task, osPriorityNormal, 512);
okini3939	1:0dac72ab5910	259	static void int_ed_task_1(void const * argument) {
okini3939	1:0dac72ab5910	260	int_ed_task(argument);
okini3939	1:0dac72ab5910	261	}
okini3939	1:0dac72ab5910	262	osThreadDef(int_ed_task_1, osPriorityNormal, 512);
okini3939	1:0dac72ab5910	263	#if (INT_TRANS_MAX_NUM >= 2)
okini3939	1:0dac72ab5910	264	static void int_ed_task_2(void const * argument) {
okini3939	1:0dac72ab5910	265	int_ed_task(argument);
okini3939	1:0dac72ab5910	266	}
okini3939	1:0dac72ab5910	267	osThreadDef(int_ed_task_2, osPriorityNormal, 512);
okini3939	1:0dac72ab5910	268	#endif
okini3939	1:0dac72ab5910	269	#if (INT_TRANS_MAX_NUM >= 3)
okini3939	1:0dac72ab5910	270	static void int_ed_task_3(void const * argument) {
okini3939	1:0dac72ab5910	271	int_ed_task(argument);
okini3939	1:0dac72ab5910	272	}
okini3939	1:0dac72ab5910	273	osThreadDef(int_ed_task_3, osPriorityNormal, 512);
okini3939	1:0dac72ab5910	274	#endif
okini3939	1:0dac72ab5910	275	#if (INT_TRANS_MAX_NUM >= 4)
okini3939	1:0dac72ab5910	276	static void int_ed_task_4(void const * argument) {
okini3939	1:0dac72ab5910	277	int_ed_task(argument);
okini3939	1:0dac72ab5910	278	}
okini3939	1:0dac72ab5910	279	osThreadDef(int_ed_task_4, osPriorityNormal, 512);
okini3939	1:0dac72ab5910	280	#endif
okini3939	1:0dac72ab5910	281
okini3939	1:0dac72ab5910	282	#if (ISO_TRANS_MAX_NUM >= 1)
okini3939	1:0dac72ab5910	283	static void iso_ed_task_1(void const * argument) {
okini3939	1:0dac72ab5910	284	iso_ed_task(argument);
okini3939	1:0dac72ab5910	285	}
okini3939	1:0dac72ab5910	286	osThreadDef(iso_ed_task_1, osPriorityAboveNormal, 512);
okini3939	1:0dac72ab5910	287	#endif
okini3939	1:0dac72ab5910	288	#if (ISO_TRANS_MAX_NUM >= 2)
okini3939	1:0dac72ab5910	289	static void iso_ed_task_2(void const * argument) {
okini3939	1:0dac72ab5910	290	iso_ed_task(argument);
okini3939	1:0dac72ab5910	291	}
okini3939	1:0dac72ab5910	292	osThreadDef(iso_ed_task_2, osPriorityAboveNormal, 512);
okini3939	1:0dac72ab5910	293	#endif
okini3939	1:0dac72ab5910	294
okini3939	1:0dac72ab5910	295	void ohciwrapp_init(usbisr_fnc_t *p_usbisr_fnc) {
okini3939	1:0dac72ab5910	296	static const osSemaphoreDef_t * const sem_def_tbl[TOTAL_SEM_NUM] = {
okini3939	1:0dac72ab5910	297	osSemaphore(ohciwrapp_sem_01), osSemaphore(ohciwrapp_sem_02), osSemaphore(ohciwrapp_sem_03)
okini3939	1:0dac72ab5910	298	, osSemaphore(ohciwrapp_sem_04), osSemaphore(ohciwrapp_sem_05), osSemaphore(ohciwrapp_sem_06)
okini3939	1:0dac72ab5910	299	, osSemaphore(ohciwrapp_sem_07)
okini3939	1:0dac72ab5910	300	#if (INT_TRANS_MAX_NUM >= 2)
okini3939	1:0dac72ab5910	301	, osSemaphore(ohciwrapp_sem_08), osSemaphore(ohciwrapp_sem_09)
okini3939	1:0dac72ab5910	302	#endif
okini3939	1:0dac72ab5910	303	#if (INT_TRANS_MAX_NUM >= 3)
okini3939	1:0dac72ab5910	304	, osSemaphore(ohciwrapp_sem_10), osSemaphore(ohciwrapp_sem_11)
okini3939	1:0dac72ab5910	305	#endif
okini3939	1:0dac72ab5910	306	#if (INT_TRANS_MAX_NUM >= 4)
okini3939	1:0dac72ab5910	307	, osSemaphore(ohciwrapp_sem_12), osSemaphore(ohciwrapp_sem_13)
okini3939	1:0dac72ab5910	308	#endif
okini3939	1:0dac72ab5910	309	#if (ISO_TRANS_MAX_NUM >= 1)
okini3939	1:0dac72ab5910	310	, osSemaphore(ohciwrapp_sem_14), osSemaphore(ohciwrapp_sem_15)
okini3939	1:0dac72ab5910	311	#endif
okini3939	1:0dac72ab5910	312	#if (ISO_TRANS_MAX_NUM >= 2)
okini3939	1:0dac72ab5910	313	, osSemaphore(ohciwrapp_sem_16), osSemaphore(ohciwrapp_sem_17)
okini3939	1:0dac72ab5910	314	#endif
okini3939	1:0dac72ab5910	315	};
okini3939	1:0dac72ab5910	316	static const osThreadDef_t * const int_tsk_def_tbl[INT_TRANS_MAX_NUM] = {
okini3939	1:0dac72ab5910	317	osThread(int_ed_task_1)
okini3939	1:0dac72ab5910	318	#if (INT_TRANS_MAX_NUM >= 2)
okini3939	1:0dac72ab5910	319	, osThread(int_ed_task_2)
okini3939	1:0dac72ab5910	320	#endif
okini3939	1:0dac72ab5910	321	#if (INT_TRANS_MAX_NUM >= 3)
okini3939	1:0dac72ab5910	322	, osThread(int_ed_task_3)
okini3939	1:0dac72ab5910	323	#endif
okini3939	1:0dac72ab5910	324	#if (INT_TRANS_MAX_NUM >= 4)
okini3939	1:0dac72ab5910	325	, osThread(int_ed_task_4)
okini3939	1:0dac72ab5910	326	#endif
okini3939	1:0dac72ab5910	327	};
okini3939	1:0dac72ab5910	328	#if (ISO_TRANS_MAX_NUM > 0)
okini3939	1:0dac72ab5910	329	static const osThreadDef_t * const iso_tsk_def_tbl[ISO_TRANS_MAX_NUM] = {
okini3939	1:0dac72ab5910	330	osThread(iso_ed_task_1)
okini3939	1:0dac72ab5910	331	#if (ISO_TRANS_MAX_NUM >= 2)
okini3939	1:0dac72ab5910	332	, osThread(iso_ed_task_2)
okini3939	1:0dac72ab5910	333	#endif
okini3939	1:0dac72ab5910	334	};
okini3939	1:0dac72ab5910	335	#endif
okini3939	1:0dac72ab5910	336
okini3939	1:0dac72ab5910	337	uint32_t cnt;
okini3939	1:0dac72ab5910	338	uint32_t index = 0;
okini3939	1:0dac72ab5910	339
okini3939	1:0dac72ab5910	340	/* Disables interrupt for usb */
okini3939	1:0dac72ab5910	341	GIC_DisableIRQ(USBIXUSBIX);
okini3939	1:0dac72ab5910	342
okini3939	1:0dac72ab5910	343	#if (USB_HOST_CH == 0)
okini3939	1:0dac72ab5910	344	/* P4_1(USB0_EN) */
okini3939	1:0dac72ab5910	345	GPIOP4 &= ~0x0002; /* Outputs low level */
okini3939	1:0dac72ab5910	346	GPIOPMC4 &= ~0x0002; /* Port mode */
okini3939	1:0dac72ab5910	347	GPIOPM4 &= ~0x0002; /* Output mode */
okini3939	1:0dac72ab5910	348	#endif
okini3939	1:0dac72ab5910	349
okini3939	1:0dac72ab5910	350	p_usbisr_cb = p_usbisr_fnc;
okini3939	1:0dac72ab5910	351	#if (USB_HOST_HISPEED == 0)
okini3939	1:0dac72ab5910	352	g_usbx_host_SupportUsbDeviceSpeed = USB_HOST_FULL_SPEED;
okini3939	1:0dac72ab5910	353	#else
okini3939	1:0dac72ab5910	354	g_usbx_host_SupportUsbDeviceSpeed = USB_HOST_HIGH_SPEED;
okini3939	1:0dac72ab5910	355	#endif
okini3939	1:0dac72ab5910	356	p_usb_reg->HcRevision = 0x00000010;
okini3939	1:0dac72ab5910	357	p_usb_reg->HcControl = 0x00000000;
okini3939	1:0dac72ab5910	358	p_usb_reg->HcCommandStatus = 0x00000000;
okini3939	1:0dac72ab5910	359	p_usb_reg->HcInterruptStatus = 0x00000000;
okini3939	1:0dac72ab5910	360	p_usb_reg->HcInterruptEnable = 0x00000000;
okini3939	1:0dac72ab5910	361	p_usb_reg->HcInterruptDisable = 0x00000000;
okini3939	1:0dac72ab5910	362	p_usb_reg->HcHCCA = 0x00000000;
okini3939	1:0dac72ab5910	363	p_usb_reg->HcPeriodCurrentED = 0x00000000;
okini3939	1:0dac72ab5910	364	p_usb_reg->HcControlHeadED = 0x00000000;
okini3939	1:0dac72ab5910	365	p_usb_reg->HcControlCurrentED = 0x00000000;
okini3939	1:0dac72ab5910	366	p_usb_reg->HcBulkHeadED = 0x00000000;
okini3939	1:0dac72ab5910	367	p_usb_reg->HcBulkCurrentED = 0x00000000;
okini3939	1:0dac72ab5910	368	p_usb_reg->HcDoneHead = 0x00000000;
okini3939	1:0dac72ab5910	369	p_usb_reg->HcFmInterval = 0x00002EDF;
okini3939	1:0dac72ab5910	370	p_usb_reg->HcFmRemaining = 0x00002EDF;
okini3939	1:0dac72ab5910	371	p_usb_reg->HcFmNumber = 0x00000000;
okini3939	1:0dac72ab5910	372	p_usb_reg->HcPeriodicStart = 0x00000000;
okini3939	1:0dac72ab5910	373	p_usb_reg->HcLSThreshold = 0x00000628;
okini3939	1:0dac72ab5910	374	p_usb_reg->HcRhDescriptorA = 0xFF000901;
okini3939	1:0dac72ab5910	375	p_usb_reg->HcRhDescriptorB = 0x00020000;
okini3939	1:0dac72ab5910	376	p_usb_reg->HcRhStatus = 0x00000000;
okini3939	1:0dac72ab5910	377	p_usb_reg->HcRhPortStatus1 = 0x00000000;
okini3939	1:0dac72ab5910	378
okini3939	1:0dac72ab5910	379	#if (USB_HOST_CH == 0)
okini3939	1:0dac72ab5910	380	GPIOP4 \|= 0x0002; /* P4_1 Outputs high level */
okini3939	1:0dac72ab5910	381	osDelay(5);
okini3939	1:0dac72ab5910	382	GPIOP4 &= ~0x0002; /* P4_1 Outputs low level */
okini3939	1:0dac72ab5910	383	osDelay(10);
okini3939	1:0dac72ab5910	384	#else
okini3939	1:0dac72ab5910	385	osDelay(15);
okini3939	1:0dac72ab5910	386	#endif
okini3939	1:0dac72ab5910	387
okini3939	1:0dac72ab5910	388	if (init_end == 0) {
okini3939	1:0dac72ab5910	389	(void)memset(&ctl_ed, 0, sizeof(ctl_ed));
okini3939	1:0dac72ab5910	390	(void)memset(&blk_ed, 0, sizeof(blk_ed));
okini3939	1:0dac72ab5910	391	(void)memset(&int_ed[0], 0, sizeof(int_ed));
okini3939	1:0dac72ab5910	392	#if (ISO_TRANS_MAX_NUM > 0)
okini3939	1:0dac72ab5910	393	(void)memset(&iso_ed[0], 0, sizeof(iso_ed));
okini3939	1:0dac72ab5910	394	#endif
okini3939	1:0dac72ab5910	395
okini3939	1:0dac72ab5910	396	/* callback */
okini3939	1:0dac72ab5910	397	semid_cb = osSemaphoreCreate(sem_def_tbl[index], 0);
okini3939	1:0dac72ab5910	398	index++;
okini3939	1:0dac72ab5910	399	(void)osThreadCreate(osThread(callback_task), 0);
okini3939	1:0dac72ab5910	400
okini3939	1:0dac72ab5910	401	/* control transfer */
okini3939	1:0dac72ab5910	402	ctl_ed.semid_wait = osSemaphoreCreate(sem_def_tbl[index], 0);
okini3939	1:0dac72ab5910	403	index++;
okini3939	1:0dac72ab5910	404	ctl_ed.semid_list = osSemaphoreCreate(sem_def_tbl[index], 0);
okini3939	1:0dac72ab5910	405	index++;
okini3939	1:0dac72ab5910	406	ctl_ed.tskid = osThreadCreate(osThread(control_ed_task), 0);
okini3939	1:0dac72ab5910	407
okini3939	1:0dac72ab5910	408	/* bulk transfer */
okini3939	1:0dac72ab5910	409	blk_ed.semid_wait = osSemaphoreCreate(sem_def_tbl[index], 0);
okini3939	1:0dac72ab5910	410	index++;
okini3939	1:0dac72ab5910	411	blk_ed.semid_list = osSemaphoreCreate(sem_def_tbl[index], 0);
okini3939	1:0dac72ab5910	412	index++;
okini3939	1:0dac72ab5910	413	blk_ed.tskid = osThreadCreate(osThread(bulk_ed_task), 0);
okini3939	1:0dac72ab5910	414
okini3939	1:0dac72ab5910	415	/* interrupt transfer */
okini3939	1:0dac72ab5910	416	for (cnt = 0; cnt < INT_TRANS_MAX_NUM; cnt++) {
okini3939	1:0dac72ab5910	417	int_ed[cnt].semid_wait = osSemaphoreCreate(sem_def_tbl[index], 0);
okini3939	1:0dac72ab5910	418	index++;
okini3939	1:0dac72ab5910	419	int_ed[cnt].semid_list = osSemaphoreCreate(sem_def_tbl[index], 0);
okini3939	1:0dac72ab5910	420	index++;
okini3939	1:0dac72ab5910	421	int_ed[cnt].tskid = osThreadCreate(int_tsk_def_tbl[cnt], (void *)cnt);
okini3939	1:0dac72ab5910	422	}
okini3939	1:0dac72ab5910	423
okini3939	1:0dac72ab5910	424	#if (ISO_TRANS_MAX_NUM > 0)
okini3939	1:0dac72ab5910	425	/* isochronous transfer */
okini3939	1:0dac72ab5910	426	for (cnt = 0; cnt < ISO_TRANS_MAX_NUM; cnt++) {
okini3939	1:0dac72ab5910	427	iso_ed[cnt].semid_wait = osSemaphoreCreate(sem_def_tbl[index], 0);
okini3939	1:0dac72ab5910	428	index++;
okini3939	1:0dac72ab5910	429	iso_ed[cnt].semid_list = osSemaphoreCreate(sem_def_tbl[index], 0);
okini3939	1:0dac72ab5910	430	index++;
okini3939	1:0dac72ab5910	431	iso_ed[cnt].tskid = osThreadCreate(iso_tsk_def_tbl[cnt], (void *)cnt);
okini3939	1:0dac72ab5910	432	}
okini3939	1:0dac72ab5910	433	#endif
okini3939	1:0dac72ab5910	434	init_end = 1;
okini3939	1:0dac72ab5910	435	}
okini3939	1:0dac72ab5910	436	}
okini3939	1:0dac72ab5910	437
okini3939	1:0dac72ab5910	438	uint32_t ohciwrapp_reg_r(uint32_t reg_ofs) {
okini3939	1:0dac72ab5910	439	if (init_end == 0) {
okini3939	1:0dac72ab5910	440	return 0;
okini3939	1:0dac72ab5910	441	}
okini3939	1:0dac72ab5910	442
okini3939	1:0dac72ab5910	443	return (uint32_t )((uint8_t *)p_usb_reg + reg_ofs);
okini3939	1:0dac72ab5910	444	}
okini3939	1:0dac72ab5910	445
okini3939	1:0dac72ab5910	446	void ohciwrapp_reg_w(uint32_t reg_ofs, uint32_t set_data) {
okini3939	1:0dac72ab5910	447	uint32_t cnt;
okini3939	1:0dac72ab5910	448	uint32_t last_data;
okini3939	1:0dac72ab5910	449	hcca_t *p_hcca;
okini3939	1:0dac72ab5910	450
okini3939	1:0dac72ab5910	451	if (init_end == 0) {
okini3939	1:0dac72ab5910	452	return;
okini3939	1:0dac72ab5910	453	}
okini3939	1:0dac72ab5910	454
okini3939	1:0dac72ab5910	455	switch (reg_ofs) {
okini3939	1:0dac72ab5910	456	case OHCI_REG_CONTROL:
okini3939	1:0dac72ab5910	457	last_data = p_usb_reg->HcControl;
okini3939	1:0dac72ab5910	458	p_usb_reg->HcControl = (set_data & 0x000007FF);
okini3939	1:0dac72ab5910	459	if ((last_data & OR_CONTROL_CLE) != (set_data & OR_CONTROL_CLE)) {
okini3939	1:0dac72ab5910	460	/* change CLE */
okini3939	1:0dac72ab5910	461	if ((set_data & OR_CONTROL_CLE) != 0) {
okini3939	1:0dac72ab5910	462	(void)osSemaphoreRelease(ctl_ed.semid_list);
okini3939	1:0dac72ab5910	463	} else {
okini3939	1:0dac72ab5910	464	if (ctl_ed.trans_wait == 1) {
okini3939	1:0dac72ab5910	465	ctl_ed.trans_wait = 0;
okini3939	1:0dac72ab5910	466	(void)osSemaphoreRelease(ctl_ed.semid_wait);
okini3939	1:0dac72ab5910	467	}
okini3939	1:0dac72ab5910	468	(void)osSemaphoreWait(ctl_ed.semid_list, osWaitForever);
okini3939	1:0dac72ab5910	469	}
okini3939	1:0dac72ab5910	470	}
okini3939	1:0dac72ab5910	471	if ((last_data & OR_CONTROL_BLE) != (set_data & OR_CONTROL_BLE)) {
okini3939	1:0dac72ab5910	472	/* change BLE */
okini3939	1:0dac72ab5910	473	if ((set_data & OR_CONTROL_BLE) != 0) {
okini3939	1:0dac72ab5910	474	(void)osSemaphoreRelease(blk_ed.semid_list);
okini3939	1:0dac72ab5910	475	} else {
okini3939	1:0dac72ab5910	476	if (blk_ed.trans_wait == 1) {
okini3939	1:0dac72ab5910	477	blk_ed.trans_wait = 0;
okini3939	1:0dac72ab5910	478	(void)osSemaphoreRelease(blk_ed.semid_wait);
okini3939	1:0dac72ab5910	479	}
okini3939	1:0dac72ab5910	480	(void)osSemaphoreWait(blk_ed.semid_list, osWaitForever);
okini3939	1:0dac72ab5910	481	}
okini3939	1:0dac72ab5910	482	}
okini3939	1:0dac72ab5910	483	#if (ISO_TRANS_MAX_NUM > 0)
okini3939	1:0dac72ab5910	484	if ((last_data & OR_CONTROL_IE) != (set_data & OR_CONTROL_IE)) {
okini3939	1:0dac72ab5910	485	/* change IE */
okini3939	1:0dac72ab5910	486	for (cnt = 0; cnt < ISO_TRANS_MAX_NUM; cnt++) {
okini3939	1:0dac72ab5910	487	if ((set_data & OR_CONTROL_IE) != 0) {
okini3939	1:0dac72ab5910	488	(void)osSemaphoreRelease(iso_ed[cnt].semid_list);
okini3939	1:0dac72ab5910	489	} else {
okini3939	1:0dac72ab5910	490	if (iso_ed[cnt].trans_wait == 1) {
okini3939	1:0dac72ab5910	491	iso_ed[cnt].trans_wait = 0;
okini3939	1:0dac72ab5910	492	(void)osSemaphoreRelease(iso_ed[cnt].semid_wait);
okini3939	1:0dac72ab5910	493	}
okini3939	1:0dac72ab5910	494	(void)osSemaphoreWait(iso_ed[cnt].semid_list, osWaitForever);
okini3939	1:0dac72ab5910	495	}
okini3939	1:0dac72ab5910	496	}
okini3939	1:0dac72ab5910	497	}
okini3939	1:0dac72ab5910	498	#endif
okini3939	1:0dac72ab5910	499	if ((last_data & OR_CONTROL_PLE) != (set_data & OR_CONTROL_PLE)) {
okini3939	1:0dac72ab5910	500	/* change PLE */
okini3939	1:0dac72ab5910	501	for (cnt = 0; cnt < INT_TRANS_MAX_NUM; cnt++) {
okini3939	1:0dac72ab5910	502	if ((set_data & OR_CONTROL_PLE) != 0) {
okini3939	1:0dac72ab5910	503	(void)osSemaphoreRelease(int_ed[cnt].semid_list);
okini3939	1:0dac72ab5910	504	} else {
okini3939	1:0dac72ab5910	505	if (int_ed[cnt].trans_wait == 1) {
okini3939	1:0dac72ab5910	506	int_ed[cnt].trans_wait = 0;
okini3939	1:0dac72ab5910	507	(void)osSemaphoreRelease(int_ed[cnt].semid_wait);
okini3939	1:0dac72ab5910	508	}
okini3939	1:0dac72ab5910	509	(void)osSemaphoreWait(int_ed[cnt].semid_list, osWaitForever);
okini3939	1:0dac72ab5910	510	}
okini3939	1:0dac72ab5910	511	}
okini3939	1:0dac72ab5910	512	}
okini3939	1:0dac72ab5910	513	break;
okini3939	1:0dac72ab5910	514	case OHCI_REG_COMMANDSTATUS:
okini3939	1:0dac72ab5910	515	if ((set_data & OR_CMD_STATUS_HCR) != 0) { /* HostController Reset */
okini3939	1:0dac72ab5910	516	p_usb_reg->HcCommandStatus \|= OR_CMD_STATUS_HCR;
okini3939	1:0dac72ab5910	517	if (usbx_api_host_init(16, g_usbx_host_SupportUsbDeviceSpeed, USBHCLOCK_X1_48MHZ) == USB_HOST_ATTACH) {
okini3939	1:0dac72ab5910	518	ohciwrapp_loc_Connect(1);
okini3939	1:0dac72ab5910	519	}
okini3939	1:0dac72ab5910	520	p_usb_reg->HcCommandStatus &= ~OR_CMD_STATUS_HCR;
okini3939	1:0dac72ab5910	521	}
okini3939	1:0dac72ab5910	522	if ((set_data & OR_CMD_STATUS_CLF) != 0) {
okini3939	1:0dac72ab5910	523	p_usb_reg->HcCommandStatus \|= OR_CMD_STATUS_CLF;
okini3939	1:0dac72ab5910	524	osSignalSet(ctl_ed.tskid, SIG_GEN_LIST_REQ);
okini3939	1:0dac72ab5910	525	}
okini3939	1:0dac72ab5910	526	if ((set_data & OR_CMD_STATUS_BLF) != 0) {
okini3939	1:0dac72ab5910	527	p_usb_reg->HcCommandStatus \|= OR_CMD_STATUS_BLF;
okini3939	1:0dac72ab5910	528	osSignalSet(blk_ed.tskid, SIG_GEN_LIST_REQ);
okini3939	1:0dac72ab5910	529	}
okini3939	1:0dac72ab5910	530	if ((set_data & OR_CMD_STATUS_OCR) != 0) {
okini3939	1:0dac72ab5910	531	p_usb_reg->HcCommandStatus \|= OR_CMD_STATUS_OCR;
okini3939	1:0dac72ab5910	532	} else {
okini3939	1:0dac72ab5910	533	p_usb_reg->HcCommandStatus &= ~OR_CMD_STATUS_OCR;
okini3939	1:0dac72ab5910	534	}
okini3939	1:0dac72ab5910	535	break;
okini3939	1:0dac72ab5910	536	case OHCI_REG_INTERRUPTSTATUS:
okini3939	1:0dac72ab5910	537	if (((p_usb_reg->HcInterruptStatus & OR_INTR_STATUS_WDH) != 0)
okini3939	1:0dac72ab5910	538	&& ((set_data & OR_INTR_STATUS_WDH) != 0)) {
okini3939	1:0dac72ab5910	539	if (p_usb_reg->HcDoneHead != 0x00000000) {
okini3939	1:0dac72ab5910	540	p_hcca = (hcca_t *)p_usb_reg->HcHCCA;
okini3939	1:0dac72ab5910	541	p_hcca->DoneHead = p_usb_reg->HcDoneHead;
okini3939	1:0dac72ab5910	542	p_usb_reg->HcDoneHead = 0x00000000;
okini3939	1:0dac72ab5910	543	p_usb_reg->HcInterruptStatus \|= OR_INTR_STATUS_WDH;
okini3939	1:0dac72ab5910	544	(void)osSemaphoreRelease(semid_cb);
okini3939	1:0dac72ab5910	545	} else {
okini3939	1:0dac72ab5910	546	p_usb_reg->HcInterruptStatus &= ~OR_INTR_STATUS_WDH;
okini3939	1:0dac72ab5910	547	}
okini3939	1:0dac72ab5910	548	}
okini3939	1:0dac72ab5910	549	if ((set_data & OR_INTR_STATUS_RHSC) != 0) {
okini3939	1:0dac72ab5910	550	p_usb_reg->HcInterruptStatus &= ~OR_INTR_STATUS_RHSC;
okini3939	1:0dac72ab5910	551	}
okini3939	1:0dac72ab5910	552	break;
okini3939	1:0dac72ab5910	553	case OHCI_REG_INTERRUPTENABLE:
okini3939	1:0dac72ab5910	554	case OHCI_REG_INTERRUPTDISABLE:
okini3939	1:0dac72ab5910	555	case OHCI_REG_HCCA:
okini3939	1:0dac72ab5910	556	case OHCI_REG_CONTROLHEADED:
okini3939	1:0dac72ab5910	557	case OHCI_REG_CONTROLCURRENTED:
okini3939	1:0dac72ab5910	558	case OHCI_REG_BULKHEADED:
okini3939	1:0dac72ab5910	559	case OHCI_REG_BULKCURRENTED:
okini3939	1:0dac72ab5910	560	case OHCI_REG_FMINTERVAL:
okini3939	1:0dac72ab5910	561	case OHCI_REG_FMREMAINING:
okini3939	1:0dac72ab5910	562	case OHCI_REG_PERIODICSTART:
okini3939	1:0dac72ab5910	563	case OHCI_REG_LSTHRESHOLD:
okini3939	1:0dac72ab5910	564	case OHCI_REG_RHDESCRIPTORA:
okini3939	1:0dac72ab5910	565	case OHCI_REG_RHDESCRIPTORB:
okini3939	1:0dac72ab5910	566	case OHCI_REG_RHSTATUS:
okini3939	1:0dac72ab5910	567	(uint32_t )((uint8_t *)p_usb_reg + reg_ofs) = set_data;
okini3939	1:0dac72ab5910	568	break;
okini3939	1:0dac72ab5910	569	case OHCI_REG_RHPORTSTATUS1:
okini3939	1:0dac72ab5910	570	p_usb_reg->HcRhPortStatus1 &= ~(set_data & 0xFFFF0000);
okini3939	1:0dac72ab5910	571	if ((set_data & OR_RH_PORT_PRS) != 0) { /* Set Port Reset */
okini3939	1:0dac72ab5910	572	p_usb_reg->HcRhPortStatus1 \|= OR_RH_PORT_PRS;
okini3939	1:0dac72ab5910	573	usbx_host_UsbBusReset();
okini3939	1:0dac72ab5910	574	p_usb_reg->HcRhPortStatus1 &= ~OR_RH_PORT_PRS;
okini3939	1:0dac72ab5910	575	}
okini3939	1:0dac72ab5910	576	break;
okini3939	1:0dac72ab5910	577	case OHCI_REG_REVISION:
okini3939	1:0dac72ab5910	578	case OHCI_REG_PERIODCURRENTED:
okini3939	1:0dac72ab5910	579	case OHCI_REG_DONEHEADED:
okini3939	1:0dac72ab5910	580	case OHCI_REG_FMNUMBER:
okini3939	1:0dac72ab5910	581	default:
okini3939	1:0dac72ab5910	582	/* Do Nothing */
okini3939	1:0dac72ab5910	583	break;
okini3939	1:0dac72ab5910	584	}
okini3939	1:0dac72ab5910	585	}
okini3939	1:0dac72ab5910	586
okini3939	1:0dac72ab5910	587	static void callback_task(void const * argument) {
okini3939	1:0dac72ab5910	588	usbisr_fnc_t *p_wk_cb = p_usbisr_cb;
okini3939	1:0dac72ab5910	589
okini3939	1:0dac72ab5910	590	if (p_wk_cb == NULL) {
okini3939	1:0dac72ab5910	591	return;
okini3939	1:0dac72ab5910	592	}
okini3939	1:0dac72ab5910	593
okini3939	1:0dac72ab5910	594	while (1) {
okini3939	1:0dac72ab5910	595	osSemaphoreWait(semid_cb, osWaitForever);
okini3939	1:0dac72ab5910	596	if (connect_change != 0xFFFFFFFF) {
okini3939	1:0dac72ab5910	597	connect_change = 0xFFFFFFFF;
okini3939	1:0dac72ab5910	598	connect_check();
okini3939	1:0dac72ab5910	599	}
okini3939	1:0dac72ab5910	600	p_wk_cb();
okini3939	1:0dac72ab5910	601	}
okini3939	1:0dac72ab5910	602	}
okini3939	1:0dac72ab5910	603
okini3939	1:0dac72ab5910	604	static void control_ed_task(void const * argument) {
okini3939	1:0dac72ab5910	605	while (1) {
okini3939	1:0dac72ab5910	606	osSignalWait(SIG_GEN_LIST_REQ, osWaitForever);
okini3939	1:0dac72ab5910	607	(void)osSemaphoreWait(ctl_ed.semid_list, osWaitForever);
okini3939	1:0dac72ab5910	608	while ((p_usb_reg->HcControl & OR_CONTROL_CLE) != 0) {
okini3939	1:0dac72ab5910	609	if ((p_usb_reg->HcControlCurrentED == 0)
okini3939	1:0dac72ab5910	610	&& ((p_usb_reg->HcCommandStatus & OR_CMD_STATUS_CLF) != 0)) {
okini3939	1:0dac72ab5910	611	p_usb_reg->HcControlCurrentED = p_usb_reg->HcControlHeadED;
okini3939	1:0dac72ab5910	612	p_usb_reg->HcCommandStatus &= ~OR_CMD_STATUS_CLF;
okini3939	1:0dac72ab5910	613	}
okini3939	1:0dac72ab5910	614	if (p_usb_reg->HcControlCurrentED != 0) {
okini3939	1:0dac72ab5910	615	ctl_ed.p_curr_ed = (hced_t *)p_usb_reg->HcControlCurrentED;
okini3939	1:0dac72ab5910	616	if (chk_genelal_ed(&ctl_ed) != 0) {
okini3939	1:0dac72ab5910	617	control_trans(&ctl_ed);
okini3939	1:0dac72ab5910	618	p_usb_reg->HcCommandStatus \|= OR_CMD_STATUS_CLF;
okini3939	1:0dac72ab5910	619	}
okini3939	1:0dac72ab5910	620	p_usb_reg->HcControlCurrentED = (uint32_t)ctl_ed.p_curr_ed->nextED;
okini3939	1:0dac72ab5910	621	} else {
okini3939	1:0dac72ab5910	622	break;
okini3939	1:0dac72ab5910	623	}
okini3939	1:0dac72ab5910	624	}
okini3939	1:0dac72ab5910	625	if ((p_usb_reg->HcCommandStatus & OR_CMD_STATUS_CLF) != 0) {
okini3939	1:0dac72ab5910	626	osSignalSet(ctl_ed.tskid, SIG_GEN_LIST_REQ);
okini3939	1:0dac72ab5910	627	}
okini3939	1:0dac72ab5910	628	(void)osSemaphoreRelease(ctl_ed.semid_list);
okini3939	1:0dac72ab5910	629	}
okini3939	1:0dac72ab5910	630	}
okini3939	1:0dac72ab5910	631
okini3939	1:0dac72ab5910	632	static void bulk_ed_task(void const * argument) {
okini3939	1:0dac72ab5910	633	while (1) {
okini3939	1:0dac72ab5910	634	osSignalWait(SIG_GEN_LIST_REQ, osWaitForever);
okini3939	1:0dac72ab5910	635	(void)osSemaphoreWait(blk_ed.semid_list, osWaitForever);
okini3939	1:0dac72ab5910	636	while ((p_usb_reg->HcControl & OR_CONTROL_BLE) != 0) {
okini3939	1:0dac72ab5910	637	if ((p_usb_reg->HcBulkCurrentED == 0)
okini3939	1:0dac72ab5910	638	&& ((p_usb_reg->HcCommandStatus & OR_CMD_STATUS_BLF) != 0)) {
okini3939	1:0dac72ab5910	639	p_usb_reg->HcBulkCurrentED = p_usb_reg->HcBulkHeadED;
okini3939	1:0dac72ab5910	640	p_usb_reg->HcCommandStatus &= ~OR_CMD_STATUS_BLF;
okini3939	1:0dac72ab5910	641	}
okini3939	1:0dac72ab5910	642	if (p_usb_reg->HcBulkCurrentED != 0) {
okini3939	1:0dac72ab5910	643	blk_ed.p_curr_ed = (hced_t *)p_usb_reg->HcBulkCurrentED;
okini3939	1:0dac72ab5910	644	if (chk_genelal_ed(&blk_ed) != 0) {
okini3939	1:0dac72ab5910	645	bulk_trans(&blk_ed);
okini3939	1:0dac72ab5910	646	p_usb_reg->HcCommandStatus \|= OR_CMD_STATUS_BLF;
okini3939	1:0dac72ab5910	647	}
okini3939	1:0dac72ab5910	648	p_usb_reg->HcBulkCurrentED = (uint32_t)blk_ed.p_curr_ed->nextED;
okini3939	1:0dac72ab5910	649	} else {
okini3939	1:0dac72ab5910	650	break;
okini3939	1:0dac72ab5910	651	}
okini3939	1:0dac72ab5910	652	}
okini3939	1:0dac72ab5910	653	if ((p_usb_reg->HcCommandStatus & OR_CMD_STATUS_BLF) != 0) {
okini3939	1:0dac72ab5910	654	osSignalSet(blk_ed.tskid, SIG_GEN_LIST_REQ);
okini3939	1:0dac72ab5910	655	}
okini3939	1:0dac72ab5910	656	(void)osSemaphoreRelease(blk_ed.semid_list);
okini3939	1:0dac72ab5910	657	}
okini3939	1:0dac72ab5910	658	}
okini3939	1:0dac72ab5910	659
okini3939	1:0dac72ab5910	660	static void int_ed_task(void const * argument) {
okini3939	1:0dac72ab5910	661	genelal_ed_t *p_int_ed = &int_ed[(uint32_t)argument];
okini3939	1:0dac72ab5910	662	uint32_t cnt;
okini3939	1:0dac72ab5910	663	uint32_t wait_cnt = 0;
okini3939	1:0dac72ab5910	664	hcca_t *p_hcca;
okini3939	1:0dac72ab5910	665	hced_t *p_ed;
okini3939	1:0dac72ab5910	666
okini3939	1:0dac72ab5910	667	while (1) {
okini3939	1:0dac72ab5910	668	(void)osSemaphoreWait(p_int_ed->semid_list, osWaitForever);
okini3939	1:0dac72ab5910	669	if (p_int_ed->p_curr_ed == NULL) {
okini3939	1:0dac72ab5910	670	for (cnt = 0; (cnt < 32) && ((p_usb_reg->HcControl & OR_CONTROL_PLE) != 0)
okini3939	1:0dac72ab5910	671	&& (p_int_ed->p_curr_ed == NULL); cnt++) {
okini3939	1:0dac72ab5910	672	p_hcca = (hcca_t *)p_usb_reg->HcHCCA;
okini3939	1:0dac72ab5910	673	p_ed = (hced_t *)p_hcca->IntTable[cnt];
okini3939	1:0dac72ab5910	674	while ((p_ed != NULL) && ((p_usb_reg->HcControl & OR_CONTROL_PLE) != 0)
okini3939	1:0dac72ab5910	675	&& (p_int_ed->p_curr_ed == NULL)) {
okini3939	1:0dac72ab5910	676	if (int_trans_doing(p_ed, (uint32_t)argument) == 0) {
okini3939	1:0dac72ab5910	677	p_int_ed->p_curr_ed = p_ed;
okini3939	1:0dac72ab5910	678	if (chk_genelal_ed(p_int_ed) != 0) {
okini3939	1:0dac72ab5910	679	int_trans_setting(p_int_ed, (uint32_t)argument);
okini3939	1:0dac72ab5910	680	} else {
okini3939	1:0dac72ab5910	681	p_int_ed->p_curr_ed = NULL;
okini3939	1:0dac72ab5910	682	}
okini3939	1:0dac72ab5910	683	}
okini3939	1:0dac72ab5910	684	p_ed = p_ed->nextED;
okini3939	1:0dac72ab5910	685	}
okini3939	1:0dac72ab5910	686	}
okini3939	1:0dac72ab5910	687	}
okini3939	1:0dac72ab5910	688	if (p_int_ed->p_curr_ed != NULL) {
okini3939	1:0dac72ab5910	689	while ((p_usb_reg->HcControl & OR_CONTROL_PLE) != 0) {
okini3939	1:0dac72ab5910	690	if (chk_genelal_ed(p_int_ed) != 0) {
okini3939	1:0dac72ab5910	691	int_trans(p_int_ed);
okini3939	1:0dac72ab5910	692	(void)osSemaphoreWait(p_int_ed->semid_wait, osWaitForever);
okini3939	1:0dac72ab5910	693	usbx_host_stop_transfer(p_int_ed->pipe_no);
okini3939	1:0dac72ab5910	694	wait_cnt = p_int_ed->cycle_time;
okini3939	1:0dac72ab5910	695	} else {
okini3939	1:0dac72ab5910	696	if (wait_cnt > 0) {
okini3939	1:0dac72ab5910	697	wait_cnt--;
okini3939	1:0dac72ab5910	698	} else {
okini3939	1:0dac72ab5910	699	p_int_ed->p_curr_ed = NULL;
okini3939	1:0dac72ab5910	700	}
okini3939	1:0dac72ab5910	701	break;
okini3939	1:0dac72ab5910	702	}
okini3939	1:0dac72ab5910	703	}
okini3939	1:0dac72ab5910	704	}
okini3939	1:0dac72ab5910	705	(void)osSemaphoreRelease(p_int_ed->semid_list);
okini3939	1:0dac72ab5910	706	if (p_int_ed->p_curr_ed == NULL) {
okini3939	1:0dac72ab5910	707	osDelay(10);
okini3939	1:0dac72ab5910	708	} else {
okini3939	1:0dac72ab5910	709	osDelay(1);
okini3939	1:0dac72ab5910	710	}
okini3939	1:0dac72ab5910	711	}
okini3939	1:0dac72ab5910	712	}
okini3939	1:0dac72ab5910	713
okini3939	1:0dac72ab5910	714	static int32_t int_trans_doing(hced_t *p_ed, uint32_t index) {
okini3939	1:0dac72ab5910	715	uint32_t cnt;
okini3939	1:0dac72ab5910	716	int32_t ret = 0;
okini3939	1:0dac72ab5910	717
okini3939	1:0dac72ab5910	718	for (cnt = 0; cnt < INT_TRANS_MAX_NUM; cnt++) {
okini3939	1:0dac72ab5910	719	if ((index != cnt) && (int_ed[cnt].p_curr_ed == p_ed)) {
okini3939	1:0dac72ab5910	720	ret = 1;
okini3939	1:0dac72ab5910	721	}
okini3939	1:0dac72ab5910	722	}
okini3939	1:0dac72ab5910	723
okini3939	1:0dac72ab5910	724	return ret;
okini3939	1:0dac72ab5910	725	}
okini3939	1:0dac72ab5910	726
okini3939	1:0dac72ab5910	727	static int32_t chk_genelal_ed(genelal_ed_t *p_g_ed){
okini3939	1:0dac72ab5910	728	int32_t ret = 0;
okini3939	1:0dac72ab5910	729	hced_t *p_ed = p_g_ed->p_curr_ed;
okini3939	1:0dac72ab5910	730
okini3939	1:0dac72ab5910	731	if (((p_ed->control & ED_SKIP) != 0)
okini3939	1:0dac72ab5910	732	\|\| ((p_ed->control & ED_FORMAT) != 0)
okini3939	1:0dac72ab5910	733	\|\| ((p_ed->headTD & ED_HALTED) != 0)
okini3939	1:0dac72ab5910	734	\|\| ((p_ed->tailTD & 0xFFFFFFF0) == (p_ed->headTD & 0xFFFFFFF0))) {
okini3939	1:0dac72ab5910	735	/* Do Nothing */
okini3939	1:0dac72ab5910	736	} else if ((p_ed->control & 0x0000007F) > 10) {
okini3939	1:0dac72ab5910	737	p_ed->headTD \|= ED_HALTED;
okini3939	1:0dac72ab5910	738	} else {
okini3939	1:0dac72ab5910	739	p_g_ed->p_curr_td = (void *)(p_ed->headTD & 0xFFFFFFF0);
okini3939	1:0dac72ab5910	740	if (p_g_ed->p_curr_td == NULL) {
okini3939	1:0dac72ab5910	741	p_ed->headTD \|= ED_HALTED;
okini3939	1:0dac72ab5910	742	} else {
okini3939	1:0dac72ab5910	743	hctd_t p_td = (hctd_t )p_g_ed->p_curr_td;
okini3939	1:0dac72ab5910	744
okini3939	1:0dac72ab5910	745	p_g_ed->p_start_buf = p_td->currBufPtr;
okini3939	1:0dac72ab5910	746	ret = 1;
okini3939	1:0dac72ab5910	747	}
okini3939	1:0dac72ab5910	748	}
okini3939	1:0dac72ab5910	749
okini3939	1:0dac72ab5910	750	return ret;
okini3939	1:0dac72ab5910	751	}
okini3939	1:0dac72ab5910	752
okini3939	1:0dac72ab5910	753	static void chk_genelal_td_done(genelal_ed_t *p_g_ed) {
okini3939	1:0dac72ab5910	754	hcca_t *p_hcca;
okini3939	1:0dac72ab5910	755	hctd_t p_td = (hctd_t )p_g_ed->p_curr_td;
okini3939	1:0dac72ab5910	756	uint32_t ConditionCode = RZA_IO_RegRead_32(&p_td->control, TD_CTL_SHFT_CC, TD_CTL_MSK_CC);
okini3939	1:0dac72ab5910	757
okini3939	1:0dac72ab5910	758	if ((ConditionCode != TD_CC_NOT_ACCESSED_1) && (ConditionCode != TD_CC_NOT_ACCESSED_2)) {
okini3939	1:0dac72ab5910	759	p_g_ed->p_curr_ed->headTD = ((uint32_t)p_td->nextTD & 0xFFFFFFF0)
okini3939	1:0dac72ab5910	760	\| (p_g_ed->p_curr_ed->headTD & 0x0000000F);
okini3939	1:0dac72ab5910	761	p_td->nextTD = (hctd_t *)p_usb_reg->HcDoneHead;
okini3939	1:0dac72ab5910	762	p_usb_reg->HcDoneHead = (uint32_t)p_g_ed->p_curr_td;
okini3939	1:0dac72ab5910	763	if ((p_usb_reg->HcInterruptStatus & OR_INTR_STATUS_WDH) == 0) {
okini3939	1:0dac72ab5910	764	p_hcca = (hcca_t *)p_usb_reg->HcHCCA;
okini3939	1:0dac72ab5910	765	p_hcca->DoneHead = p_usb_reg->HcDoneHead;
okini3939	1:0dac72ab5910	766	p_usb_reg->HcDoneHead = 0x00000000;
okini3939	1:0dac72ab5910	767	p_usb_reg->HcInterruptStatus \|= OR_INTR_STATUS_WDH;
okini3939	1:0dac72ab5910	768	(void)osSemaphoreRelease(semid_cb);
okini3939	1:0dac72ab5910	769	}
okini3939	1:0dac72ab5910	770	}
okini3939	1:0dac72ab5910	771	}
okini3939	1:0dac72ab5910	772
okini3939	1:0dac72ab5910	773	static void chk_split_trans_setting(genelal_ed_t *p_g_ed) {
okini3939	1:0dac72ab5910	774	uint8_t *p_buf;
okini3939	1:0dac72ab5910	775	tdinfo_t td_info;
okini3939	1:0dac72ab5910	776	hctd_t p_td = (hctd_t )p_g_ed->p_curr_td;
okini3939	1:0dac72ab5910	777
okini3939	1:0dac72ab5910	778	/* Hi-Speed mode only */
okini3939	1:0dac72ab5910	779	if (g_usbx_host_UsbDeviceSpeed != USB_HOST_HIGH_SPEED) {
okini3939	1:0dac72ab5910	780	return;
okini3939	1:0dac72ab5910	781	}
okini3939	1:0dac72ab5910	782
okini3939	1:0dac72ab5910	783	if (RZA_IO_RegRead_32(&p_td->control, TD_CTL_SHFT_CC, TD_CTL_MSK_CC) != TD_CC_NOERROR) {
okini3939	1:0dac72ab5910	784	return;
okini3939	1:0dac72ab5910	785	}
okini3939	1:0dac72ab5910	786
okini3939	1:0dac72ab5910	787	get_td_info(p_g_ed, &td_info);
okini3939	1:0dac72ab5910	788	p_buf = p_g_ed->p_start_buf;
okini3939	1:0dac72ab5910	789
okini3939	1:0dac72ab5910	790	if (td_info.direction == 0) {
okini3939	1:0dac72ab5910	791	uint8_t bRequest = p_buf[1];
okini3939	1:0dac72ab5910	792	uint16_t wValue = (p_buf[3] << 8) + p_buf[2];
okini3939	1:0dac72ab5910	793	uint16_t wIndx = (p_buf[5] << 8) + p_buf[4];
okini3939	1:0dac72ab5910	794	uint16_t devadd;
okini3939	1:0dac72ab5910	795
okini3939	1:0dac72ab5910	796	if ((td_info.devadr == 0) && (bRequest == SET_ADDRESS)) {
okini3939	1:0dac72ab5910	797	/* SET_ADDRESS */
okini3939	1:0dac72ab5910	798	usbx_host_get_devadd(USB_HOST_DEVICE_0, &devadd);
okini3939	1:0dac72ab5910	799	usbx_host_set_devadd(wValue, &devadd);
okini3939	1:0dac72ab5910	800	if (split_ctl.root_devadr == 0) {
okini3939	1:0dac72ab5910	801	split_ctl.root_devadr = wValue; /* New Address */
okini3939	1:0dac72ab5910	802	}
okini3939	1:0dac72ab5910	803	} else if ((td_info.devadr == split_ctl.root_devadr) && (bRequest == SET_FEATURE)
okini3939	1:0dac72ab5910	804	&& (wValue == 0x0004) && (split_ctl.root_devadr != 0)) {
okini3939	1:0dac72ab5910	805	/* SET_FEATURE PORT_RESET */
okini3939	1:0dac72ab5910	806	split_ctl.reset_port = (wIndx & 0x00FF);
okini3939	1:0dac72ab5910	807	} else if ((td_info.devadr == split_ctl.root_devadr) && (bRequest == GET_STATUS)) {
okini3939	1:0dac72ab5910	808	/* GET_STATUS */
okini3939	1:0dac72ab5910	809	split_ctl.get_port = wIndx;
okini3939	1:0dac72ab5910	810	split_ctl.seq_cnt = 1;
okini3939	1:0dac72ab5910	811	} else {
okini3939	1:0dac72ab5910	812	/* Do Nothing */
okini3939	1:0dac72ab5910	813	}
okini3939	1:0dac72ab5910	814	} else if (td_info.direction == 2) {
okini3939	1:0dac72ab5910	815	if ((td_info.devadr == split_ctl.root_devadr) && (split_ctl.seq_cnt == 1)) {
okini3939	1:0dac72ab5910	816	if (split_ctl.get_port < PORT_NUM) {
okini3939	1:0dac72ab5910	817	split_ctl.port_sts_bits[split_ctl.get_port] = (p_buf[1] << 8) + p_buf[0];
okini3939	1:0dac72ab5910	818	}
okini3939	1:0dac72ab5910	819	split_ctl.seq_cnt = 0;
okini3939	1:0dac72ab5910	820	}
okini3939	1:0dac72ab5910	821	} else {
okini3939	1:0dac72ab5910	822	/* Do Nothing */
okini3939	1:0dac72ab5910	823	}
okini3939	1:0dac72ab5910	824	}
okini3939	1:0dac72ab5910	825
okini3939	1:0dac72ab5910	826	static void set_split_trans_setting(void) {
okini3939	1:0dac72ab5910	827	uint16_t port_speed;
okini3939	1:0dac72ab5910	828	uint16_t devadd;
okini3939	1:0dac72ab5910	829
okini3939	1:0dac72ab5910	830	if ((split_ctl.root_devadr != 0) && (split_ctl.reset_port != 0) && (split_ctl.reset_port < PORT_NUM)) {
okini3939	1:0dac72ab5910	831	usbx_host_get_devadd(USB_HOST_DEVICE_0, &devadd);
okini3939	1:0dac72ab5910	832	RZA_IO_RegWrite_16(&devadd, split_ctl.root_devadr, USB_DEVADDn_UPPHUB_SHIFT, USB_DEVADDn_UPPHUB);
okini3939	1:0dac72ab5910	833	RZA_IO_RegWrite_16(&devadd, split_ctl.reset_port, USB_DEVADDn_HUBPORT_SHIFT, USB_DEVADDn_HUBPORT);
okini3939	1:0dac72ab5910	834	if ((split_ctl.port_sts_bits[split_ctl.reset_port] & PORT_HIGH_SPEED) != 0) {
okini3939	1:0dac72ab5910	835	port_speed = USB_HOST_HIGH_SPEED;
okini3939	1:0dac72ab5910	836	} else if ((split_ctl.port_sts_bits[split_ctl.reset_port] & PORT_LOW_SPEED) != 0) {
okini3939	1:0dac72ab5910	837	port_speed = USB_HOST_LOW_SPEED;
okini3939	1:0dac72ab5910	838	} else {
okini3939	1:0dac72ab5910	839	port_speed = USB_HOST_FULL_SPEED;
okini3939	1:0dac72ab5910	840	}
okini3939	1:0dac72ab5910	841	RZA_IO_RegWrite_16(&devadd, port_speed, USB_DEVADDn_USBSPD_SHIFT, USB_DEVADDn_USBSPD);
okini3939	1:0dac72ab5910	842	usbx_host_set_devadd(USB_HOST_DEVICE_0, &devadd);
okini3939	1:0dac72ab5910	843	split_ctl.reset_port = 0;
okini3939	1:0dac72ab5910	844	}
okini3939	1:0dac72ab5910	845	}
okini3939	1:0dac72ab5910	846
okini3939	1:0dac72ab5910	847	static void control_trans(genelal_ed_t *p_g_ed) {
okini3939	1:0dac72ab5910	848	hctd_t p_td = (hctd_t )p_g_ed->p_curr_td;
okini3939	1:0dac72ab5910	849	tdinfo_t td_info;
okini3939	1:0dac72ab5910	850	uint16_t devadd;
okini3939	1:0dac72ab5910	851
okini3939	1:0dac72ab5910	852	get_td_info(p_g_ed, &td_info);
okini3939	1:0dac72ab5910	853
okini3939	1:0dac72ab5910	854	if (g_usbx_host_UsbDeviceSpeed == USB_HOST_HIGH_SPEED) {
okini3939	1:0dac72ab5910	855	if (td_info.devadr == 0) {
okini3939	1:0dac72ab5910	856	set_split_trans_setting();
okini3939	1:0dac72ab5910	857	}
okini3939	1:0dac72ab5910	858	} else {
okini3939	1:0dac72ab5910	859	/* When a non-Hi-Speed, the communication speed is determined from the TD. */
okini3939	1:0dac72ab5910	860	usbx_host_get_devadd(USB_HOST_DEVICE_0, &devadd);
okini3939	1:0dac72ab5910	861	if (td_info.speed == 1) {
okini3939	1:0dac72ab5910	862	RZA_IO_RegWrite_16(&devadd, USB_HOST_LOW_SPEED, USB_DEVADDn_USBSPD_SHIFT, USB_DEVADDn_USBSPD);
okini3939	1:0dac72ab5910	863	} else {
okini3939	1:0dac72ab5910	864	RZA_IO_RegWrite_16(&devadd, USB_HOST_FULL_SPEED, USB_DEVADDn_USBSPD_SHIFT, USB_DEVADDn_USBSPD);
okini3939	1:0dac72ab5910	865	}
okini3939	1:0dac72ab5910	866	usbx_host_set_devadd(td_info.devadr, &devadd);
okini3939	1:0dac72ab5910	867	}
okini3939	1:0dac72ab5910	868
okini3939	1:0dac72ab5910	869	USB20X.DCPMAXP = (td_info.devadr << 12) + td_info.msp;
okini3939	1:0dac72ab5910	870	if (td_info.direction == 0) {
okini3939	1:0dac72ab5910	871	g_usbx_host_CmdStage = (USB_HOST_STAGE_SETUP \| USB_HOST_CMD_IDLE);
okini3939	1:0dac72ab5910	872	} else if (td_info.count != 0) {
okini3939	1:0dac72ab5910	873	g_usbx_host_CmdStage = (USB_HOST_STAGE_DATA \| USB_HOST_CMD_IDLE);
okini3939	1:0dac72ab5910	874	} else {
okini3939	1:0dac72ab5910	875	g_usbx_host_CmdStage = (USB_HOST_STAGE_STATUS \| USB_HOST_CMD_IDLE);
okini3939	1:0dac72ab5910	876	}
okini3939	1:0dac72ab5910	877	g_usbx_host_pipe_status[USB_HOST_PIPE0] = USB_HOST_PIPE_WAIT;
okini3939	1:0dac72ab5910	878	p_g_ed->pipe_no = USB_HOST_PIPE0;
okini3939	1:0dac72ab5910	879
okini3939	1:0dac72ab5910	880	p_g_ed->trans_wait = 1;
okini3939	1:0dac72ab5910	881	if (connect_status == 0) {
okini3939	1:0dac72ab5910	882	ohciwrapp_loc_TransEnd(p_g_ed->pipe_no, TD_CC_DEVICENOTRESPONDING);
okini3939	1:0dac72ab5910	883	} else {
okini3939	1:0dac72ab5910	884	if (td_info.direction == 0) {
okini3939	1:0dac72ab5910	885	uint16_t Req = (p_td->currBufPtr[1] << 8) + p_td->currBufPtr[0];
okini3939	1:0dac72ab5910	886	uint16_t Val = (p_td->currBufPtr[3] << 8) + p_td->currBufPtr[2];
okini3939	1:0dac72ab5910	887	uint16_t Indx = (p_td->currBufPtr[5] << 8) + p_td->currBufPtr[4];
okini3939	1:0dac72ab5910	888	uint16_t Len = (p_td->currBufPtr[7] << 8) + p_td->currBufPtr[6];
okini3939	1:0dac72ab5910	889
okini3939	1:0dac72ab5910	890	g_usbx_host_data_pointer[USB_HOST_PIPE0] = p_td->bufEnd;
okini3939	1:0dac72ab5910	891	usbx_host_SetupStage(Req, Val, Indx, Len);
okini3939	1:0dac72ab5910	892	} else if (td_info.direction == 1) {
okini3939	1:0dac72ab5910	893	usbx_host_CtrlWriteStart(td_info.count, p_td->currBufPtr);
okini3939	1:0dac72ab5910	894	} else {
okini3939	1:0dac72ab5910	895	usbx_host_CtrlReadStart(td_info.count, p_td->currBufPtr);
okini3939	1:0dac72ab5910	896	}
okini3939	1:0dac72ab5910	897
okini3939	1:0dac72ab5910	898	(void)osSemaphoreWait(p_g_ed->semid_wait, CTL_TRANS_TIMEOUT);
okini3939	1:0dac72ab5910	899	if (p_g_ed->trans_wait == 1) {
okini3939	1:0dac72ab5910	900	p_g_ed->trans_wait = 0;
okini3939	1:0dac72ab5910	901	RZA_IO_RegWrite_32(&p_td->control, TD_CC_DEVICENOTRESPONDING, TD_CTL_SHFT_CC, TD_CTL_MSK_CC);
okini3939	1:0dac72ab5910	902	}
okini3939	1:0dac72ab5910	903	}
okini3939	1:0dac72ab5910	904
okini3939	1:0dac72ab5910	905	g_usbx_host_CmdStage &= (~USB_HOST_CMD_FIELD);
okini3939	1:0dac72ab5910	906	g_usbx_host_CmdStage \|= USB_HOST_CMD_IDLE;
okini3939	1:0dac72ab5910	907	g_usbx_host_pipe_status[USB_HOST_PIPE0] = USB_HOST_PIPE_IDLE;
okini3939	1:0dac72ab5910	908	}
okini3939	1:0dac72ab5910	909
okini3939	1:0dac72ab5910	910	static void bulk_trans(genelal_ed_t *p_g_ed) {
okini3939	1:0dac72ab5910	911	hctd_t p_td = (hctd_t )p_g_ed->p_curr_td;
okini3939	1:0dac72ab5910	912	hced_t *p_ed = p_g_ed->p_curr_ed;
okini3939	1:0dac72ab5910	913	tdinfo_t td_info;
okini3939	1:0dac72ab5910	914	USB_HOST_CFG_PIPETBL_t *user_table = &usb_host_blk_ep_tbl1[0];
okini3939	1:0dac72ab5910	915	uint8_t wk_table[6];
okini3939	1:0dac72ab5910	916
okini3939	1:0dac72ab5910	917	get_td_info(p_g_ed, &td_info);
okini3939	1:0dac72ab5910	918
okini3939	1:0dac72ab5910	919	wk_table[0] = 0;
okini3939	1:0dac72ab5910	920	wk_table[1] = USB_HOST_ENDPOINT_DESC;
okini3939	1:0dac72ab5910	921	wk_table[2] = td_info.endpoint_no;
okini3939	1:0dac72ab5910	922	if (td_info.direction == 2) {
okini3939	1:0dac72ab5910	923	wk_table[2] \|= USB_HOST_EP_IN;
okini3939	1:0dac72ab5910	924	}
okini3939	1:0dac72ab5910	925	wk_table[3] = USB_HOST_EP_BULK;
okini3939	1:0dac72ab5910	926	wk_table[4] = (uint8_t)td_info.msp;
okini3939	1:0dac72ab5910	927	wk_table[5] = (uint8_t)(td_info.msp >> 8);
okini3939	1:0dac72ab5910	928	p_g_ed->pipe_no = user_table->pipe_number;
okini3939	1:0dac72ab5910	929	usbx_api_host_SetEndpointTable(td_info.devadr, user_table, wk_table);
okini3939	1:0dac72ab5910	930
okini3939	1:0dac72ab5910	931	set_togle(p_g_ed->pipe_no, p_td, p_ed);
okini3939	1:0dac72ab5910	932
okini3939	1:0dac72ab5910	933	p_g_ed->trans_wait = 1;
okini3939	1:0dac72ab5910	934	if (connect_status == 0) {
okini3939	1:0dac72ab5910	935	ohciwrapp_loc_TransEnd(p_g_ed->pipe_no, TD_CC_DEVICENOTRESPONDING);
okini3939	1:0dac72ab5910	936	} else {
okini3939	1:0dac72ab5910	937	if (td_info.direction == 1) {
okini3939	1:0dac72ab5910	938	usbx_host_start_send_transfer(p_g_ed->pipe_no, td_info.count, p_td->currBufPtr);
okini3939	1:0dac72ab5910	939	} else {
okini3939	1:0dac72ab5910	940	usbx_host_start_receive_transfer(p_g_ed->pipe_no, td_info.count, p_td->currBufPtr);
okini3939	1:0dac72ab5910	941	}
okini3939	1:0dac72ab5910	942
okini3939	1:0dac72ab5910	943	(void)osSemaphoreWait(p_g_ed->semid_wait, BLK_TRANS_TIMEOUT);
okini3939	1:0dac72ab5910	944	usbx_host_stop_transfer(p_g_ed->pipe_no);
okini3939	1:0dac72ab5910	945	}
okini3939	1:0dac72ab5910	946	}
okini3939	1:0dac72ab5910	947
okini3939	1:0dac72ab5910	948	static void int_trans_setting(genelal_ed_t *p_g_ed, uint32_t index) {
okini3939	1:0dac72ab5910	949	hctd_t p_td = (hctd_t )p_g_ed->p_curr_td;
okini3939	1:0dac72ab5910	950	hced_t *p_ed = p_g_ed->p_curr_ed;
okini3939	1:0dac72ab5910	951	tdinfo_t td_info;
okini3939	1:0dac72ab5910	952	USB_HOST_CFG_PIPETBL_t *user_table = &usb_host_int_ep_tbl1[index];
okini3939	1:0dac72ab5910	953	uint8_t wk_table[6];
okini3939	1:0dac72ab5910	954	uint32_t cycle_time;
okini3939	1:0dac72ab5910	955	uint16_t devadd;
okini3939	1:0dac72ab5910	956
okini3939	1:0dac72ab5910	957	get_td_info(p_g_ed, &td_info);
okini3939	1:0dac72ab5910	958
okini3939	1:0dac72ab5910	959	wk_table[0] = 0;
okini3939	1:0dac72ab5910	960	wk_table[1] = USB_HOST_ENDPOINT_DESC;
okini3939	1:0dac72ab5910	961	wk_table[2] = td_info.endpoint_no;
okini3939	1:0dac72ab5910	962	if (td_info.direction == 2) {
okini3939	1:0dac72ab5910	963	wk_table[2] \|= USB_HOST_EP_IN;
okini3939	1:0dac72ab5910	964	}
okini3939	1:0dac72ab5910	965	wk_table[3] = USB_HOST_EP_INT;
okini3939	1:0dac72ab5910	966	wk_table[4] = (uint8_t)td_info.msp;
okini3939	1:0dac72ab5910	967	wk_table[5] = (uint8_t)(td_info.msp >> 8);
okini3939	1:0dac72ab5910	968	cycle_time = chk_cycle(p_ed);
okini3939	1:0dac72ab5910	969	p_g_ed->cycle_time = cycle_time;
okini3939	1:0dac72ab5910	970	user_table->pipe_cycle = 0;
okini3939	1:0dac72ab5910	971	while (cycle_time > 1) {
okini3939	1:0dac72ab5910	972	cycle_time >>= 1;
okini3939	1:0dac72ab5910	973	user_table->pipe_cycle++;
okini3939	1:0dac72ab5910	974	}
okini3939	1:0dac72ab5910	975	if (g_usbx_host_UsbDeviceSpeed == USB_HOST_HIGH_SPEED) {
okini3939	1:0dac72ab5910	976	usbx_host_get_devadd(td_info.devadr, &devadd);
okini3939	1:0dac72ab5910	977	if (RZA_IO_RegRead_16(&devadd, USB_DEVADDn_USBSPD_SHIFT, USB_DEVADDn_USBSPD) == USB_HOST_HIGH_SPEED) {
okini3939	1:0dac72ab5910	978	user_table->pipe_cycle += 3;
okini3939	1:0dac72ab5910	979	if (user_table->pipe_cycle > 7) {
okini3939	1:0dac72ab5910	980	user_table->pipe_cycle = 7;
okini3939	1:0dac72ab5910	981	}
okini3939	1:0dac72ab5910	982	}
okini3939	1:0dac72ab5910	983	}
okini3939	1:0dac72ab5910	984
okini3939	1:0dac72ab5910	985	p_g_ed->pipe_no = user_table->pipe_number;
okini3939	1:0dac72ab5910	986	usbx_api_host_SetEndpointTable(td_info.devadr, user_table, wk_table);
okini3939	1:0dac72ab5910	987
okini3939	1:0dac72ab5910	988	set_togle(p_g_ed->pipe_no, p_td, p_ed);
okini3939	1:0dac72ab5910	989	}
okini3939	1:0dac72ab5910	990
okini3939	1:0dac72ab5910	991	static uint32_t chk_cycle(hced_t *p_ed) {
okini3939	1:0dac72ab5910	992	uint32_t cnt;
okini3939	1:0dac72ab5910	993	uint32_t hit_cnt = 0;
okini3939	1:0dac72ab5910	994	uint32_t cycle_time = 1;
okini3939	1:0dac72ab5910	995	hcca_t *p_hcca;
okini3939	1:0dac72ab5910	996	hced_t *p_wk_ed;
okini3939	1:0dac72ab5910	997
okini3939	1:0dac72ab5910	998	p_hcca = (hcca_t *)p_usb_reg->HcHCCA;
okini3939	1:0dac72ab5910	999
okini3939	1:0dac72ab5910	1000	for (cnt = 0; cnt < 32; cnt++) {
okini3939	1:0dac72ab5910	1001	p_wk_ed = (hced_t *)p_hcca->IntTable[cnt];
okini3939	1:0dac72ab5910	1002	while (p_wk_ed != NULL) {
okini3939	1:0dac72ab5910	1003	if (p_wk_ed == p_ed) {
okini3939	1:0dac72ab5910	1004	hit_cnt++;
okini3939	1:0dac72ab5910	1005	break;
okini3939	1:0dac72ab5910	1006	}
okini3939	1:0dac72ab5910	1007	p_wk_ed = p_wk_ed->nextED;
okini3939	1:0dac72ab5910	1008	}
okini3939	1:0dac72ab5910	1009	}
okini3939	1:0dac72ab5910	1010	if (hit_cnt < 2) {
okini3939	1:0dac72ab5910	1011	cycle_time = 32;
okini3939	1:0dac72ab5910	1012	} else if (hit_cnt < 4) {
okini3939	1:0dac72ab5910	1013	cycle_time = 16;
okini3939	1:0dac72ab5910	1014	} else if (hit_cnt < 8) {
okini3939	1:0dac72ab5910	1015	cycle_time = 8;
okini3939	1:0dac72ab5910	1016	} else if (hit_cnt < 16) {
okini3939	1:0dac72ab5910	1017	cycle_time = 4;
okini3939	1:0dac72ab5910	1018	} else if (hit_cnt < 32) {
okini3939	1:0dac72ab5910	1019	cycle_time = 2;
okini3939	1:0dac72ab5910	1020	} else{
okini3939	1:0dac72ab5910	1021	cycle_time = 1;
okini3939	1:0dac72ab5910	1022	}
okini3939	1:0dac72ab5910	1023
okini3939	1:0dac72ab5910	1024	return cycle_time;
okini3939	1:0dac72ab5910	1025	}
okini3939	1:0dac72ab5910	1026
okini3939	1:0dac72ab5910	1027	static void int_trans(genelal_ed_t *p_g_ed) {
okini3939	1:0dac72ab5910	1028	hctd_t p_td = (hctd_t )p_g_ed->p_curr_td;
okini3939	1:0dac72ab5910	1029	tdinfo_t td_info;
okini3939	1:0dac72ab5910	1030
okini3939	1:0dac72ab5910	1031	get_td_info(p_g_ed, &td_info);
okini3939	1:0dac72ab5910	1032	p_g_ed->trans_wait = 1;
okini3939	1:0dac72ab5910	1033	if (connect_status == 0) {
okini3939	1:0dac72ab5910	1034	ohciwrapp_loc_TransEnd(p_g_ed->pipe_no, TD_CC_DEVICENOTRESPONDING);
okini3939	1:0dac72ab5910	1035	} else {
okini3939	1:0dac72ab5910	1036	if (td_info.direction == 1) {
okini3939	1:0dac72ab5910	1037	usbx_host_start_send_transfer(p_g_ed->pipe_no, td_info.count, p_td->currBufPtr);
okini3939	1:0dac72ab5910	1038	} else {
okini3939	1:0dac72ab5910	1039	usbx_host_start_receive_transfer(p_g_ed->pipe_no, td_info.count, p_td->currBufPtr);
okini3939	1:0dac72ab5910	1040	}
okini3939	1:0dac72ab5910	1041	}
okini3939	1:0dac72ab5910	1042	}
okini3939	1:0dac72ab5910	1043
okini3939	1:0dac72ab5910	1044	static void get_td_info(genelal_ed_t p_g_ed, tdinfo_t p_td_info) {
okini3939	1:0dac72ab5910	1045	hced_t *p_ed = p_g_ed->p_curr_ed;
okini3939	1:0dac72ab5910	1046
okini3939	1:0dac72ab5910	1047	p_td_info->endpoint_no = (uint8_t)((p_ed->control >> 7) & 0x0000000F);
okini3939	1:0dac72ab5910	1048	p_td_info->msp = (p_ed->control >> 16) & 0x000007FF;
okini3939	1:0dac72ab5910	1049	p_td_info->devadr = p_ed->control & 0x0000000F;
okini3939	1:0dac72ab5910	1050	p_td_info->speed = (p_ed->control >> 13) & 0x00000001;
okini3939	1:0dac72ab5910	1051	p_td_info->direction = (p_ed->control >> 11) & 0x00000003;
okini3939	1:0dac72ab5910	1052
okini3939	1:0dac72ab5910	1053	if ((p_ed->control & ED_FORMAT) == 0) {
okini3939	1:0dac72ab5910	1054	hctd_t p_td = (hctd_t )p_g_ed->p_curr_td;
okini3939	1:0dac72ab5910	1055
okini3939	1:0dac72ab5910	1056	if ((p_td_info->direction == 0) \|\| (p_td_info->direction == 3)) {
okini3939	1:0dac72ab5910	1057	if ((p_td->control & TD_CTL_MSK_DP) == TD_SETUP) {
okini3939	1:0dac72ab5910	1058	p_td_info->direction = 0;
okini3939	1:0dac72ab5910	1059	} else if ((p_td->control & TD_CTL_MSK_DP) == TD_OUT) {
okini3939	1:0dac72ab5910	1060	p_td_info->direction = 1;
okini3939	1:0dac72ab5910	1061	} else {
okini3939	1:0dac72ab5910	1062	p_td_info->direction = 2;
okini3939	1:0dac72ab5910	1063	}
okini3939	1:0dac72ab5910	1064	}
okini3939	1:0dac72ab5910	1065	if (p_td->currBufPtr != NULL) {
okini3939	1:0dac72ab5910	1066	p_td_info->count = (uint32_t)p_td->bufEnd - (uint32_t)p_td->currBufPtr + 1;
okini3939	1:0dac72ab5910	1067	} else {
okini3939	1:0dac72ab5910	1068	p_td_info->count = 0;
okini3939	1:0dac72ab5910	1069	}
okini3939	1:0dac72ab5910	1070	} else {
okini3939	1:0dac72ab5910	1071	#if (ISO_TRANS_MAX_NUM > 0)
okini3939	1:0dac72ab5910	1072	hcisotd_t p_isotd = (hcisotd_t )p_g_ed->p_curr_td;
okini3939	1:0dac72ab5910	1073
okini3939	1:0dac72ab5910	1074	if ((p_td_info->direction == 0) \|\| (p_td_info->direction == 3)) {
okini3939	1:0dac72ab5910	1075	if ((p_isotd->control & TD_CTL_MSK_DP) == TD_SETUP) {
okini3939	1:0dac72ab5910	1076	p_td_info->direction = 0;
okini3939	1:0dac72ab5910	1077	} else if ((p_isotd->control & TD_CTL_MSK_DP) == TD_OUT) {
okini3939	1:0dac72ab5910	1078	p_td_info->direction = 1;
okini3939	1:0dac72ab5910	1079	} else {
okini3939	1:0dac72ab5910	1080	p_td_info->direction = 2;
okini3939	1:0dac72ab5910	1081	}
okini3939	1:0dac72ab5910	1082	}
okini3939	1:0dac72ab5910	1083	#endif
okini3939	1:0dac72ab5910	1084	}
okini3939	1:0dac72ab5910	1085	}
okini3939	1:0dac72ab5910	1086
okini3939	1:0dac72ab5910	1087	static void set_togle(uint32_t pipe, hctd_t p_td, hced_t p_ed) {
okini3939	1:0dac72ab5910	1088	if ((p_td->control & TD_CTL_MSK_T) == TD_TOGGLE_0) {
okini3939	1:0dac72ab5910	1089	usbx_host_set_sqclr(pipe);
okini3939	1:0dac72ab5910	1090	} else if ((p_td->control & TD_CTL_MSK_T) == TD_TOGGLE_1) {
okini3939	1:0dac72ab5910	1091	usbx_host_set_sqset(pipe);
okini3939	1:0dac72ab5910	1092	} else if ((p_ed->headTD & ED_TOGLE_CARRY) == 0) {
okini3939	1:0dac72ab5910	1093	usbx_host_set_sqclr(pipe);
okini3939	1:0dac72ab5910	1094	} else {
okini3939	1:0dac72ab5910	1095	usbx_host_set_sqset(pipe);
okini3939	1:0dac72ab5910	1096	}
okini3939	1:0dac72ab5910	1097	}
okini3939	1:0dac72ab5910	1098
okini3939	1:0dac72ab5910	1099	#if (ISO_TRANS_MAX_NUM > 0)
okini3939	1:0dac72ab5910	1100	static void iso_ed_task(void const * argument) {
okini3939	1:0dac72ab5910	1101	genelal_ed_t *p_iso_ed = &iso_ed[(uint32_t)argument];
okini3939	1:0dac72ab5910	1102	uint32_t wait_cnt = 0;
okini3939	1:0dac72ab5910	1103	hcca_t *p_hcca;
okini3939	1:0dac72ab5910	1104	hced_t *p_ed;
okini3939	1:0dac72ab5910	1105
okini3939	1:0dac72ab5910	1106	while (1) {
okini3939	1:0dac72ab5910	1107	(void)osSemaphoreWait(p_iso_ed->semid_list, osWaitForever);
okini3939	1:0dac72ab5910	1108	if (p_iso_ed->p_curr_ed == NULL) {
okini3939	1:0dac72ab5910	1109	p_hcca = (hcca_t *)p_usb_reg->HcHCCA;
okini3939	1:0dac72ab5910	1110	p_ed = (hced_t *)p_hcca->IntTable[0];
okini3939	1:0dac72ab5910	1111	while ((p_ed != NULL) && ((p_usb_reg->HcControl & OR_CONTROL_IE) != 0)
okini3939	1:0dac72ab5910	1112	&& (p_iso_ed->p_curr_ed == NULL)) {
okini3939	1:0dac72ab5910	1113	if (iso_trans_doing(p_ed, (uint32_t)argument) == 0) {
okini3939	1:0dac72ab5910	1114	p_iso_ed->p_curr_ed = p_ed;
okini3939	1:0dac72ab5910	1115	if (chk_iso_ed(p_iso_ed) != 0) {
okini3939	1:0dac72ab5910	1116	iso_trans_setting(p_iso_ed, (uint32_t)argument);
okini3939	1:0dac72ab5910	1117	} else {
okini3939	1:0dac72ab5910	1118	p_iso_ed->p_curr_ed = NULL;
okini3939	1:0dac72ab5910	1119	}
okini3939	1:0dac72ab5910	1120	}
okini3939	1:0dac72ab5910	1121	p_ed = p_ed->nextED;
okini3939	1:0dac72ab5910	1122	}
okini3939	1:0dac72ab5910	1123	p_iso_ed->psw_idx = 0;
okini3939	1:0dac72ab5910	1124	}
okini3939	1:0dac72ab5910	1125	if (p_iso_ed->p_curr_ed != NULL) {
okini3939	1:0dac72ab5910	1126	while ((p_usb_reg->HcControl & OR_CONTROL_IE) != 0) {
okini3939	1:0dac72ab5910	1127	if (chk_iso_ed(p_iso_ed) != 0) {
okini3939	1:0dac72ab5910	1128	hcisotd_t p_isotd = (hcisotd_t )p_iso_ed->p_curr_td;
okini3939	1:0dac72ab5910	1129	uint32_t starting_frame = p_isotd->control & 0x0000FFFF;
okini3939	1:0dac72ab5910	1130	uint32_t wait_time = 0;
okini3939	1:0dac72ab5910	1131	uint32_t wk_HcFmNumber = p_usb_reg->HcFmNumber;
okini3939	1:0dac72ab5910	1132
okini3939	1:0dac72ab5910	1133	if (starting_frame > wk_HcFmNumber) {
okini3939	1:0dac72ab5910	1134	wait_time = starting_frame - wk_HcFmNumber;
okini3939	1:0dac72ab5910	1135	} else {
okini3939	1:0dac72ab5910	1136	wait_time = (0xFFFF - wk_HcFmNumber) + starting_frame;
okini3939	1:0dac72ab5910	1137	}
okini3939	1:0dac72ab5910	1138	if ((wait_time >= 2) && (wait_time <= 1000)) {
okini3939	1:0dac72ab5910	1139	for (int cnt = 0; cnt < (wait_time - 1); cnt++) {
okini3939	1:0dac72ab5910	1140	osDelay(1);
okini3939	1:0dac72ab5910	1141	p_usb_reg->HcFmNumber = (wk_HcFmNumber + cnt) & 0x0000FFFF;
okini3939	1:0dac72ab5910	1142	}
okini3939	1:0dac72ab5910	1143	}
okini3939	1:0dac72ab5910	1144	p_iso_ed->psw_idx = 0;
okini3939	1:0dac72ab5910	1145	iso_trans(p_iso_ed);
okini3939	1:0dac72ab5910	1146	(void)osSemaphoreWait(p_iso_ed->semid_wait, osWaitForever);
okini3939	1:0dac72ab5910	1147	wait_cnt = 8;
okini3939	1:0dac72ab5910	1148	} else {
okini3939	1:0dac72ab5910	1149	if (wait_cnt > 0) {
okini3939	1:0dac72ab5910	1150	wait_cnt--;
okini3939	1:0dac72ab5910	1151	} else {
okini3939	1:0dac72ab5910	1152	p_iso_ed->p_curr_ed = NULL;
okini3939	1:0dac72ab5910	1153	}
okini3939	1:0dac72ab5910	1154	break;
okini3939	1:0dac72ab5910	1155	}
okini3939	1:0dac72ab5910	1156	}
okini3939	1:0dac72ab5910	1157	}
okini3939	1:0dac72ab5910	1158	(void)osSemaphoreRelease(p_iso_ed->semid_list);
okini3939	1:0dac72ab5910	1159	if (p_iso_ed->p_curr_ed == NULL) {
okini3939	1:0dac72ab5910	1160	osDelay(10);
okini3939	1:0dac72ab5910	1161	} else {
okini3939	1:0dac72ab5910	1162	osDelay(1);
okini3939	1:0dac72ab5910	1163	}
okini3939	1:0dac72ab5910	1164	}
okini3939	1:0dac72ab5910	1165	}
okini3939	1:0dac72ab5910	1166
okini3939	1:0dac72ab5910	1167	static int32_t iso_trans_doing(hced_t *p_ed, uint32_t index) {
okini3939	1:0dac72ab5910	1168	uint32_t cnt;
okini3939	1:0dac72ab5910	1169	int32_t ret = 0;
okini3939	1:0dac72ab5910	1170
okini3939	1:0dac72ab5910	1171	for (cnt = 0; cnt < ISO_TRANS_MAX_NUM; cnt++) {
okini3939	1:0dac72ab5910	1172	if ((index != cnt) && (iso_ed[cnt].p_curr_ed == p_ed)) {
okini3939	1:0dac72ab5910	1173	ret = 1;
okini3939	1:0dac72ab5910	1174	}
okini3939	1:0dac72ab5910	1175	}
okini3939	1:0dac72ab5910	1176
okini3939	1:0dac72ab5910	1177	return ret;
okini3939	1:0dac72ab5910	1178	}
okini3939	1:0dac72ab5910	1179
okini3939	1:0dac72ab5910	1180	static void chk_iso_td_done(genelal_ed_t *p_g_ed) {
okini3939	1:0dac72ab5910	1181	hcca_t *p_hcca;
okini3939	1:0dac72ab5910	1182	hcisotd_t p_isotd = (hcisotd_t )p_g_ed->p_curr_td;
okini3939	1:0dac72ab5910	1183	uint32_t ConditionCode = RZA_IO_RegRead_32(&p_isotd->control, TD_CTL_SHFT_CC, TD_CTL_MSK_CC);
okini3939	1:0dac72ab5910	1184
okini3939	1:0dac72ab5910	1185	if ((ConditionCode != TD_CC_NOT_ACCESSED_1) && (ConditionCode != TD_CC_NOT_ACCESSED_2)) {
okini3939	1:0dac72ab5910	1186	p_g_ed->p_curr_ed->headTD = ((uint32_t)p_isotd->nextTD & 0xFFFFFFF0)
okini3939	1:0dac72ab5910	1187	\| (p_g_ed->p_curr_ed->headTD & 0x0000000F);
okini3939	1:0dac72ab5910	1188	p_isotd->nextTD = (hcisotd_t *)p_usb_reg->HcDoneHead;
okini3939	1:0dac72ab5910	1189	p_usb_reg->HcDoneHead = (uint32_t)p_g_ed->p_curr_td;
okini3939	1:0dac72ab5910	1190	if ((p_usb_reg->HcInterruptStatus & OR_INTR_STATUS_WDH) == 0) {
okini3939	1:0dac72ab5910	1191	p_hcca = (hcca_t *)p_usb_reg->HcHCCA;
okini3939	1:0dac72ab5910	1192	p_hcca->DoneHead = p_usb_reg->HcDoneHead;
okini3939	1:0dac72ab5910	1193	p_usb_reg->HcDoneHead = 0x00000000;
okini3939	1:0dac72ab5910	1194	p_usb_reg->HcInterruptStatus \|= OR_INTR_STATUS_WDH;
okini3939	1:0dac72ab5910	1195	(void)osSemaphoreRelease(semid_cb);
okini3939	1:0dac72ab5910	1196	}
okini3939	1:0dac72ab5910	1197	}
okini3939	1:0dac72ab5910	1198	}
okini3939	1:0dac72ab5910	1199
okini3939	1:0dac72ab5910	1200	static int32_t chk_iso_ed(genelal_ed_t *p_g_ed){
okini3939	1:0dac72ab5910	1201	int32_t ret = 0;
okini3939	1:0dac72ab5910	1202	hced_t *p_ed = p_g_ed->p_curr_ed;
okini3939	1:0dac72ab5910	1203
okini3939	1:0dac72ab5910	1204	if (((p_ed->control & ED_SKIP) != 0)
okini3939	1:0dac72ab5910	1205	\|\| ((p_ed->control & ED_FORMAT) == 0)
okini3939	1:0dac72ab5910	1206	\|\| ((p_ed->headTD & ED_HALTED) != 0)
okini3939	1:0dac72ab5910	1207	\|\| ((p_ed->tailTD & 0xFFFFFFF0) == (p_ed->headTD & 0xFFFFFFF0))) {
okini3939	1:0dac72ab5910	1208	/* Do Nothing */
okini3939	1:0dac72ab5910	1209	} else if ((p_ed->control & 0x0000007F) > 10) {
okini3939	1:0dac72ab5910	1210	p_ed->headTD \|= ED_HALTED;
okini3939	1:0dac72ab5910	1211	} else {
okini3939	1:0dac72ab5910	1212	p_g_ed->p_curr_td = (void *)(p_ed->headTD & 0xFFFFFFF0);
okini3939	1:0dac72ab5910	1213	if (p_g_ed->p_curr_td == NULL) {
okini3939	1:0dac72ab5910	1214	p_ed->headTD \|= ED_HALTED;
okini3939	1:0dac72ab5910	1215	} else {
okini3939	1:0dac72ab5910	1216	hcisotd_t p_isotd = (hcisotd_t )p_g_ed->p_curr_td;
okini3939	1:0dac72ab5910	1217
okini3939	1:0dac72ab5910	1218	p_g_ed->p_start_buf = p_isotd->bufferPage0;
okini3939	1:0dac72ab5910	1219	ret = 1;
okini3939	1:0dac72ab5910	1220	}
okini3939	1:0dac72ab5910	1221	}
okini3939	1:0dac72ab5910	1222
okini3939	1:0dac72ab5910	1223	return ret;
okini3939	1:0dac72ab5910	1224	}
okini3939	1:0dac72ab5910	1225
okini3939	1:0dac72ab5910	1226	static void iso_trans_setting(genelal_ed_t *p_g_ed, uint32_t index) {
okini3939	1:0dac72ab5910	1227	tdinfo_t td_info;
okini3939	1:0dac72ab5910	1228	USB_HOST_CFG_PIPETBL_t *user_table = &usb_host_iso_ep_tbl1[index];
okini3939	1:0dac72ab5910	1229	uint8_t wk_table[6];
okini3939	1:0dac72ab5910	1230	uint16_t devadd;
okini3939	1:0dac72ab5910	1231
okini3939	1:0dac72ab5910	1232	get_td_info(p_g_ed, &td_info);
okini3939	1:0dac72ab5910	1233
okini3939	1:0dac72ab5910	1234	wk_table[0] = 0;
okini3939	1:0dac72ab5910	1235	wk_table[1] = USB_HOST_ENDPOINT_DESC;
okini3939	1:0dac72ab5910	1236	wk_table[2] = td_info.endpoint_no;
okini3939	1:0dac72ab5910	1237	if (td_info.direction == 2) {
okini3939	1:0dac72ab5910	1238	wk_table[2] \|= USB_HOST_EP_IN;
okini3939	1:0dac72ab5910	1239	}
okini3939	1:0dac72ab5910	1240	wk_table[3] = USB_HOST_EP_ISO;
okini3939	1:0dac72ab5910	1241	wk_table[4] = (uint8_t)td_info.msp;
okini3939	1:0dac72ab5910	1242	wk_table[5] = (uint8_t)(td_info.msp >> 8);
okini3939	1:0dac72ab5910	1243	p_g_ed->cycle_time = 1;
okini3939	1:0dac72ab5910	1244	user_table->pipe_cycle = 0;
okini3939	1:0dac72ab5910	1245	if (g_usbx_host_UsbDeviceSpeed == USB_HOST_HIGH_SPEED) {
okini3939	1:0dac72ab5910	1246	usbx_host_get_devadd(td_info.devadr, &devadd);
okini3939	1:0dac72ab5910	1247	if (RZA_IO_RegRead_16(&devadd, USB_DEVADDn_USBSPD_SHIFT, USB_DEVADDn_USBSPD) == USB_HOST_HIGH_SPEED) {
okini3939	1:0dac72ab5910	1248	user_table->pipe_cycle += 3;
okini3939	1:0dac72ab5910	1249	}
okini3939	1:0dac72ab5910	1250	}
okini3939	1:0dac72ab5910	1251
okini3939	1:0dac72ab5910	1252	p_g_ed->pipe_no = user_table->pipe_number;
okini3939	1:0dac72ab5910	1253	usbx_api_host_SetEndpointTable(td_info.devadr, user_table, wk_table);
okini3939	1:0dac72ab5910	1254	}
okini3939	1:0dac72ab5910	1255
okini3939	1:0dac72ab5910	1256	static void iso_trans(genelal_ed_t *p_g_ed) {
okini3939	1:0dac72ab5910	1257	hcisotd_t p_isotd = (hcisotd_t )p_g_ed->p_curr_td;
okini3939	1:0dac72ab5910	1258	tdinfo_t td_info;
okini3939	1:0dac72ab5910	1259	uint32_t buff_addr;
okini3939	1:0dac72ab5910	1260	uint32_t data_size;
okini3939	1:0dac72ab5910	1261
okini3939	1:0dac72ab5910	1262	if (((uint32_t)p_isotd->offsetPSW[p_g_ed->psw_idx] & 0x00001000) == 0) {
okini3939	1:0dac72ab5910	1263	buff_addr = (uint32_t)p_isotd->bufferPage0 & 0xFFFFF000;
okini3939	1:0dac72ab5910	1264	} else {
okini3939	1:0dac72ab5910	1265	buff_addr = (uint32_t)p_isotd->bufEnd & 0xFFFFF000;
okini3939	1:0dac72ab5910	1266	}
okini3939	1:0dac72ab5910	1267	buff_addr \|= (uint32_t)p_isotd->offsetPSW[p_g_ed->psw_idx] & 0x00000FFF;
okini3939	1:0dac72ab5910	1268
okini3939	1:0dac72ab5910	1269	if (p_g_ed->psw_idx < RZA_IO_RegRead_32(&p_isotd->control, TD_CTL_SHFT_FC, TD_CTL_MSK_FC)) {
okini3939	1:0dac72ab5910	1270	data_size = p_isotd->offsetPSW[p_g_ed->psw_idx + 1] - p_isotd->offsetPSW[p_g_ed->psw_idx];
okini3939	1:0dac72ab5910	1271	} else {
okini3939	1:0dac72ab5910	1272	data_size = (uint32_t)p_isotd->bufEnd - buff_addr + 1;
okini3939	1:0dac72ab5910	1273	}
okini3939	1:0dac72ab5910	1274	p_isotd->offsetPSW[p_g_ed->psw_idx] = (uint16_t)data_size;
okini3939	1:0dac72ab5910	1275
okini3939	1:0dac72ab5910	1276	get_td_info(p_g_ed, &td_info);
okini3939	1:0dac72ab5910	1277	p_g_ed->trans_wait = 1;
okini3939	1:0dac72ab5910	1278	if (connect_status == 0) {
okini3939	1:0dac72ab5910	1279	ohciwrapp_loc_TransEnd(p_g_ed->pipe_no, TD_CC_DEVICENOTRESPONDING);
okini3939	1:0dac72ab5910	1280	} else {
okini3939	1:0dac72ab5910	1281	if (td_info.direction == 1) {
okini3939	1:0dac72ab5910	1282	usbx_host_start_send_transfer(p_g_ed->pipe_no, data_size, (uint8_t *)buff_addr);
okini3939	1:0dac72ab5910	1283	} else {
okini3939	1:0dac72ab5910	1284	usbx_host_start_receive_transfer(p_g_ed->pipe_no, data_size, (uint8_t *)buff_addr);
okini3939	1:0dac72ab5910	1285	}
okini3939	1:0dac72ab5910	1286	}
okini3939	1:0dac72ab5910	1287	}
okini3939	1:0dac72ab5910	1288	#endif
okini3939	1:0dac72ab5910	1289
okini3939	1:0dac72ab5910	1290	static void connect_check(void) {
okini3939	1:0dac72ab5910	1291	uint32_t type = 0;
okini3939	1:0dac72ab5910	1292	uint16_t stat;
okini3939	1:0dac72ab5910	1293	uint16_t devadd = 0;
okini3939	1:0dac72ab5910	1294	uint32_t wk_HcRhPortStatus1 = p_usb_reg->HcRhPortStatus1;
okini3939	1:0dac72ab5910	1295
okini3939	1:0dac72ab5910	1296	if (usbx_host_CheckAttach() == USB_HOST_ATTACH) {
okini3939	1:0dac72ab5910	1297	type = 1;
okini3939	1:0dac72ab5910	1298	}
okini3939	1:0dac72ab5910	1299
okini3939	1:0dac72ab5910	1300	if ((((wk_HcRhPortStatus1 & OR_RH_PORT_CCS) == 0) && (type == 0))
okini3939	1:0dac72ab5910	1301	\|\| (((wk_HcRhPortStatus1 & OR_RH_PORT_CCS) != 0) && (type != 0))) {
okini3939	1:0dac72ab5910	1302	return;
okini3939	1:0dac72ab5910	1303	}
okini3939	1:0dac72ab5910	1304
okini3939	1:0dac72ab5910	1305	if (type == 0) {
okini3939	1:0dac72ab5910	1306	usbx_host_UsbDetach();
okini3939	1:0dac72ab5910	1307	wk_HcRhPortStatus1 &= ~OR_RH_PORT_CCS;
okini3939	1:0dac72ab5910	1308	} else {
okini3939	1:0dac72ab5910	1309	usbx_host_UsbAttach();
okini3939	1:0dac72ab5910	1310	stat = usbx_host_UsbBusReset();
okini3939	1:0dac72ab5910	1311	RZA_IO_RegWrite_16(&devadd, 0, USB_DEVADDn_UPPHUB_SHIFT, USB_DEVADDn_UPPHUB);
okini3939	1:0dac72ab5910	1312	RZA_IO_RegWrite_16(&devadd, 0, USB_DEVADDn_HUBPORT_SHIFT, USB_DEVADDn_HUBPORT);
okini3939	1:0dac72ab5910	1313	if (stat == USB_HOST_HSMODE) {
okini3939	1:0dac72ab5910	1314	wk_HcRhPortStatus1 &= ~OR_RH_PORT_LSDA;
okini3939	1:0dac72ab5910	1315	RZA_IO_RegWrite_16(&USB20X.SOFCFG, 0, USB_SOFCFG_TRNENSEL_SHIFT, USB_SOFCFG_TRNENSEL);
okini3939	1:0dac72ab5910	1316	g_usbx_host_UsbDeviceSpeed = USB_HOST_HIGH_SPEED;
okini3939	1:0dac72ab5910	1317	} else if (stat == USB_HOST_FSMODE) {
okini3939	1:0dac72ab5910	1318	wk_HcRhPortStatus1 &= ~OR_RH_PORT_LSDA;
okini3939	1:0dac72ab5910	1319	RZA_IO_RegWrite_16(&USB20X.SOFCFG, 0, USB_SOFCFG_TRNENSEL_SHIFT, USB_SOFCFG_TRNENSEL);
okini3939	1:0dac72ab5910	1320	g_usbx_host_UsbDeviceSpeed = USB_HOST_FULL_SPEED;
okini3939	1:0dac72ab5910	1321	} else {
okini3939	1:0dac72ab5910	1322	wk_HcRhPortStatus1 \|= OR_RH_PORT_LSDA;
okini3939	1:0dac72ab5910	1323	RZA_IO_RegWrite_16(&USB20X.SOFCFG, 1, USB_SOFCFG_TRNENSEL_SHIFT, USB_SOFCFG_TRNENSEL);
okini3939	1:0dac72ab5910	1324	g_usbx_host_UsbDeviceSpeed = USB_HOST_LOW_SPEED;
okini3939	1:0dac72ab5910	1325	}
okini3939	1:0dac72ab5910	1326	RZA_IO_RegWrite_16(&devadd, g_usbx_host_UsbDeviceSpeed, USB_DEVADDn_USBSPD_SHIFT, USB_DEVADDn_USBSPD);
okini3939	1:0dac72ab5910	1327	usbx_host_init_pipe_status();
okini3939	1:0dac72ab5910	1328	usbx_host_set_devadd(USB_HOST_DEVICE_0, &devadd);
okini3939	1:0dac72ab5910	1329	wk_HcRhPortStatus1 \|= OR_RH_PORT_CCS;
okini3939	1:0dac72ab5910	1330	}
okini3939	1:0dac72ab5910	1331	wk_HcRhPortStatus1 \|= OR_RH_PORT_CSC;
okini3939	1:0dac72ab5910	1332	p_usb_reg->HcRhPortStatus1 = wk_HcRhPortStatus1;
okini3939	1:0dac72ab5910	1333	p_usb_reg->HcInterruptStatus \|= OR_INTR_STATUS_RHSC;
okini3939	1:0dac72ab5910	1334	(void)memset(&split_ctl, 0, sizeof(split_ctl));
okini3939	1:0dac72ab5910	1335	}
okini3939	1:0dac72ab5910	1336
okini3939	1:0dac72ab5910	1337	void ohciwrapp_loc_Connect(uint32_t type) {
okini3939	1:0dac72ab5910	1338	uint32_t cnt;
okini3939	1:0dac72ab5910	1339
okini3939	1:0dac72ab5910	1340	connect_status = type;
okini3939	1:0dac72ab5910	1341	connect_change = type;
okini3939	1:0dac72ab5910	1342	if (type == 0) {
okini3939	1:0dac72ab5910	1343	if (ctl_ed.trans_wait == 1) {
okini3939	1:0dac72ab5910	1344	ohciwrapp_loc_TransEnd(ctl_ed.pipe_no, TD_CC_DEVICENOTRESPONDING);
okini3939	1:0dac72ab5910	1345	}
okini3939	1:0dac72ab5910	1346	if (blk_ed.trans_wait == 1) {
okini3939	1:0dac72ab5910	1347	ohciwrapp_loc_TransEnd(blk_ed.pipe_no, TD_CC_DEVICENOTRESPONDING);
okini3939	1:0dac72ab5910	1348	}
okini3939	1:0dac72ab5910	1349	for (cnt = 0; cnt< INT_TRANS_MAX_NUM; cnt++) {
okini3939	1:0dac72ab5910	1350	if (int_ed[cnt].trans_wait == 1) {
okini3939	1:0dac72ab5910	1351	ohciwrapp_loc_TransEnd(int_ed[cnt].pipe_no, TD_CC_DEVICENOTRESPONDING);
okini3939	1:0dac72ab5910	1352	}
okini3939	1:0dac72ab5910	1353	}
okini3939	1:0dac72ab5910	1354	#if (ISO_TRANS_MAX_NUM > 0)
okini3939	1:0dac72ab5910	1355	for (cnt = 0; cnt< ISO_TRANS_MAX_NUM; cnt++) {
okini3939	1:0dac72ab5910	1356	if (iso_ed[cnt].trans_wait == 1) {
okini3939	1:0dac72ab5910	1357	hced_t *p_ed = iso_ed[cnt].p_curr_ed;
okini3939	1:0dac72ab5910	1358
okini3939	1:0dac72ab5910	1359	p_ed->headTD \|= ED_HALTED;
okini3939	1:0dac72ab5910	1360	ohciwrapp_loc_TransEnd(iso_ed[cnt].pipe_no, TD_CC_DEVICENOTRESPONDING);
okini3939	1:0dac72ab5910	1361	}
okini3939	1:0dac72ab5910	1362	}
okini3939	1:0dac72ab5910	1363	#endif
okini3939	1:0dac72ab5910	1364	}
okini3939	1:0dac72ab5910	1365	(void)osSemaphoreRelease(semid_cb);
okini3939	1:0dac72ab5910	1366	}
okini3939	1:0dac72ab5910	1367
okini3939	1:0dac72ab5910	1368	void ohciwrapp_loc_TransEnd(uint32_t pipe, uint32_t ConditionCode) {
okini3939	1:0dac72ab5910	1369	uint32_t periodic = 0;
okini3939	1:0dac72ab5910	1370	uint32_t cnt;
okini3939	1:0dac72ab5910	1371	uint32_t sqmon;
okini3939	1:0dac72ab5910	1372	hced_t *p_ed;
okini3939	1:0dac72ab5910	1373	genelal_ed_t *p_wait_ed = NULL;
okini3939	1:0dac72ab5910	1374
okini3939	1:0dac72ab5910	1375	if (ctl_ed.pipe_no == pipe) {
okini3939	1:0dac72ab5910	1376	p_wait_ed = &ctl_ed;
okini3939	1:0dac72ab5910	1377	} else if (blk_ed.pipe_no == pipe) {
okini3939	1:0dac72ab5910	1378	p_wait_ed = &blk_ed;
okini3939	1:0dac72ab5910	1379	} else {
okini3939	1:0dac72ab5910	1380	#if (ISO_TRANS_MAX_NUM > 0)
okini3939	1:0dac72ab5910	1381	if (p_wait_ed == NULL) {
okini3939	1:0dac72ab5910	1382	for (cnt = 0; cnt< ISO_TRANS_MAX_NUM; cnt++) {
okini3939	1:0dac72ab5910	1383	if (iso_ed[cnt].pipe_no == pipe) {
okini3939	1:0dac72ab5910	1384	p_wait_ed = &iso_ed[cnt];
okini3939	1:0dac72ab5910	1385	break;
okini3939	1:0dac72ab5910	1386	}
okini3939	1:0dac72ab5910	1387	}
okini3939	1:0dac72ab5910	1388	}
okini3939	1:0dac72ab5910	1389	#endif
okini3939	1:0dac72ab5910	1390	if (p_wait_ed == NULL) {
okini3939	1:0dac72ab5910	1391	for (cnt = 0; cnt< INT_TRANS_MAX_NUM; cnt++) {
okini3939	1:0dac72ab5910	1392	if (int_ed[cnt].pipe_no == pipe) {
okini3939	1:0dac72ab5910	1393	p_wait_ed = &int_ed[cnt];
okini3939	1:0dac72ab5910	1394	periodic = 1;
okini3939	1:0dac72ab5910	1395	break;
okini3939	1:0dac72ab5910	1396	}
okini3939	1:0dac72ab5910	1397	}
okini3939	1:0dac72ab5910	1398	}
okini3939	1:0dac72ab5910	1399	}
okini3939	1:0dac72ab5910	1400
okini3939	1:0dac72ab5910	1401	if (p_wait_ed == NULL) {
okini3939	1:0dac72ab5910	1402	return;
okini3939	1:0dac72ab5910	1403	}
okini3939	1:0dac72ab5910	1404	p_ed = p_wait_ed->p_curr_ed;
okini3939	1:0dac72ab5910	1405	if (p_ed == NULL) {
okini3939	1:0dac72ab5910	1406	return;
okini3939	1:0dac72ab5910	1407	}
okini3939	1:0dac72ab5910	1408
okini3939	1:0dac72ab5910	1409	if ((p_ed->control & ED_FORMAT) == 0) {
okini3939	1:0dac72ab5910	1410	hctd_t p_td = (hctd_t )p_wait_ed->p_curr_td;
okini3939	1:0dac72ab5910	1411
okini3939	1:0dac72ab5910	1412	if (p_td != NULL) {
okini3939	1:0dac72ab5910	1413	if (ConditionCode == TD_CC_NOERROR) {
okini3939	1:0dac72ab5910	1414	/* ErrorCount */
okini3939	1:0dac72ab5910	1415	RZA_IO_RegWrite_32(&p_td->control, 0, TD_CTL_SHFT_EC, TD_CTL_MSK_EC);
okini3939	1:0dac72ab5910	1416
okini3939	1:0dac72ab5910	1417	/* CurrentBufferPointer */
okini3939	1:0dac72ab5910	1418	p_td->currBufPtr += ((uint32_t)p_td->bufEnd - (uint32_t)p_td->currBufPtr + 1) - g_usbx_host_data_count[pipe];
okini3939	1:0dac72ab5910	1419	} else {
okini3939	1:0dac72ab5910	1420	/* ErrorCount */
okini3939	1:0dac72ab5910	1421	RZA_IO_RegWrite_32(&p_td->control, 3, TD_CTL_SHFT_EC, TD_CTL_MSK_EC);
okini3939	1:0dac72ab5910	1422	}
okini3939	1:0dac72ab5910	1423
okini3939	1:0dac72ab5910	1424	/* DataToggle */
okini3939	1:0dac72ab5910	1425	sqmon = usbx_host_get_sqmon(pipe);
okini3939	1:0dac72ab5910	1426	RZA_IO_RegWrite_32(&p_td->control, sqmon, TD_CTL_SHFT_T, TD_CTL_MSK_T);
okini3939	1:0dac72ab5910	1427	if (sqmon == 0) {
okini3939	1:0dac72ab5910	1428	p_ed->headTD &= ~ED_TOGLE_CARRY;
okini3939	1:0dac72ab5910	1429	} else {
okini3939	1:0dac72ab5910	1430	p_ed->headTD \|= ED_TOGLE_CARRY;
okini3939	1:0dac72ab5910	1431	}
okini3939	1:0dac72ab5910	1432
okini3939	1:0dac72ab5910	1433	/* ConditionCode */
okini3939	1:0dac72ab5910	1434	RZA_IO_RegWrite_32(&p_td->control, ConditionCode, TD_CTL_SHFT_CC, TD_CTL_MSK_CC);
okini3939	1:0dac72ab5910	1435
okini3939	1:0dac72ab5910	1436	if (p_wait_ed == &ctl_ed) {
okini3939	1:0dac72ab5910	1437	chk_split_trans_setting(&ctl_ed);
okini3939	1:0dac72ab5910	1438	}
okini3939	1:0dac72ab5910	1439	chk_genelal_td_done(p_wait_ed);
okini3939	1:0dac72ab5910	1440
okini3939	1:0dac72ab5910	1441	if (periodic != 0) {
okini3939	1:0dac72ab5910	1442	if (chk_genelal_ed(p_wait_ed) != 0) {
okini3939	1:0dac72ab5910	1443	int_trans(p_wait_ed);
okini3939	1:0dac72ab5910	1444	} else {
okini3939	1:0dac72ab5910	1445	p_wait_ed->trans_wait = 0;
okini3939	1:0dac72ab5910	1446	(void)osSemaphoreRelease(p_wait_ed->semid_wait);
okini3939	1:0dac72ab5910	1447	}
okini3939	1:0dac72ab5910	1448	} else {
okini3939	1:0dac72ab5910	1449	p_wait_ed->trans_wait = 0;
okini3939	1:0dac72ab5910	1450	(void)osSemaphoreRelease(p_wait_ed->semid_wait);
okini3939	1:0dac72ab5910	1451	}
okini3939	1:0dac72ab5910	1452	}
okini3939	1:0dac72ab5910	1453	} else {
okini3939	1:0dac72ab5910	1454	#if (ISO_TRANS_MAX_NUM > 0)
okini3939	1:0dac72ab5910	1455	hcisotd_t p_isotd = (hcisotd_t )p_wait_ed->p_curr_td;
okini3939	1:0dac72ab5910	1456	uint32_t next_trans = 0;
okini3939	1:0dac72ab5910	1457
okini3939	1:0dac72ab5910	1458	if (p_isotd != NULL) {
okini3939	1:0dac72ab5910	1459	usbx_host_stop_transfer(pipe);
okini3939	1:0dac72ab5910	1460	p_usb_reg->HcFmNumber = ((p_isotd->control & 0x0000FFFF) + p_wait_ed->psw_idx) & 0x0000FFFF;
okini3939	1:0dac72ab5910	1461
okini3939	1:0dac72ab5910	1462	/* Size of packet */
okini3939	1:0dac72ab5910	1463	p_isotd->offsetPSW[p_wait_ed->psw_idx] -= g_usbx_host_data_count[pipe];
okini3939	1:0dac72ab5910	1464
okini3939	1:0dac72ab5910	1465	/* ConditionCode */
okini3939	1:0dac72ab5910	1466	RZA_IO_RegWrite_32(&p_isotd->control, ConditionCode, TD_CTL_SHFT_CC, TD_CTL_MSK_CC);
okini3939	1:0dac72ab5910	1467	RZA_IO_RegWrite_16(&p_isotd->offsetPSW[p_wait_ed->psw_idx],
okini3939	1:0dac72ab5910	1468	(uint16_t)ConditionCode, TD_PSW_SHFT_CC, TD_PSW_MSK_CC);
okini3939	1:0dac72ab5910	1469
okini3939	1:0dac72ab5910	1470	if (usbx_host_CheckAttach() != USB_HOST_ATTACH) {
okini3939	1:0dac72ab5910	1471	p_ed->headTD \|= ED_HALTED;
okini3939	1:0dac72ab5910	1472	}
okini3939	1:0dac72ab5910	1473	if (p_wait_ed->psw_idx >= RZA_IO_RegRead_32(&p_isotd->control, TD_CTL_SHFT_FC, TD_CTL_MSK_FC)) {
okini3939	1:0dac72ab5910	1474	p_wait_ed->psw_idx = 0;
okini3939	1:0dac72ab5910	1475	chk_iso_td_done(p_wait_ed);
okini3939	1:0dac72ab5910	1476	} else {
okini3939	1:0dac72ab5910	1477	p_wait_ed->psw_idx++;
okini3939	1:0dac72ab5910	1478	}
okini3939	1:0dac72ab5910	1479	if (chk_iso_ed(p_wait_ed) != 0) {
okini3939	1:0dac72ab5910	1480	iso_trans(p_wait_ed);
okini3939	1:0dac72ab5910	1481	next_trans = 1;
okini3939	1:0dac72ab5910	1482	}
okini3939	1:0dac72ab5910	1483	if (next_trans == 0) {
okini3939	1:0dac72ab5910	1484	p_wait_ed->trans_wait = 0;
okini3939	1:0dac72ab5910	1485	(void)osSemaphoreRelease(p_wait_ed->semid_wait);
okini3939	1:0dac72ab5910	1486	}
okini3939	1:0dac72ab5910	1487	}
okini3939	1:0dac72ab5910	1488	#endif
okini3939	1:0dac72ab5910	1489	}
okini3939	1:0dac72ab5910	1490
okini3939	1:0dac72ab5910	1491	}
okini3939	1:0dac72ab5910	1492

Repository toolbox

Export to desktop IDE

Build repository

Repository details

Type:	Program
Mbed OS support:	Mbed 2 deprecated
Created:	05 Jun 2019
Imports:	0
Forks:	0
Commits:	2
Dependents:	0
Dependencies:	3
Followers:	1

USBHost/targets/TARGET_RENESAS/TARGET_RZ_A1H/ohci_wrapp_RZ_A1.c@1:0dac72ab5910, 2019-06-05 (annotated)

Who changed what in which revision?

Repository toolbox

Repository details

Important Information for this Arm website

Access Warning