Lines Matching +full:burst +full:- +full:wrap
1 // SPDX-License-Identifier: GPL-2.0
5 * Copyright (C) 2014-2015 Intel Corporation.
21 #include <linux/dma-mapping.h>
31 #define msc_dev(x) (&(x)->thdev->dev)
35 * READY -> INUSE -+-> LOCKED -+-> READY -> etc.
36 * \-----------/
42 * All state transitions happen automatically, except for the LOCKED->READY,
57 * struct msc_window - multiblock mode window descriptor
80 * struct msc_iter - iterator for msc buffer
106 * struct msc - MSC device representation
116 * @single_wrap: single mode wrap occurred
121 * @buf_mutex: mutex to serialize access to buffer-related bits
124 * @wrap: wrapping is enabled
126 * @burst_len: write burst length
162 wrap : 1, member
174 * struct msu_buffer_entry - internal MSU buffer bookkeeping
192 if (!strcmp(mbe->mbuf->name, name)) in __msu_buffer_entry_find()
206 if (mbe && !try_module_get(mbe->owner)) in msu_buffer_get()
210 return mbe ? mbe->mbuf : NULL; in msu_buffer_get()
218 mbe = __msu_buffer_entry_find(mbuf->name); in msu_buffer_put()
220 module_put(mbe->owner); in msu_buffer_put()
232 return -ENOMEM; in intel_th_msu_buffer_register()
235 if (__msu_buffer_entry_find(mbuf->name)) { in intel_th_msu_buffer_register()
236 ret = -EEXIST; in intel_th_msu_buffer_register()
241 mbe->mbuf = mbuf; in intel_th_msu_buffer_register()
242 mbe->owner = owner; in intel_th_msu_buffer_register()
243 list_add_tail(&mbe->entry, &msu_buffer_list); in intel_th_msu_buffer_register()
256 mbe = __msu_buffer_entry_find(mbuf->name); in intel_th_msu_buffer_unregister()
258 list_del(&mbe->entry); in intel_th_msu_buffer_unregister()
268 if (!bdesc->valid_dw) in msc_block_is_empty()
280 return win->sgt->sgl; in msc_win_base_sg()
300 * msc_is_last_win() - check if a window is the last one for a given MSC
306 return win->entry.next == &win->msc->win_list; in msc_is_last_win()
310 * msc_next_window() - return next window in the multiblock buffer
318 return list_first_entry(&win->msc->win_list, struct msc_window, in msc_next_window()
330 for_each_sg(win->sgt->sgl, sg, win->nr_segs, blk) { in msc_win_total_sz()
334 return (size_t)win->nr_blocks << PAGE_SHIFT; in msc_win_total_sz()
345 * msc_find_window() - find a window matching a given sg_table
359 if (list_empty(&msc->win_list)) in msc_find_window()
367 list_for_each_entry(win, &msc->win_list, entry) { in msc_find_window()
368 if (win->sgt == sgt) in msc_find_window()
383 * msc_oldest_window() - locate the window with oldest data
395 if (list_empty(&msc->win_list)) in msc_oldest_window()
398 win = msc_find_window(msc, msc_next_window(msc->cur_win)->sgt, true); in msc_oldest_window()
402 return list_first_entry(&msc->win_list, struct msc_window, entry); in msc_oldest_window()
406 * msc_win_oldest_sg() - locate the oldest block in a given window
425 for_each_sg(win->sgt->sgl, sg, win->nr_segs, blk) { in msc_win_oldest_sg()
437 return sg_virt(iter->block); in msc_iter_bdesc()
446 return ERR_PTR(-ENOMEM); in msc_iter_install()
448 mutex_lock(&msc->buf_mutex); in msc_iter_install()
456 if (msc->enabled) { in msc_iter_install()
458 iter = ERR_PTR(-EBUSY); in msc_iter_install()
462 iter->msc = msc; in msc_iter_install()
464 list_add_tail(&iter->entry, &msc->iter_list); in msc_iter_install()
466 mutex_unlock(&msc->buf_mutex); in msc_iter_install()
473 mutex_lock(&msc->buf_mutex); in msc_iter_remove()
474 list_del(&iter->entry); in msc_iter_remove()
475 mutex_unlock(&msc->buf_mutex); in msc_iter_remove()
482 if (iter->start_block) in msc_iter_block_start()
485 iter->start_block = msc_win_oldest_sg(iter->win); in msc_iter_block_start()
486 iter->block = iter->start_block; in msc_iter_block_start()
487 iter->wrap_count = 0; in msc_iter_block_start()
494 iter->wrap_count = 2; in msc_iter_block_start()
501 if (iter->start_win) in msc_iter_win_start()
504 iter->start_win = msc_oldest_window(msc); in msc_iter_win_start()
505 if (!iter->start_win) in msc_iter_win_start()
506 return -EINVAL; in msc_iter_win_start()
508 iter->win = iter->start_win; in msc_iter_win_start()
509 iter->start_block = NULL; in msc_iter_win_start()
518 iter->win = msc_next_window(iter->win); in msc_iter_win_advance()
519 iter->start_block = NULL; in msc_iter_win_advance()
521 if (iter->win == iter->start_win) { in msc_iter_win_advance()
522 iter->eof++; in msc_iter_win_advance()
533 iter->block_off = 0; in msc_iter_block_advance()
536 if (iter->wrap_count && iter->block == iter->start_block) { in msc_iter_block_advance()
537 iter->wrap_count--; in msc_iter_block_advance()
538 if (!iter->wrap_count) in msc_iter_block_advance()
544 if (!iter->wrap_count && msc_block_last_written(msc_iter_bdesc(iter))) in msc_iter_block_advance()
549 if (sg_is_last(iter->block)) in msc_iter_block_advance()
550 iter->block = msc_win_base_sg(iter->win); in msc_iter_block_advance()
552 iter->block = sg_next(iter->block); in msc_iter_block_advance()
555 if (!iter->wrap_count && iter->block == iter->start_block) in msc_iter_block_advance()
562 * msc_buffer_iterate() - go through multiblock buffer's data
581 struct msc *msc = iter->msc; in msc_buffer_iterate()
585 if (iter->eof) in msc_buffer_iterate()
612 if (iter->block == iter->start_block && iter->wrap_count == 2) { in msc_buffer_iterate()
613 tocopy = DATA_IN_PAGE - data_bytes; in msc_buffer_iterate()
620 tocopy -= iter->block_off; in msc_buffer_iterate()
621 src += iter->block_off; in msc_buffer_iterate()
633 copied = tocopy - remaining; in msc_buffer_iterate()
634 len -= copied; in msc_buffer_iterate()
635 iter->block_off += copied; in msc_buffer_iterate()
636 iter->offset += copied; in msc_buffer_iterate()
647 return size - len; in msc_buffer_iterate()
651 * msc_buffer_clear_hw_header() - clear hw header for multiblock
659 list_for_each_entry(win, &msc->win_list, entry) { in msc_buffer_clear_hw_header()
662 for_each_sg(win->sgt->sgl, sg, win->nr_segs, blk) { in msc_buffer_clear_hw_header()
674 if (!msc->do_irq) in intel_th_msu_init()
677 if (!msc->mbuf) in intel_th_msu_init()
680 mintctl = ioread32(msc->msu_base + REG_MSU_MINTCTL); in intel_th_msu_init()
681 mintctl |= msc->index ? M1BLIE : M0BLIE; in intel_th_msu_init()
682 iowrite32(mintctl, msc->msu_base + REG_MSU_MINTCTL); in intel_th_msu_init()
683 if (mintctl != ioread32(msc->msu_base + REG_MSU_MINTCTL)) { in intel_th_msu_init()
685 msc->do_irq = 0; in intel_th_msu_init()
689 msusts = ioread32(msc->msu_base + REG_MSU_MSUSTS); in intel_th_msu_init()
690 iowrite32(msusts, msc->msu_base + REG_MSU_MSUSTS); in intel_th_msu_init()
699 if (!msc->do_irq) in intel_th_msu_deinit()
702 mintctl = ioread32(msc->msu_base + REG_MSU_MINTCTL); in intel_th_msu_deinit()
703 mintctl &= msc->index ? ~M1BLIE : ~M0BLIE; in intel_th_msu_deinit()
704 iowrite32(mintctl, msc->msu_base + REG_MSU_MINTCTL); in intel_th_msu_deinit()
715 if (!win->msc->mbuf) in msc_win_set_lockout()
718 spin_lock_irqsave(&win->lo_lock, flags); in msc_win_set_lockout()
719 old = win->lockout; in msc_win_set_lockout()
722 ret = -EINVAL; in msc_win_set_lockout()
726 win->lockout = new; in msc_win_set_lockout()
729 atomic_inc(&win->msc->user_count); in msc_win_set_lockout()
731 atomic_dec(&win->msc->user_count); in msc_win_set_lockout()
734 spin_unlock_irqrestore(&win->lo_lock, flags); in msc_win_set_lockout()
738 return -EBUSY; in msc_win_set_lockout()
744 dev_warn_ratelimited(msc_dev(win->msc), in msc_win_set_lockout()
752 * msc_configure() - set up MSC hardware
755 * Program storage mode, wrapping, burst length and trace buffer address
763 lockdep_assert_held(&msc->buf_mutex); in msc_configure()
765 if (msc->mode > MSC_MODE_MULTI) in msc_configure()
766 return -EINVAL; in msc_configure()
768 if (msc->mode == MSC_MODE_MULTI) { in msc_configure()
769 if (msc_win_set_lockout(msc->cur_win, WIN_READY, WIN_INUSE)) in msc_configure()
770 return -EBUSY; in msc_configure()
775 msc->orig_addr = ioread32(msc->reg_base + REG_MSU_MSC0BAR); in msc_configure()
776 msc->orig_sz = ioread32(msc->reg_base + REG_MSU_MSC0SIZE); in msc_configure()
778 reg = msc->base_addr >> PAGE_SHIFT; in msc_configure()
779 iowrite32(reg, msc->reg_base + REG_MSU_MSC0BAR); in msc_configure()
781 if (msc->mode == MSC_MODE_SINGLE) { in msc_configure()
782 reg = msc->nr_pages; in msc_configure()
783 iowrite32(reg, msc->reg_base + REG_MSU_MSC0SIZE); in msc_configure()
786 reg = ioread32(msc->reg_base + REG_MSU_MSC0CTL); in msc_configure()
790 reg |= msc->mode << __ffs(MSC_MODE); in msc_configure()
791 reg |= msc->burst_len << __ffs(MSC_LEN); in msc_configure()
793 if (msc->wrap) in msc_configure()
796 iowrite32(reg, msc->reg_base + REG_MSU_MSC0CTL); in msc_configure()
800 msc->thdev->output.multiblock = msc->mode == MSC_MODE_MULTI; in msc_configure()
801 intel_th_trace_enable(msc->thdev); in msc_configure()
802 msc->enabled = 1; in msc_configure()
804 if (msc->mbuf && msc->mbuf->activate) in msc_configure()
805 msc->mbuf->activate(msc->mbuf_priv); in msc_configure()
811 * msc_disable() - disable MSC hardware
819 struct msc_window *win = msc->cur_win; in msc_disable()
822 lockdep_assert_held(&msc->buf_mutex); in msc_disable()
824 if (msc->mode == MSC_MODE_MULTI) in msc_disable()
827 if (msc->mbuf && msc->mbuf->deactivate) in msc_disable()
828 msc->mbuf->deactivate(msc->mbuf_priv); in msc_disable()
830 intel_th_trace_disable(msc->thdev); in msc_disable()
832 if (msc->mode == MSC_MODE_SINGLE) { in msc_disable()
833 reg = ioread32(msc->reg_base + REG_MSU_MSC0STS); in msc_disable()
834 msc->single_wrap = !!(reg & MSCSTS_WRAPSTAT); in msc_disable()
836 reg = ioread32(msc->reg_base + REG_MSU_MSC0MWP); in msc_disable()
837 msc->single_sz = reg & ((msc->nr_pages << PAGE_SHIFT) - 1); in msc_disable()
838 dev_dbg(msc_dev(msc), "MSCnMWP: %08x/%08lx, wrap: %d\n", in msc_disable()
839 reg, msc->single_sz, msc->single_wrap); in msc_disable()
842 reg = ioread32(msc->reg_base + REG_MSU_MSC0CTL); in msc_disable()
844 iowrite32(reg, msc->reg_base + REG_MSU_MSC0CTL); in msc_disable()
846 if (msc->mbuf && msc->mbuf->ready) in msc_disable()
847 msc->mbuf->ready(msc->mbuf_priv, win->sgt, in msc_disable()
850 msc->enabled = 0; in msc_disable()
852 iowrite32(msc->orig_addr, msc->reg_base + REG_MSU_MSC0BAR); in msc_disable()
853 iowrite32(msc->orig_sz, msc->reg_base + REG_MSU_MSC0SIZE); in msc_disable()
856 ioread32(msc->reg_base + REG_MSU_MSC0NWSA)); in msc_disable()
858 reg = ioread32(msc->reg_base + REG_MSU_MSC0STS); in msc_disable()
861 reg = ioread32(msc->reg_base + REG_MSU_MSUSTS); in msc_disable()
862 reg &= msc->index ? MSUSTS_MSC1BLAST : MSUSTS_MSC0BLAST; in msc_disable()
863 iowrite32(reg, msc->reg_base + REG_MSU_MSUSTS); in msc_disable()
868 struct msc *msc = dev_get_drvdata(&thdev->dev); in intel_th_msc_activate()
869 int ret = -EBUSY; in intel_th_msc_activate()
871 if (!atomic_inc_unless_negative(&msc->user_count)) in intel_th_msc_activate()
872 return -ENODEV; in intel_th_msc_activate()
874 mutex_lock(&msc->buf_mutex); in intel_th_msc_activate()
877 if (list_empty(&msc->iter_list)) in intel_th_msc_activate()
880 mutex_unlock(&msc->buf_mutex); in intel_th_msc_activate()
883 atomic_dec(&msc->user_count); in intel_th_msc_activate()
890 struct msc *msc = dev_get_drvdata(&thdev->dev); in intel_th_msc_deactivate()
892 mutex_lock(&msc->buf_mutex); in intel_th_msc_deactivate()
893 if (msc->enabled) { in intel_th_msc_deactivate()
895 atomic_dec(&msc->user_count); in intel_th_msc_deactivate()
897 mutex_unlock(&msc->buf_mutex); in intel_th_msc_deactivate()
901 * msc_buffer_contig_alloc() - allocate a contiguous buffer for SINGLE mode
908 * Return: 0 on success, -errno otherwise.
920 ret = sg_alloc_table(&msc->single_sgt, 1, GFP_KERNEL); in msc_buffer_contig_alloc()
924 ret = -ENOMEM; in msc_buffer_contig_alloc()
930 sg_set_buf(msc->single_sgt.sgl, page_address(page), size); in msc_buffer_contig_alloc()
932 ret = dma_map_sg(msc_dev(msc)->parent->parent, msc->single_sgt.sgl, 1, in msc_buffer_contig_alloc()
937 msc->nr_pages = nr_pages; in msc_buffer_contig_alloc()
938 msc->base = page_address(page); in msc_buffer_contig_alloc()
939 msc->base_addr = sg_dma_address(msc->single_sgt.sgl); in msc_buffer_contig_alloc()
947 sg_free_table(&msc->single_sgt); in msc_buffer_contig_alloc()
954 * msc_buffer_contig_free() - free a contiguous buffer
961 dma_unmap_sg(msc_dev(msc)->parent->parent, msc->single_sgt.sgl, in msc_buffer_contig_free()
963 sg_free_table(&msc->single_sgt); in msc_buffer_contig_free()
965 for (off = 0; off < msc->nr_pages << PAGE_SHIFT; off += PAGE_SIZE) { in msc_buffer_contig_free()
966 struct page *page = virt_to_page(msc->base + off); in msc_buffer_contig_free()
968 page->mapping = NULL; in msc_buffer_contig_free()
972 msc->nr_pages = 0; in msc_buffer_contig_free()
976 * msc_buffer_contig_get_page() - find a page at a given offset
985 if (pgoff >= msc->nr_pages) in msc_buffer_contig_get_page()
988 return virt_to_page(msc->base + (pgoff << PAGE_SHIFT)); in msc_buffer_contig_get_page()
998 ret = sg_alloc_table(win->sgt, nr_segs, GFP_KERNEL); in __msc_buffer_win_alloc()
1000 return -ENOMEM; in __msc_buffer_win_alloc()
1002 for_each_sg(win->sgt->sgl, sg_ptr, nr_segs, i) { in __msc_buffer_win_alloc()
1003 block = dma_alloc_coherent(msc_dev(win->msc)->parent->parent, in __msc_buffer_win_alloc()
1015 for_each_sg(win->sgt->sgl, sg_ptr, i, ret) in __msc_buffer_win_alloc()
1016 dma_free_coherent(msc_dev(win->msc)->parent->parent, PAGE_SIZE, in __msc_buffer_win_alloc()
1019 sg_free_table(win->sgt); in __msc_buffer_win_alloc()
1021 return -ENOMEM; in __msc_buffer_win_alloc()
1031 if (msc->mode == MSC_MODE_SINGLE) { in msc_buffer_set_uc()
1032 set_memory_uc((unsigned long)msc->base, msc->nr_pages); in msc_buffer_set_uc()
1036 list_for_each_entry(win, &msc->win_list, entry) { in msc_buffer_set_uc()
1037 for_each_sg(win->sgt->sgl, sg_ptr, win->nr_segs, i) { in msc_buffer_set_uc()
1040 PFN_DOWN(sg_ptr->length)); in msc_buffer_set_uc()
1051 if (msc->mode == MSC_MODE_SINGLE) { in msc_buffer_set_wb()
1052 set_memory_wb((unsigned long)msc->base, msc->nr_pages); in msc_buffer_set_wb()
1056 list_for_each_entry(win, &msc->win_list, entry) { in msc_buffer_set_wb()
1057 for_each_sg(win->sgt->sgl, sg_ptr, win->nr_segs, i) { in msc_buffer_set_wb()
1058 /* Reset the page to write-back */ in msc_buffer_set_wb()
1060 PFN_DOWN(sg_ptr->length)); in msc_buffer_set_wb()
1081 * msc_buffer_win_alloc() - alloc a window for a multiblock mode
1088 * Return: 0 on success, -errno otherwise.
1093 int ret = -ENOMEM; in msc_buffer_win_alloc()
1100 return -ENOMEM; in msc_buffer_win_alloc()
1102 win->msc = msc; in msc_buffer_win_alloc()
1103 win->sgt = &win->_sgt; in msc_buffer_win_alloc()
1104 win->lockout = WIN_READY; in msc_buffer_win_alloc()
1105 spin_lock_init(&win->lo_lock); in msc_buffer_win_alloc()
1107 if (!list_empty(&msc->win_list)) { in msc_buffer_win_alloc()
1108 struct msc_window *prev = list_last_entry(&msc->win_list, in msc_buffer_win_alloc()
1112 win->pgoff = prev->pgoff + prev->nr_blocks; in msc_buffer_win_alloc()
1115 if (msc->mbuf && msc->mbuf->alloc_window) in msc_buffer_win_alloc()
1116 ret = msc->mbuf->alloc_window(msc->mbuf_priv, &win->sgt, in msc_buffer_win_alloc()
1124 win->nr_segs = ret; in msc_buffer_win_alloc()
1125 win->nr_blocks = nr_blocks; in msc_buffer_win_alloc()
1127 if (list_empty(&msc->win_list)) { in msc_buffer_win_alloc()
1128 msc->base = msc_win_base(win); in msc_buffer_win_alloc()
1129 msc->base_addr = msc_win_base_dma(win); in msc_buffer_win_alloc()
1130 msc->cur_win = win; in msc_buffer_win_alloc()
1133 list_add_tail(&win->entry, &msc->win_list); in msc_buffer_win_alloc()
1134 msc->nr_pages += nr_blocks; in msc_buffer_win_alloc()
1149 for_each_sg(win->sgt->sgl, sg, win->nr_segs, i) { in __msc_buffer_win_free()
1152 page->mapping = NULL; in __msc_buffer_win_free()
1153 dma_free_coherent(msc_dev(win->msc)->parent->parent, PAGE_SIZE, in __msc_buffer_win_free()
1156 sg_free_table(win->sgt); in __msc_buffer_win_free()
1160 * msc_buffer_win_free() - free a window from MSC's window list
1169 msc->nr_pages -= win->nr_blocks; in msc_buffer_win_free()
1171 list_del(&win->entry); in msc_buffer_win_free()
1172 if (list_empty(&msc->win_list)) { in msc_buffer_win_free()
1173 msc->base = NULL; in msc_buffer_win_free()
1174 msc->base_addr = 0; in msc_buffer_win_free()
1177 if (msc->mbuf && msc->mbuf->free_window) in msc_buffer_win_free()
1178 msc->mbuf->free_window(msc->mbuf_priv, win->sgt); in msc_buffer_win_free()
1186 * msc_buffer_relink() - set up block descriptors for multiblock mode
1197 list_for_each_entry(win, &msc->win_list, entry) { in msc_buffer_relink()
1208 next_win = list_first_entry(&msc->win_list, in msc_buffer_relink()
1214 for_each_sg(win->sgt->sgl, sg, win->nr_segs, blk) { in msc_buffer_relink()
1219 bdesc->next_win = msc_win_base_pfn(next_win); in msc_buffer_relink()
1225 if (blk == win->nr_segs - 1) { in msc_buffer_relink()
1227 bdesc->next_blk = msc_win_base_pfn(win); in msc_buffer_relink()
1231 bdesc->next_blk = PFN_DOWN(addr); in msc_buffer_relink()
1234 bdesc->sw_tag = sw_tag; in msc_buffer_relink()
1235 bdesc->block_sz = sg->length / 64; in msc_buffer_relink()
1250 list_for_each_entry_safe(win, iter, &msc->win_list, entry) in msc_buffer_multi_free()
1273 * msc_buffer_free() - free buffers for MSC
1285 if (msc->mode == MSC_MODE_SINGLE) in msc_buffer_free()
1287 else if (msc->mode == MSC_MODE_MULTI) in msc_buffer_free()
1292 * msc_buffer_alloc() - allocate a buffer for MSC
1305 * Return: 0 on success, -errno otherwise.
1312 /* -1: buffer not allocated */ in msc_buffer_alloc()
1313 if (atomic_read(&msc->user_count) != -1) in msc_buffer_alloc()
1314 return -EBUSY; in msc_buffer_alloc()
1316 if (msc->mode == MSC_MODE_SINGLE) { in msc_buffer_alloc()
1318 return -EINVAL; in msc_buffer_alloc()
1321 } else if (msc->mode == MSC_MODE_MULTI) { in msc_buffer_alloc()
1324 ret = -EINVAL; in msc_buffer_alloc()
1333 if (WARN_ON_ONCE(atomic_cmpxchg(&msc->user_count, -1, 0) != -1)) in msc_buffer_alloc()
1334 return -EINVAL; in msc_buffer_alloc()
1341 * msc_buffer_unlocked_free_unless_used() - free a buffer unless it's in use
1349 * deallocate, -EBUSY if there are active users.
1355 count = atomic_cmpxchg(&msc->user_count, 0, -1); in msc_buffer_unlocked_free_unless_used()
1359 ret = -EBUSY; in msc_buffer_unlocked_free_unless_used()
1369 * msc_buffer_free_unless_used() - free a buffer unless it's in use
1378 mutex_lock(&msc->buf_mutex); in msc_buffer_free_unless_used()
1380 mutex_unlock(&msc->buf_mutex); in msc_buffer_free_unless_used()
1386 * msc_buffer_get_page() - get MSC buffer page at a given offset
1401 if (msc->mode == MSC_MODE_SINGLE) in msc_buffer_get_page()
1404 list_for_each_entry(win, &msc->win_list, entry) in msc_buffer_get_page()
1405 if (pgoff >= win->pgoff && pgoff < win->pgoff + win->nr_blocks) in msc_buffer_get_page()
1411 pgoff -= win->pgoff; in msc_buffer_get_page()
1413 for_each_sg(win->sgt->sgl, sg, win->nr_segs, blk) { in msc_buffer_get_page()
1415 size_t pgsz = PFN_DOWN(sg->length); in msc_buffer_get_page()
1420 pgoff -= pgsz; in msc_buffer_get_page()
1427 * struct msc_win_to_user_struct - data for copy_to_user() callback
1437 * msc_win_to_user() - iterator for msc_buffer_iterate() to copy data to user
1447 ret = copy_to_user(u->buf + u->offset, src, len); in msc_win_to_user()
1448 u->offset += len - ret; in msc_win_to_user()
1460 struct intel_th_device *thdev = file->private_data; in intel_th_msc_open()
1461 struct msc *msc = dev_get_drvdata(&thdev->dev); in intel_th_msc_open()
1465 return -EPERM; in intel_th_msc_open()
1471 file->private_data = iter; in intel_th_msc_open()
1478 struct msc_iter *iter = file->private_data; in intel_th_msc_release()
1479 struct msc *msc = iter->msc; in intel_th_msc_release()
1489 unsigned long size = msc->nr_pages << PAGE_SHIFT, rem = len; in msc_single_to_user()
1492 if (msc->single_wrap) { in msc_single_to_user()
1493 start += msc->single_sz; in msc_single_to_user()
1495 tocopy = min(rem, size - start); in msc_single_to_user()
1496 if (copy_to_user(buf, msc->base + start, tocopy)) in msc_single_to_user()
1497 return -EFAULT; in msc_single_to_user()
1500 rem -= tocopy; in msc_single_to_user()
1504 start &= size - 1; in msc_single_to_user()
1506 tocopy = min(rem, msc->single_sz - start); in msc_single_to_user()
1507 if (copy_to_user(buf, msc->base + start, tocopy)) in msc_single_to_user()
1508 return -EFAULT; in msc_single_to_user()
1510 rem -= tocopy; in msc_single_to_user()
1513 return len - rem; in msc_single_to_user()
1516 if (copy_to_user(buf, msc->base + start, rem)) in msc_single_to_user()
1517 return -EFAULT; in msc_single_to_user()
1525 struct msc_iter *iter = file->private_data; in intel_th_msc_read()
1526 struct msc *msc = iter->msc; in intel_th_msc_read()
1531 if (!atomic_inc_unless_negative(&msc->user_count)) in intel_th_msc_read()
1534 if (msc->mode == MSC_MODE_SINGLE && !msc->single_wrap) in intel_th_msc_read()
1535 size = msc->single_sz; in intel_th_msc_read()
1537 size = msc->nr_pages << PAGE_SHIFT; in intel_th_msc_read()
1546 len = size - off; in intel_th_msc_read()
1548 if (msc->mode == MSC_MODE_SINGLE) { in intel_th_msc_read()
1552 } else if (msc->mode == MSC_MODE_MULTI) { in intel_th_msc_read()
1560 *ppos = iter->offset; in intel_th_msc_read()
1562 ret = -EINVAL; in intel_th_msc_read()
1566 atomic_dec(&msc->user_count); in intel_th_msc_read()
1577 struct msc_iter *iter = vma->vm_file->private_data; in msc_mmap_open()
1578 struct msc *msc = iter->msc; in msc_mmap_open()
1580 atomic_inc(&msc->mmap_count); in msc_mmap_open()
1585 struct msc_iter *iter = vma->vm_file->private_data; in msc_mmap_close()
1586 struct msc *msc = iter->msc; in msc_mmap_close()
1589 if (!atomic_dec_and_mutex_lock(&msc->mmap_count, &msc->buf_mutex)) in msc_mmap_close()
1593 for (pg = 0; pg < msc->nr_pages; pg++) { in msc_mmap_close()
1599 if (page->mapping) in msc_mmap_close()
1600 page->mapping = NULL; in msc_mmap_close()
1603 /* last mapping -- drop user_count */ in msc_mmap_close()
1604 atomic_dec(&msc->user_count); in msc_mmap_close()
1605 mutex_unlock(&msc->buf_mutex); in msc_mmap_close()
1610 struct msc_iter *iter = vmf->vma->vm_file->private_data; in msc_mmap_fault()
1611 struct msc *msc = iter->msc; in msc_mmap_fault()
1613 vmf->page = msc_buffer_get_page(msc, vmf->pgoff); in msc_mmap_fault()
1614 if (!vmf->page) in msc_mmap_fault()
1617 get_page(vmf->page); in msc_mmap_fault()
1618 vmf->page->mapping = vmf->vma->vm_file->f_mapping; in msc_mmap_fault()
1619 vmf->page->index = vmf->pgoff; in msc_mmap_fault()
1632 unsigned long size = vma->vm_end - vma->vm_start; in intel_th_msc_mmap()
1633 struct msc_iter *iter = vma->vm_file->private_data; in intel_th_msc_mmap()
1634 struct msc *msc = iter->msc; in intel_th_msc_mmap()
1635 int ret = -EINVAL; in intel_th_msc_mmap()
1638 return -EINVAL; in intel_th_msc_mmap()
1640 if (vma->vm_pgoff) in intel_th_msc_mmap()
1641 return -EINVAL; in intel_th_msc_mmap()
1644 if (!atomic_inc_unless_negative(&msc->user_count)) in intel_th_msc_mmap()
1645 return -EINVAL; in intel_th_msc_mmap()
1647 if (msc->mode != MSC_MODE_SINGLE && in intel_th_msc_mmap()
1648 msc->mode != MSC_MODE_MULTI) in intel_th_msc_mmap()
1651 if (size >> PAGE_SHIFT != msc->nr_pages) in intel_th_msc_mmap()
1654 atomic_set(&msc->mmap_count, 1); in intel_th_msc_mmap()
1659 atomic_dec(&msc->user_count); in intel_th_msc_mmap()
1661 vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot); in intel_th_msc_mmap()
1663 vma->vm_ops = &msc_mmap_ops; in intel_th_msc_mmap()
1678 struct msc *msc = dev_get_drvdata(&thdev->dev); in intel_th_msc_wait_empty()
1683 count && !(reg & MSCSTS_PLE); count--) { in intel_th_msc_wait_empty()
1684 reg = __raw_readl(msc->reg_base + REG_MSU_MSC0STS); in intel_th_msc_wait_empty()
1694 atomic_set(&msc->user_count, -1); in intel_th_msc_init()
1696 msc->mode = msc->multi_is_broken ? MSC_MODE_SINGLE : MSC_MODE_MULTI; in intel_th_msc_init()
1697 mutex_init(&msc->buf_mutex); in intel_th_msc_init()
1698 INIT_LIST_HEAD(&msc->win_list); in intel_th_msc_init()
1699 INIT_LIST_HEAD(&msc->iter_list); in intel_th_msc_init()
1701 msc->burst_len = in intel_th_msc_init()
1702 (ioread32(msc->reg_base + REG_MSU_MSC0CTL) & MSC_LEN) >> in intel_th_msc_init()
1712 if (list_empty(&msc->win_list)) in msc_win_switch()
1713 return -EINVAL; in msc_win_switch()
1715 first = list_first_entry(&msc->win_list, struct msc_window, entry); in msc_win_switch()
1717 if (msc_is_last_win(msc->cur_win)) in msc_win_switch()
1718 msc->cur_win = first; in msc_win_switch()
1720 msc->cur_win = list_next_entry(msc->cur_win, entry); in msc_win_switch()
1722 msc->base = msc_win_base(msc->cur_win); in msc_win_switch()
1723 msc->base_addr = msc_win_base_dma(msc->cur_win); in msc_win_switch()
1725 intel_th_trace_switch(msc->thdev); in msc_win_switch()
1731 * intel_th_msc_window_unlock - put the window back in rotation
1748 if (msc->switch_on_unlock == win) { in intel_th_msc_window_unlock()
1749 msc->switch_on_unlock = NULL; in intel_th_msc_window_unlock()
1759 intel_th_msc_deactivate(msc->thdev); in msc_work()
1764 struct msc *msc = dev_get_drvdata(&thdev->dev); in intel_th_msc_interrupt()
1765 u32 msusts = ioread32(msc->msu_base + REG_MSU_MSUSTS); in intel_th_msc_interrupt()
1766 u32 mask = msc->index ? MSUSTS_MSC1BLAST : MSUSTS_MSC0BLAST; in intel_th_msc_interrupt()
1769 if (!msc->do_irq || !msc->mbuf) in intel_th_msc_interrupt()
1775 return msc->enabled ? IRQ_HANDLED : IRQ_NONE; in intel_th_msc_interrupt()
1777 iowrite32(msusts, msc->msu_base + REG_MSU_MSUSTS); in intel_th_msc_interrupt()
1779 if (!msc->enabled) in intel_th_msc_interrupt()
1783 win = msc->cur_win; in intel_th_msc_interrupt()
1792 if (msc->stop_on_full) in intel_th_msc_interrupt()
1793 schedule_work(&msc->work); in intel_th_msc_interrupt()
1795 msc->switch_on_unlock = next_win; in intel_th_msc_interrupt()
1800 /* current window: INUSE -> LOCKED */ in intel_th_msc_interrupt()
1805 if (msc->mbuf && msc->mbuf->ready) in intel_th_msc_interrupt()
1806 msc->mbuf->ready(msc->mbuf_priv, win->sgt, in intel_th_msc_interrupt()
1824 return scnprintf(buf, PAGE_SIZE, "%d\n", msc->wrap); in wrap_show()
1839 msc->wrap = !!val; in wrap_store()
1844 static DEVICE_ATTR_RW(wrap);
1848 lockdep_assert_held(&msc->buf_mutex); in msc_buffer_unassign()
1850 if (!msc->mbuf) in msc_buffer_unassign()
1853 msc->mbuf->unassign(msc->mbuf_priv); in msc_buffer_unassign()
1854 msu_buffer_put(msc->mbuf); in msc_buffer_unassign()
1855 msc->mbuf_priv = NULL; in msc_buffer_unassign()
1856 msc->mbuf = NULL; in msc_buffer_unassign()
1863 const char *mode = msc_mode[msc->mode]; in mode_show()
1866 mutex_lock(&msc->buf_mutex); in mode_show()
1867 if (msc->mbuf) in mode_show()
1868 mode = msc->mbuf->name; in mode_show()
1870 mutex_unlock(&msc->buf_mutex); in mode_show()
1886 return -EPERM; in mode_store()
1890 len = cp - buf; in mode_store()
1894 return -ENOMEM; in mode_store()
1903 if (!msc->do_irq) { in mode_store()
1905 return -EINVAL; in mode_store()
1913 return -EINVAL; in mode_store()
1916 if (i == MSC_MODE_MULTI && msc->multi_is_broken) in mode_store()
1917 return -EOPNOTSUPP; in mode_store()
1919 mutex_lock(&msc->buf_mutex); in mode_store()
1923 if (mbuf && mbuf == msc->mbuf) { in mode_store()
1934 void *mbuf_priv = mbuf->assign(dev, &i); in mode_store()
1937 ret = -ENOMEM; in mode_store()
1942 msc->mbuf_priv = mbuf_priv; in mode_store()
1943 msc->mbuf = mbuf; in mode_store()
1948 msc->mode = i; in mode_store()
1953 mutex_unlock(&msc->buf_mutex); in mode_store()
1967 mutex_lock(&msc->buf_mutex); in nr_pages_show()
1969 if (msc->mode == MSC_MODE_SINGLE) in nr_pages_show()
1970 count = scnprintf(buf, PAGE_SIZE, "%ld\n", msc->nr_pages); in nr_pages_show()
1971 else if (msc->mode == MSC_MODE_MULTI) { in nr_pages_show()
1972 list_for_each_entry(win, &msc->win_list, entry) { in nr_pages_show()
1973 count += scnprintf(buf + count, PAGE_SIZE - count, in nr_pages_show()
1974 "%d%c", win->nr_blocks, in nr_pages_show()
1981 mutex_unlock(&msc->buf_mutex); in nr_pages_show()
1998 return -EPERM; in nr_pages_store()
2004 /* scan the comma-separated list of allocation sizes */ in nr_pages_store()
2007 len = end - buf; in nr_pages_store()
2011 s = kstrndup(p, end ? end - p : len, GFP_KERNEL); in nr_pages_store()
2013 ret = -ENOMEM; in nr_pages_store()
2023 if (nr_wins && msc->mode == MSC_MODE_SINGLE) { in nr_pages_store()
2024 ret = -EINVAL; in nr_pages_store()
2032 return -ENOMEM; in nr_pages_store()
2036 win[nr_wins - 1] = val; in nr_pages_store()
2042 len -= end - p + 1; in nr_pages_store()
2046 mutex_lock(&msc->buf_mutex); in nr_pages_store()
2048 mutex_unlock(&msc->buf_mutex); in nr_pages_store()
2071 return -EINVAL; in win_switch_store()
2073 ret = -EINVAL; in win_switch_store()
2074 mutex_lock(&msc->buf_mutex); in win_switch_store()
2080 if (msc->mode == MSC_MODE_MULTI && !msc->mbuf) in win_switch_store()
2082 mutex_unlock(&msc->buf_mutex); in win_switch_store()
2094 return sprintf(buf, "%d\n", msc->stop_on_full); in stop_on_full_show()
2104 ret = kstrtobool(buf, &msc->stop_on_full); in stop_on_full_store()
2128 struct device *dev = &thdev->dev; in intel_th_msc_probe()
2136 return -ENODEV; in intel_th_msc_probe()
2138 base = devm_ioremap(dev, res->start, resource_size(res)); in intel_th_msc_probe()
2140 return -ENOMEM; in intel_th_msc_probe()
2144 return -ENOMEM; in intel_th_msc_probe()
2148 msc->do_irq = 1; in intel_th_msc_probe()
2151 msc->multi_is_broken = 1; in intel_th_msc_probe()
2153 msc->index = thdev->id; in intel_th_msc_probe()
2155 msc->thdev = thdev; in intel_th_msc_probe()
2156 msc->reg_base = base + msc->index * 0x100; in intel_th_msc_probe()
2157 msc->msu_base = base; in intel_th_msc_probe()
2159 INIT_WORK(&msc->work, msc_work); in intel_th_msc_probe()
2171 struct msc *msc = dev_get_drvdata(&thdev->dev); in intel_th_msc_remove()