128 lines · c
1// SPDX-License-Identifier: (GPL-2.0-only OR BSD-3-Clause)2//3// This file is provided under a dual BSD/GPLv2 license. When using or4// redistributing this file, you may do so under either license.5//6// Copyright(c) 2018-2022 Intel Corporation7//8// Author: Keyon Jie <yang.jie@linux.intel.com>9//10 11#include <linux/io-64-nonatomic-lo-hi.h>12#include <linux/platform_device.h>13#include <linux/unaligned.h>14#include <sound/soc.h>15#include <sound/sof.h>16#include "sof-priv.h"17#include "ops.h"18 19/*20 * Register IO21 *22 * The sof_io_xyz() wrappers are typically referenced in snd_sof_dsp_ops23 * structures and cannot be inlined.24 */25 26void sof_io_write(struct snd_sof_dev *sdev, void __iomem *addr, u32 value)27{28 writel(value, addr);29}30EXPORT_SYMBOL(sof_io_write);31 32u32 sof_io_read(struct snd_sof_dev *sdev, void __iomem *addr)33{34 return readl(addr);35}36EXPORT_SYMBOL(sof_io_read);37 38void sof_io_write64(struct snd_sof_dev *sdev, void __iomem *addr, u64 value)39{40 writeq(value, addr);41}42EXPORT_SYMBOL(sof_io_write64);43 44u64 sof_io_read64(struct snd_sof_dev *sdev, void __iomem *addr)45{46 return readq(addr);47}48EXPORT_SYMBOL(sof_io_read64);49 50/*51 * IPC Mailbox IO52 */53 54void sof_mailbox_write(struct snd_sof_dev *sdev, u32 offset,55 void *message, size_t bytes)56{57 void __iomem *dest = sdev->bar[sdev->mailbox_bar] + offset;58 59 memcpy_toio(dest, message, bytes);60}61EXPORT_SYMBOL(sof_mailbox_write);62 63void sof_mailbox_read(struct snd_sof_dev *sdev, u32 offset,64 void *message, size_t bytes)65{66 void __iomem *src = sdev->bar[sdev->mailbox_bar] + offset;67 68 memcpy_fromio(message, src, bytes);69}70EXPORT_SYMBOL(sof_mailbox_read);71 72/*73 * Memory copy.74 */75 76int sof_block_write(struct snd_sof_dev *sdev, enum snd_sof_fw_blk_type blk_type,77 u32 offset, void *src, size_t size)78{79 int bar = snd_sof_dsp_get_bar_index(sdev, blk_type);80 const u8 *src_byte = src;81 void __iomem *dest;82 u32 affected_mask;83 u32 tmp;84 int m, n;85 86 if (bar < 0)87 return bar;88 89 dest = sdev->bar[bar] + offset;90 91 m = size / 4;92 n = size % 4;93 94 /* __iowrite32_copy use 32bit size values so divide by 4 */95 __iowrite32_copy(dest, src, m);96 97 if (n) {98 affected_mask = (1 << (8 * n)) - 1;99 100 /* first read the 32bit data of dest, then change affected101 * bytes, and write back to dest. For unaffected bytes, it102 * should not be changed103 */104 tmp = ioread32(dest + m * 4);105 tmp &= ~affected_mask;106 107 tmp |= *(u32 *)(src_byte + m * 4) & affected_mask;108 iowrite32(tmp, dest + m * 4);109 }110 111 return 0;112}113EXPORT_SYMBOL(sof_block_write);114 115int sof_block_read(struct snd_sof_dev *sdev, enum snd_sof_fw_blk_type blk_type,116 u32 offset, void *dest, size_t size)117{118 int bar = snd_sof_dsp_get_bar_index(sdev, blk_type);119 120 if (bar < 0)121 return bar;122 123 memcpy_fromio(dest, sdev->bar[bar] + offset, size);124 125 return 0;126}127EXPORT_SYMBOL(sof_block_read);128