Lines Matching full:hw
23 u32 fjes_hw_rd32(struct fjes_hw *hw, u32 reg) in fjes_hw_rd32() argument
25 u8 *base = hw->base; in fjes_hw_rd32()
33 static u8 *fjes_hw_iomap(struct fjes_hw *hw) in fjes_hw_iomap() argument
37 if (!request_mem_region(hw->hw_res.start, hw->hw_res.size, in fjes_hw_iomap()
43 base = (u8 *)ioremap(hw->hw_res.start, hw->hw_res.size); in fjes_hw_iomap()
48 static void fjes_hw_iounmap(struct fjes_hw *hw) in fjes_hw_iounmap() argument
50 iounmap(hw->base); in fjes_hw_iounmap()
51 release_mem_region(hw->hw_res.start, hw->hw_res.size); in fjes_hw_iounmap()
54 int fjes_hw_reset(struct fjes_hw *hw) in fjes_hw_reset() argument
74 static int fjes_hw_get_max_epid(struct fjes_hw *hw) in fjes_hw_get_max_epid() argument
83 static int fjes_hw_get_my_epid(struct fjes_hw *hw) in fjes_hw_get_my_epid() argument
92 static int fjes_hw_alloc_shared_status_region(struct fjes_hw *hw) in fjes_hw_alloc_shared_status_region() argument
97 (sizeof(u8) * hw->max_epid); in fjes_hw_alloc_shared_status_region()
98 hw->hw_info.share = kzalloc(size, GFP_KERNEL); in fjes_hw_alloc_shared_status_region()
99 if (!hw->hw_info.share) in fjes_hw_alloc_shared_status_region()
102 hw->hw_info.share->epnum = hw->max_epid; in fjes_hw_alloc_shared_status_region()
107 static void fjes_hw_free_shared_status_region(struct fjes_hw *hw) in fjes_hw_free_shared_status_region() argument
109 kfree(hw->hw_info.share); in fjes_hw_free_shared_status_region()
110 hw->hw_info.share = NULL; in fjes_hw_free_shared_status_region()
174 fjes_hw_init_command_registers(struct fjes_hw *hw, in fjes_hw_init_command_registers() argument
201 static int fjes_hw_setup(struct fjes_hw *hw) in fjes_hw_setup() argument
212 hw->hw_info.max_epid = &hw->max_epid; in fjes_hw_setup()
213 hw->hw_info.my_epid = &hw->my_epid; in fjes_hw_setup()
215 buf = kcalloc(hw->max_epid, sizeof(struct ep_share_mem_info), in fjes_hw_setup()
220 hw->ep_shm_info = (struct ep_share_mem_info *)buf; in fjes_hw_setup()
222 mem_size = FJES_DEV_REQ_BUF_SIZE(hw->max_epid); in fjes_hw_setup()
223 hw->hw_info.req_buf = kzalloc(mem_size, GFP_KERNEL); in fjes_hw_setup()
224 if (!(hw->hw_info.req_buf)) { in fjes_hw_setup()
229 hw->hw_info.req_buf_size = mem_size; in fjes_hw_setup()
231 mem_size = FJES_DEV_RES_BUF_SIZE(hw->max_epid); in fjes_hw_setup()
232 hw->hw_info.res_buf = kzalloc(mem_size, GFP_KERNEL); in fjes_hw_setup()
233 if (!(hw->hw_info.res_buf)) { in fjes_hw_setup()
238 hw->hw_info.res_buf_size = mem_size; in fjes_hw_setup()
240 result = fjes_hw_alloc_shared_status_region(hw); in fjes_hw_setup()
244 hw->hw_info.buffer_share_bit = 0; in fjes_hw_setup()
245 hw->hw_info.buffer_unshare_reserve_bit = 0; in fjes_hw_setup()
247 for (epidx = 0; epidx < hw->max_epid; epidx++) { in fjes_hw_setup()
248 if (epidx != hw->my_epid) { in fjes_hw_setup()
249 buf_pair = &hw->ep_shm_info[epidx]; in fjes_hw_setup()
259 spin_lock_irqsave(&hw->rx_status_lock, flags); in fjes_hw_setup()
264 spin_unlock_irqrestore(&hw->rx_status_lock, flags); in fjes_hw_setup()
270 param.req_len = hw->hw_info.req_buf_size; in fjes_hw_setup()
271 param.req_start = __pa(hw->hw_info.req_buf); in fjes_hw_setup()
272 param.res_len = hw->hw_info.res_buf_size; in fjes_hw_setup()
273 param.res_start = __pa(hw->hw_info.res_buf); in fjes_hw_setup()
275 param.share_start = __pa(hw->hw_info.share->ep_status); in fjes_hw_setup()
277 fjes_hw_init_command_registers(hw, ¶m); in fjes_hw_setup()
282 for (epidx = 0; epidx < hw->max_epid ; epidx++) { in fjes_hw_setup()
283 if (epidx == hw->my_epid) in fjes_hw_setup()
285 fjes_hw_free_epbuf(&hw->ep_shm_info[epidx].tx); in fjes_hw_setup()
286 fjes_hw_free_epbuf(&hw->ep_shm_info[epidx].rx); in fjes_hw_setup()
288 fjes_hw_free_shared_status_region(hw); in fjes_hw_setup()
290 kfree(hw->hw_info.res_buf); in fjes_hw_setup()
291 hw->hw_info.res_buf = NULL; in fjes_hw_setup()
293 kfree(hw->hw_info.req_buf); in fjes_hw_setup()
294 hw->hw_info.req_buf = NULL; in fjes_hw_setup()
296 kfree(hw->ep_shm_info); in fjes_hw_setup()
297 hw->ep_shm_info = NULL; in fjes_hw_setup()
301 static void fjes_hw_cleanup(struct fjes_hw *hw) in fjes_hw_cleanup() argument
305 if (!hw->ep_shm_info) in fjes_hw_cleanup()
308 fjes_hw_free_shared_status_region(hw); in fjes_hw_cleanup()
310 kfree(hw->hw_info.req_buf); in fjes_hw_cleanup()
311 hw->hw_info.req_buf = NULL; in fjes_hw_cleanup()
313 kfree(hw->hw_info.res_buf); in fjes_hw_cleanup()
314 hw->hw_info.res_buf = NULL; in fjes_hw_cleanup()
316 for (epidx = 0; epidx < hw->max_epid ; epidx++) { in fjes_hw_cleanup()
317 if (epidx == hw->my_epid) in fjes_hw_cleanup()
319 fjes_hw_free_epbuf(&hw->ep_shm_info[epidx].tx); in fjes_hw_cleanup()
320 fjes_hw_free_epbuf(&hw->ep_shm_info[epidx].rx); in fjes_hw_cleanup()
323 kfree(hw->ep_shm_info); in fjes_hw_cleanup()
324 hw->ep_shm_info = NULL; in fjes_hw_cleanup()
327 int fjes_hw_init(struct fjes_hw *hw) in fjes_hw_init() argument
331 hw->base = fjes_hw_iomap(hw); in fjes_hw_init()
332 if (!hw->base) in fjes_hw_init()
335 ret = fjes_hw_reset(hw); in fjes_hw_init()
339 fjes_hw_set_irqmask(hw, REG_ICTL_MASK_ALL, true); in fjes_hw_init()
341 INIT_WORK(&hw->update_zone_task, fjes_hw_update_zone_task); in fjes_hw_init()
342 INIT_WORK(&hw->epstop_task, fjes_hw_epstop_task); in fjes_hw_init()
344 mutex_init(&hw->hw_info.lock); in fjes_hw_init()
345 spin_lock_init(&hw->rx_status_lock); in fjes_hw_init()
347 hw->max_epid = fjes_hw_get_max_epid(hw); in fjes_hw_init()
348 hw->my_epid = fjes_hw_get_my_epid(hw); in fjes_hw_init()
350 if ((hw->max_epid == 0) || (hw->my_epid >= hw->max_epid)) in fjes_hw_init()
353 ret = fjes_hw_setup(hw); in fjes_hw_init()
355 hw->hw_info.trace = vzalloc(FJES_DEBUG_BUFFER_SIZE); in fjes_hw_init()
356 hw->hw_info.trace_size = FJES_DEBUG_BUFFER_SIZE; in fjes_hw_init()
361 void fjes_hw_exit(struct fjes_hw *hw) in fjes_hw_exit() argument
365 if (hw->base) { in fjes_hw_exit()
367 if (hw->debug_mode) { in fjes_hw_exit()
369 mutex_lock(&hw->hw_info.lock); in fjes_hw_exit()
370 fjes_hw_stop_debug(hw); in fjes_hw_exit()
371 mutex_unlock(&hw->hw_info.lock); in fjes_hw_exit()
373 vfree(hw->hw_info.trace); in fjes_hw_exit()
374 hw->hw_info.trace = NULL; in fjes_hw_exit()
375 hw->hw_info.trace_size = 0; in fjes_hw_exit()
376 hw->debug_mode = 0; in fjes_hw_exit()
378 ret = fjes_hw_reset(hw); in fjes_hw_exit()
382 fjes_hw_iounmap(hw); in fjes_hw_exit()
383 hw->base = NULL; in fjes_hw_exit()
386 fjes_hw_cleanup(hw); in fjes_hw_exit()
388 cancel_work_sync(&hw->update_zone_task); in fjes_hw_exit()
389 cancel_work_sync(&hw->epstop_task); in fjes_hw_exit()
393 fjes_hw_issue_request_command(struct fjes_hw *hw, in fjes_hw_issue_request_command() argument
441 int fjes_hw_request_info(struct fjes_hw *hw) in fjes_hw_request_info() argument
443 union fjes_device_command_req *req_buf = hw->hw_info.req_buf; in fjes_hw_request_info()
444 union fjes_device_command_res *res_buf = hw->hw_info.res_buf; in fjes_hw_request_info()
448 memset(req_buf, 0, hw->hw_info.req_buf_size); in fjes_hw_request_info()
449 memset(res_buf, 0, hw->hw_info.res_buf_size); in fjes_hw_request_info()
456 ret = fjes_hw_issue_request_command(hw, FJES_CMD_REQ_INFO); in fjes_hw_request_info()
457 trace_fjes_hw_request_info(hw, res_buf); in fjes_hw_request_info()
461 if (FJES_DEV_COMMAND_INFO_RES_LEN((*hw->hw_info.max_epid)) != in fjes_hw_request_info()
498 int fjes_hw_register_buff_addr(struct fjes_hw *hw, int dest_epid, in fjes_hw_register_buff_addr() argument
501 union fjes_device_command_req *req_buf = hw->hw_info.req_buf; in fjes_hw_register_buff_addr()
502 union fjes_device_command_res *res_buf = hw->hw_info.res_buf; in fjes_hw_register_buff_addr()
510 if (test_bit(dest_epid, &hw->hw_info.buffer_share_bit)) in fjes_hw_register_buff_addr()
513 memset(req_buf, 0, hw->hw_info.req_buf_size); in fjes_hw_register_buff_addr()
514 memset(res_buf, 0, hw->hw_info.res_buf_size); in fjes_hw_register_buff_addr()
547 ret = fjes_hw_issue_request_command(hw, FJES_CMD_REQ_SHARE_BUFFER); in fjes_hw_register_buff_addr()
555 msleep(200 + hw->my_epid * 20); in fjes_hw_register_buff_addr()
556 timeout -= (200 + hw->my_epid * 20); in fjes_hw_register_buff_addr()
562 hw, FJES_CMD_REQ_SHARE_BUFFER); in fjes_hw_register_buff_addr()
577 set_bit(dest_epid, &hw->hw_info.buffer_share_bit); in fjes_hw_register_buff_addr()
607 int fjes_hw_unregister_buff_addr(struct fjes_hw *hw, int dest_epid) in fjes_hw_unregister_buff_addr() argument
609 union fjes_device_command_req *req_buf = hw->hw_info.req_buf; in fjes_hw_unregister_buff_addr()
610 union fjes_device_command_res *res_buf = hw->hw_info.res_buf; in fjes_hw_unregister_buff_addr()
611 struct fjes_device_shared_info *share = hw->hw_info.share; in fjes_hw_unregister_buff_addr()
616 if (!hw->base) in fjes_hw_unregister_buff_addr()
622 if (!test_bit(dest_epid, &hw->hw_info.buffer_share_bit)) in fjes_hw_unregister_buff_addr()
625 memset(req_buf, 0, hw->hw_info.req_buf_size); in fjes_hw_unregister_buff_addr()
626 memset(res_buf, 0, hw->hw_info.res_buf_size); in fjes_hw_unregister_buff_addr()
636 ret = fjes_hw_issue_request_command(hw, FJES_CMD_REQ_UNSHARE_BUFFER); in fjes_hw_unregister_buff_addr()
645 msleep(200 + hw->my_epid * 20); in fjes_hw_unregister_buff_addr()
646 timeout -= (200 + hw->my_epid * 20); in fjes_hw_unregister_buff_addr()
652 fjes_hw_issue_request_command(hw, FJES_CMD_REQ_UNSHARE_BUFFER); in fjes_hw_unregister_buff_addr()
667 clear_bit(dest_epid, &hw->hw_info.buffer_share_bit); in fjes_hw_unregister_buff_addr()
697 int fjes_hw_raise_interrupt(struct fjes_hw *hw, int dest_epid, in fjes_hw_raise_interrupt() argument
707 u32 fjes_hw_capture_interrupt_status(struct fjes_hw *hw) in fjes_hw_capture_interrupt_status() argument
716 void fjes_hw_set_irqmask(struct fjes_hw *hw, in fjes_hw_set_irqmask() argument
725 bool fjes_hw_epid_is_same_zone(struct fjes_hw *hw, int epid) in fjes_hw_epid_is_same_zone() argument
727 if (epid >= hw->max_epid) in fjes_hw_epid_is_same_zone()
730 if ((hw->ep_shm_info[epid].es_status != in fjes_hw_epid_is_same_zone()
732 (hw->ep_shm_info[hw->my_epid].zone == in fjes_hw_epid_is_same_zone()
736 return (hw->ep_shm_info[epid].zone == in fjes_hw_epid_is_same_zone()
737 hw->ep_shm_info[hw->my_epid].zone); in fjes_hw_epid_is_same_zone()
751 static bool fjes_hw_epid_is_stop_requested(struct fjes_hw *hw, int src_epid) in fjes_hw_epid_is_stop_requested() argument
753 return test_bit(src_epid, &hw->txrx_stop_req_bit); in fjes_hw_epid_is_stop_requested()
756 static bool fjes_hw_epid_is_stop_process_done(struct fjes_hw *hw, int src_epid) in fjes_hw_epid_is_stop_process_done() argument
758 return (hw->ep_shm_info[src_epid].tx.info->v1i.rx_status & in fjes_hw_epid_is_stop_process_done()
763 fjes_hw_get_partner_ep_status(struct fjes_hw *hw, int epid) in fjes_hw_get_partner_ep_status() argument
767 if (fjes_hw_epid_is_shared(hw->hw_info.share, epid)) { in fjes_hw_get_partner_ep_status()
768 if (fjes_hw_epid_is_stop_requested(hw, epid)) { in fjes_hw_get_partner_ep_status()
771 if (fjes_hw_epid_is_stop_process_done(hw, epid)) in fjes_hw_get_partner_ep_status()
783 void fjes_hw_raise_epstop(struct fjes_hw *hw) in fjes_hw_raise_epstop() argument
789 for (epidx = 0; epidx < hw->max_epid; epidx++) { in fjes_hw_raise_epstop()
790 if (epidx == hw->my_epid) in fjes_hw_raise_epstop()
793 status = fjes_hw_get_partner_ep_status(hw, epidx); in fjes_hw_raise_epstop()
796 fjes_hw_raise_interrupt(hw, epidx, in fjes_hw_raise_epstop()
798 hw->ep_shm_info[epidx].ep_stats.send_intr_unshare += 1; in fjes_hw_raise_epstop()
804 set_bit(epidx, &hw->hw_info.buffer_unshare_reserve_bit); in fjes_hw_raise_epstop()
805 set_bit(epidx, &hw->txrx_stop_req_bit); in fjes_hw_raise_epstop()
807 spin_lock_irqsave(&hw->rx_status_lock, flags); in fjes_hw_raise_epstop()
808 hw->ep_shm_info[epidx].tx.info->v1i.rx_status |= in fjes_hw_raise_epstop()
810 spin_unlock_irqrestore(&hw->rx_status_lock, flags); in fjes_hw_raise_epstop()
814 int fjes_hw_wait_epstop(struct fjes_hw *hw) in fjes_hw_wait_epstop() argument
821 while (hw->hw_info.buffer_unshare_reserve_bit && in fjes_hw_wait_epstop()
823 for (epidx = 0; epidx < hw->max_epid; epidx++) { in fjes_hw_wait_epstop()
824 if (epidx == hw->my_epid) in fjes_hw_wait_epstop()
826 status = fjes_hw_epid_is_shared(hw->hw_info.share, in fjes_hw_wait_epstop()
828 info = hw->ep_shm_info[epidx].rx.info; in fjes_hw_wait_epstop()
833 &hw->hw_info.buffer_unshare_reserve_bit)) { in fjes_hw_wait_epstop()
835 &hw->hw_info.buffer_unshare_reserve_bit); in fjes_hw_wait_epstop()
843 for (epidx = 0; epidx < hw->max_epid; epidx++) { in fjes_hw_wait_epstop()
844 if (epidx == hw->my_epid) in fjes_hw_wait_epstop()
846 if (test_bit(epidx, &hw->hw_info.buffer_unshare_reserve_bit)) in fjes_hw_wait_epstop()
848 &hw->hw_info.buffer_unshare_reserve_bit); in fjes_hw_wait_epstop()
983 struct fjes_hw *hw = container_of(work, in fjes_hw_update_zone_task() local
1001 adapter = (struct fjes_adapter *)hw->back; in fjes_hw_update_zone_task()
1003 res_buf = hw->hw_info.res_buf; in fjes_hw_update_zone_task()
1006 mutex_lock(&hw->hw_info.lock); in fjes_hw_update_zone_task()
1008 ret = fjes_hw_request_info(hw); in fjes_hw_update_zone_task()
1021 for (epidx = 0; epidx < hw->max_epid; epidx++) { in fjes_hw_update_zone_task()
1022 if (epidx == hw->my_epid) { in fjes_hw_update_zone_task()
1023 hw->ep_shm_info[epidx].es_status = in fjes_hw_update_zone_task()
1025 hw->ep_shm_info[epidx].zone = in fjes_hw_update_zone_task()
1030 pstatus = fjes_hw_get_partner_ep_status(hw, epidx); in fjes_hw_update_zone_task()
1039 info[hw->my_epid].zone)) in fjes_hw_update_zone_task()
1052 info[hw->my_epid].zone)) { in fjes_hw_update_zone_task()
1056 &hw->hw_info.buffer_unshare_reserve_bit); in fjes_hw_update_zone_task()
1066 info[hw->my_epid].zone)) in fjes_hw_update_zone_task()
1071 hw->ep_shm_info[epidx].es_status = in fjes_hw_update_zone_task()
1073 hw->ep_shm_info[epidx].zone = info[epidx].zone; in fjes_hw_update_zone_task()
1078 mutex_unlock(&hw->hw_info.lock); in fjes_hw_update_zone_task()
1080 for (epidx = 0; epidx < hw->max_epid; epidx++) { in fjes_hw_update_zone_task()
1081 if (epidx == hw->my_epid) in fjes_hw_update_zone_task()
1085 spin_lock_irqsave(&hw->rx_status_lock, flags); in fjes_hw_update_zone_task()
1086 fjes_hw_setup_epbuf(&hw->ep_shm_info[epidx].tx, in fjes_hw_update_zone_task()
1088 spin_unlock_irqrestore(&hw->rx_status_lock, flags); in fjes_hw_update_zone_task()
1090 mutex_lock(&hw->hw_info.lock); in fjes_hw_update_zone_task()
1093 hw, epidx, &hw->ep_shm_info[epidx]); in fjes_hw_update_zone_task()
1108 mutex_unlock(&hw->hw_info.lock); in fjes_hw_update_zone_task()
1110 hw->ep_shm_info[epidx].ep_stats in fjes_hw_update_zone_task()
1115 mutex_lock(&hw->hw_info.lock); in fjes_hw_update_zone_task()
1117 ret = fjes_hw_unregister_buff_addr(hw, epidx); in fjes_hw_update_zone_task()
1133 mutex_unlock(&hw->hw_info.lock); in fjes_hw_update_zone_task()
1135 hw->ep_shm_info[epidx].ep_stats in fjes_hw_update_zone_task()
1139 spin_lock_irqsave(&hw->rx_status_lock, flags); in fjes_hw_update_zone_task()
1141 &hw->ep_shm_info[epidx].tx, in fjes_hw_update_zone_task()
1143 spin_unlock_irqrestore(&hw->rx_status_lock, in fjes_hw_update_zone_task()
1149 fjes_hw_raise_interrupt(hw, epidx, in fjes_hw_update_zone_task()
1152 hw->ep_shm_info[epidx].ep_stats.send_intr_unshare += 1; in fjes_hw_update_zone_task()
1154 set_bit(epidx, &hw->txrx_stop_req_bit); in fjes_hw_update_zone_task()
1155 spin_lock_irqsave(&hw->rx_status_lock, flags); in fjes_hw_update_zone_task()
1156 hw->ep_shm_info[epidx].tx. in fjes_hw_update_zone_task()
1159 spin_unlock_irqrestore(&hw->rx_status_lock, flags); in fjes_hw_update_zone_task()
1160 set_bit(epidx, &hw->hw_info.buffer_unshare_reserve_bit); in fjes_hw_update_zone_task()
1173 struct fjes_hw *hw = container_of(work, struct fjes_hw, epstop_task); in fjes_hw_epstop_task() local
1174 struct fjes_adapter *adapter = (struct fjes_adapter *)hw->back; in fjes_hw_epstop_task()
1180 while ((remain_bit = hw->epstop_req_bit)) { in fjes_hw_epstop_task()
1183 spin_lock_irqsave(&hw->rx_status_lock, flags); in fjes_hw_epstop_task()
1184 hw->ep_shm_info[epid_bit]. in fjes_hw_epstop_task()
1187 spin_unlock_irqrestore(&hw->rx_status_lock, in fjes_hw_epstop_task()
1190 clear_bit(epid_bit, &hw->epstop_req_bit); in fjes_hw_epstop_task()
1203 int fjes_hw_start_debug(struct fjes_hw *hw) in fjes_hw_start_debug() argument
1205 union fjes_device_command_req *req_buf = hw->hw_info.req_buf; in fjes_hw_start_debug()
1206 union fjes_device_command_res *res_buf = hw->hw_info.res_buf; in fjes_hw_start_debug()
1213 if (!hw->hw_info.trace) in fjes_hw_start_debug()
1215 memset(hw->hw_info.trace, 0, FJES_DEBUG_BUFFER_SIZE); in fjes_hw_start_debug()
1217 memset(req_buf, 0, hw->hw_info.req_buf_size); in fjes_hw_start_debug()
1218 memset(res_buf, 0, hw->hw_info.res_buf_size); in fjes_hw_start_debug()
1221 FJES_DEV_COMMAND_START_DBG_REQ_LEN(hw->hw_info.trace_size); in fjes_hw_start_debug()
1222 req_buf->start_trace.mode = hw->debug_mode; in fjes_hw_start_debug()
1223 req_buf->start_trace.buffer_len = hw->hw_info.trace_size; in fjes_hw_start_debug()
1224 page_count = hw->hw_info.trace_size / FJES_DEBUG_PAGE_SIZE; in fjes_hw_start_debug()
1226 addr = ((u8 *)hw->hw_info.trace) + i * FJES_DEBUG_PAGE_SIZE; in fjes_hw_start_debug()
1236 ret = fjes_hw_issue_request_command(hw, FJES_CMD_REQ_START_DEBUG); in fjes_hw_start_debug()
1272 int fjes_hw_stop_debug(struct fjes_hw *hw) in fjes_hw_stop_debug() argument
1274 union fjes_device_command_req *req_buf = hw->hw_info.req_buf; in fjes_hw_stop_debug()
1275 union fjes_device_command_res *res_buf = hw->hw_info.res_buf; in fjes_hw_stop_debug()
1279 if (!hw->hw_info.trace) in fjes_hw_stop_debug()
1282 memset(req_buf, 0, hw->hw_info.req_buf_size); in fjes_hw_stop_debug()
1283 memset(res_buf, 0, hw->hw_info.res_buf_size); in fjes_hw_stop_debug()
1289 ret = fjes_hw_issue_request_command(hw, FJES_CMD_REQ_STOP_DEBUG); in fjes_hw_stop_debug()
1299 hw->debug_mode = 0; in fjes_hw_stop_debug()