1 // SPDX-License-Identifier: (GPL-2.0 OR BSD-3-Clause) 2 // 3 // This file is provided under a dual BSD/GPLv2 license. When using or 4 // redistributing this file, you may do so under either license. 5 // 6 // Copyright(c) 2018 Intel Corporation. All rights reserved. 7 // 8 // Author: Liam Girdwood <liam.r.girdwood@linux.intel.com> 9 // 10 11 #include <linux/pci.h> 12 #include "ops.h" 13 14 static 15 bool snd_sof_pci_update_bits_unlocked(struct snd_sof_dev *sdev, u32 offset, 16 u32 mask, u32 value) 17 { 18 struct pci_dev *pci = to_pci_dev(sdev->dev); 19 unsigned int old, new; 20 u32 ret = 0; 21 22 pci_read_config_dword(pci, offset, &ret); 23 old = ret; 24 dev_dbg(sdev->dev, "Debug PCIR: %8.8x at %8.8x\n", old & mask, offset); 25 26 new = (old & ~mask) | (value & mask); 27 28 if (old == new) 29 return false; 30 31 pci_write_config_dword(pci, offset, new); 32 dev_dbg(sdev->dev, "Debug PCIW: %8.8x at %8.8x\n", value, 33 offset); 34 35 return true; 36 } 37 38 bool snd_sof_pci_update_bits(struct snd_sof_dev *sdev, u32 offset, 39 u32 mask, u32 value) 40 { 41 unsigned long flags; 42 bool change; 43 44 spin_lock_irqsave(&sdev->hw_lock, flags); 45 change = snd_sof_pci_update_bits_unlocked(sdev, offset, mask, value); 46 spin_unlock_irqrestore(&sdev->hw_lock, flags); 47 return change; 48 } 49 EXPORT_SYMBOL(snd_sof_pci_update_bits); 50 51 bool snd_sof_dsp_update_bits_unlocked(struct snd_sof_dev *sdev, u32 bar, 52 u32 offset, u32 mask, u32 value) 53 { 54 unsigned int old, new; 55 u32 ret; 56 57 ret = snd_sof_dsp_read(sdev, bar, offset); 58 59 old = ret; 60 new = (old & ~mask) | (value & mask); 61 62 if (old == new) 63 return false; 64 65 snd_sof_dsp_write(sdev, bar, offset, new); 66 67 return true; 68 } 69 EXPORT_SYMBOL(snd_sof_dsp_update_bits_unlocked); 70 71 bool snd_sof_dsp_update_bits64_unlocked(struct snd_sof_dev *sdev, u32 bar, 72 u32 offset, u64 mask, u64 value) 73 { 74 u64 old, new; 75 76 old = snd_sof_dsp_read64(sdev, bar, offset); 77 78 new = (old & ~mask) | (value & mask); 79 80 if (old == new) 81 return false; 82 83 snd_sof_dsp_write64(sdev, bar, offset, new); 84 85 return true; 86 } 87 EXPORT_SYMBOL(snd_sof_dsp_update_bits64_unlocked); 88 89 /* This is for registers bits with attribute RWC */ 90 bool snd_sof_dsp_update_bits(struct snd_sof_dev *sdev, u32 bar, u32 offset, 91 u32 mask, u32 value) 92 { 93 unsigned long flags; 94 bool change; 95 96 spin_lock_irqsave(&sdev->hw_lock, flags); 97 change = snd_sof_dsp_update_bits_unlocked(sdev, bar, offset, mask, 98 value); 99 spin_unlock_irqrestore(&sdev->hw_lock, flags); 100 return change; 101 } 102 EXPORT_SYMBOL(snd_sof_dsp_update_bits); 103 104 bool snd_sof_dsp_update_bits64(struct snd_sof_dev *sdev, u32 bar, u32 offset, 105 u64 mask, u64 value) 106 { 107 unsigned long flags; 108 bool change; 109 110 spin_lock_irqsave(&sdev->hw_lock, flags); 111 change = snd_sof_dsp_update_bits64_unlocked(sdev, bar, offset, mask, 112 value); 113 spin_unlock_irqrestore(&sdev->hw_lock, flags); 114 return change; 115 } 116 EXPORT_SYMBOL(snd_sof_dsp_update_bits64); 117 118 static 119 void snd_sof_dsp_update_bits_forced_unlocked(struct snd_sof_dev *sdev, u32 bar, 120 u32 offset, u32 mask, u32 value) 121 { 122 unsigned int old, new; 123 u32 ret; 124 125 ret = snd_sof_dsp_read(sdev, bar, offset); 126 127 old = ret; 128 new = (old & ~mask) | (value & mask); 129 130 snd_sof_dsp_write(sdev, bar, offset, new); 131 } 132 133 /* This is for registers bits with attribute RWC */ 134 void snd_sof_dsp_update_bits_forced(struct snd_sof_dev *sdev, u32 bar, 135 u32 offset, u32 mask, u32 value) 136 { 137 unsigned long flags; 138 139 spin_lock_irqsave(&sdev->hw_lock, flags); 140 snd_sof_dsp_update_bits_forced_unlocked(sdev, bar, offset, mask, value); 141 spin_unlock_irqrestore(&sdev->hw_lock, flags); 142 } 143 EXPORT_SYMBOL(snd_sof_dsp_update_bits_forced); 144 145 void snd_sof_dsp_panic(struct snd_sof_dev *sdev, u32 offset) 146 { 147 dev_err(sdev->dev, "error : DSP panic!\n"); 148 149 /* 150 * check if DSP is not ready and did not set the dsp_oops_offset. 151 * if the dsp_oops_offset is not set, set it from the panic message. 152 * Also add a check to memory window setting with panic message. 153 */ 154 if (!sdev->dsp_oops_offset) 155 sdev->dsp_oops_offset = offset; 156 else 157 dev_dbg(sdev->dev, "panic: dsp_oops_offset %zu offset %d\n", 158 sdev->dsp_oops_offset, offset); 159 160 snd_sof_dsp_dbg_dump(sdev, SOF_DBG_REGS | SOF_DBG_MBOX); 161 snd_sof_trace_notify_for_error(sdev); 162 } 163 EXPORT_SYMBOL(snd_sof_dsp_panic); 164