sde_dbg.c 68 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Copyright (c) 2009-2021, The Linux Foundation. All rights reserved.
  4. */
  5. #define pr_fmt(fmt) "[drm:%s:%d] " fmt, __func__, __LINE__
  6. #include <linux/delay.h>
  7. #include <linux/spinlock.h>
  8. #include <linux/ktime.h>
  9. #include <linux/debugfs.h>
  10. #include <linux/uaccess.h>
  11. #include <linux/dma-buf.h>
  12. #include <linux/slab.h>
  13. #include <linux/list_sort.h>
  14. #include <linux/pm.h>
  15. #include <linux/pm_runtime.h>
  16. #include "sde_dbg.h"
  17. #include "sde/sde_hw_catalog.h"
  18. #define SDE_DBG_BASE_MAX 10
  19. #define DEFAULT_PANIC 1
  20. #define DEFAULT_REGDUMP SDE_DBG_DUMP_IN_MEM
  21. #define DEFAULT_DBGBUS_DUMP SDE_DBG_DUMP_IN_MEM
  22. #define DEFAULT_BASE_REG_CNT DEFAULT_MDSS_HW_BLOCK_SIZE
  23. #define GROUP_BYTES 4
  24. #define ROW_BYTES 16
  25. #define RANGE_NAME_LEN 40
  26. #define REG_BASE_NAME_LEN 80
  27. #define DBGBUS_NAME_SDE "sde"
  28. #define DBGBUS_NAME_VBIF_RT "vbif_rt"
  29. #define DBGBUS_NAME_DSI "dsi"
  30. #define DBGBUS_NAME_RSC "sde_rsc_wrapper"
  31. #define DBGBUS_NAME_LUTDMA "reg_dma"
  32. #define DBGBUS_NAME_DP "dp_ahb"
  33. /* offsets from LUTDMA top address for the debug buses */
  34. #define LUTDMA_0_DEBUG_BUS_CTRL 0x1e8
  35. #define LUTDMA_0_DEBUG_BUS_STATUS 0x1ec
  36. #define LUTDMA_1_DEBUG_BUS_CTRL 0x5e8
  37. #define LUTDMA_1_DEBUG_BUS_STATUS 0x5ec
  38. /* offsets from sde top address for the debug buses */
  39. #define DBGBUS_SSPP0 0x188
  40. #define DBGBUS_AXI_INTF 0x194
  41. #define DBGBUS_SSPP1 0x298
  42. #define DBGBUS_DSPP 0x348
  43. #define DBGBUS_DSPP_STATUS 0x34C
  44. #define DBGBUS_PERIPH 0x418
  45. /* offsets from DSI CTRL base address for the DSI debug buses */
  46. #define DSI_DEBUG_BUS_CTRL 0x0124
  47. #define DSI_DEBUG_BUS 0x0128
  48. #define TEST_MASK(id, tp) ((id << 4) | (tp << 1) | BIT(0))
  49. #define TEST_EXT_MASK(id, tp) (((tp >> 3) << 24) | (id << 4) \
  50. | ((tp & 0x7) << 1) | BIT(0))
  51. /* following offsets are with respect to MDP VBIF base for DBG BUS access */
  52. #define MMSS_VBIF_CLKON 0x4
  53. #define MMSS_VBIF_TEST_BUS_OUT_CTRL 0x210
  54. #define MMSS_VBIF_TEST_BUS1_CTRL0 0x214
  55. #define MMSS_VBIF_TEST_BUS2_CTRL0 0x21c
  56. #define MMSS_VBIF_TEST_BUS_OUT 0x230
  57. /* Vbif error info */
  58. #define MMSS_VBIF_PND_ERR 0x190
  59. #define MMSS_VBIF_SRC_ERR 0x194
  60. #define MMSS_VBIF_XIN_HALT_CTRL1 0x204
  61. #define MMSS_VBIF_ERR_INFO 0X1a0
  62. #define MMSS_VBIF_ERR_INFO_1 0x1a4
  63. #define MMSS_VBIF_CLIENT_NUM 14
  64. #define RSC_WRAPPER_DEBUG_BUS 0x010
  65. #define RSC_WRAPPER_DEBUG_BUS_DATA 0x014
  66. /* offsets from DP AHB base address for DP debug bus */
  67. #define DPTX_DEBUG_BUS_CTRL 0x88
  68. #define DPTX_DEBUG_BUS_OUTPUT 0x8c
  69. /* print debug ranges in groups of 4 u32s */
  70. #define REG_DUMP_ALIGN 16
  71. #define RSC_DEBUG_MUX_SEL_SDM845 9
  72. #define DBG_CTRL_STOP_FTRACE BIT(0)
  73. #define DBG_CTRL_PANIC_UNDERRUN BIT(1)
  74. #define DBG_CTRL_RESET_HW_PANIC BIT(2)
  75. #define DBG_CTRL_MAX BIT(3)
  76. #define DUMP_BUF_SIZE (4096 * 512)
  77. #define DUMP_CLMN_COUNT 4
  78. #define DUMP_LINE_SIZE 256
  79. #define DUMP_MAX_LINES_PER_BLK 512
  80. #define EXT_TEST_GROUP_SEL_EN 0x7
  81. #define DSPP_DEBUGBUS_CTRL_EN 0x7001
  82. #define SDE_HW_REV_MAJOR(rev) ((rev) >> 28)
  83. #define SDE_DBG_LOG_START "start"
  84. #define SDE_DBG_LOG_END "end"
  85. #define SDE_DBG_LOG_MARKER(name, marker) \
  86. dev_info(sde_dbg_base.dev, "======== %s %s dump =========\n", marker, name)
  87. #define SDE_DBG_LOG_ENTRY(off, x0, x4, x8, xc) \
  88. dev_info(sde_dbg_base.dev, "0x%lx : %08x %08x %08x %08x\n", off, x0, x4, x8, xc)
  89. #define SDE_DBG_LOG_DUMP_ADDR(name, addr, size, off) \
  90. dev_info(sde_dbg_base.dev, "%s: start_addr:0x%pK len:0x%x offset=0x%lx\n", \
  91. name, addr, size, off)
  92. #define SDE_DBG_LOG_DEBUGBUS(name, addr, block_id, test_id, val) \
  93. dev_err(sde_dbg_base.dev, "%s 0x%x %d %d 0x%x\n", \
  94. name, addr, block_id, test_id, val)
  95. /**
  96. * struct sde_dbg_reg_offset - tracking for start and end of region
  97. * @start: start offset
  98. * @start: end offset
  99. */
  100. struct sde_dbg_reg_offset {
  101. u32 start;
  102. u32 end;
  103. };
  104. /**
  105. * struct sde_dbg_reg_range - register dumping named sub-range
  106. * @head: head of this node
  107. * @reg_dump: address for the mem dump
  108. * @range_name: name of this range
  109. * @offset: offsets for range to dump
  110. * @xin_id: client xin id
  111. */
  112. struct sde_dbg_reg_range {
  113. struct list_head head;
  114. u32 *reg_dump;
  115. char range_name[RANGE_NAME_LEN];
  116. struct sde_dbg_reg_offset offset;
  117. uint32_t xin_id;
  118. };
  119. /**
  120. * struct sde_dbg_reg_base - register region base.
  121. * may sub-ranges: sub-ranges are used for dumping
  122. * or may not have sub-ranges: dumping is base -> max_offset
  123. * @reg_base_head: head of this node
  124. * @sub_range_list: head to the list with dump ranges
  125. * @name: register base name
  126. * @base: base pointer
  127. * @off: cached offset of region for manual register dumping
  128. * @cnt: cached range of region for manual register dumping
  129. * @max_offset: length of region
  130. * @buf: buffer used for manual register dumping
  131. * @buf_len: buffer length used for manual register dumping
  132. * @reg_dump: address for the mem dump if no ranges used
  133. * @cb: callback for external dump function, null if not defined
  134. * @cb_ptr: private pointer to callback function
  135. * @blk_id: id indicate the HW block
  136. */
  137. struct sde_dbg_reg_base {
  138. struct list_head reg_base_head;
  139. struct list_head sub_range_list;
  140. char name[REG_BASE_NAME_LEN];
  141. void __iomem *base;
  142. size_t off;
  143. size_t cnt;
  144. size_t max_offset;
  145. char *buf;
  146. size_t buf_len;
  147. u32 *reg_dump;
  148. void (*cb)(void *ptr);
  149. void *cb_ptr;
  150. u64 blk_id;
  151. };
  152. struct sde_debug_bus_entry {
  153. u32 wr_addr;
  154. u32 rd_addr;
  155. u32 block_id;
  156. u32 block_id_max;
  157. u32 test_id;
  158. u32 test_id_max;
  159. void (*analyzer)(u32 wr_addr, u32 block_id, u32 test_id, u32 val);
  160. };
  161. struct sde_dbg_dsi_ctrl_list_entry {
  162. const char *name;
  163. void __iomem *base;
  164. struct list_head list;
  165. };
  166. struct sde_dbg_debug_bus_common {
  167. char *name;
  168. u32 entries_size;
  169. u32 limited_entries_size;
  170. u32 *dumped_content;
  171. u32 content_idx;
  172. u32 content_size;
  173. u64 blk_id;
  174. };
  175. struct sde_dbg_sde_debug_bus {
  176. struct sde_dbg_debug_bus_common cmn;
  177. struct sde_debug_bus_entry *entries;
  178. struct sde_debug_bus_entry *limited_entries;
  179. u32 top_blk_off;
  180. u32 (*read_tp)(void __iomem *mem_base, u32 wr_addr, u32 rd_addr, u32 block_id, u32 test_id);
  181. void (*clear_tp)(void __iomem *mem_base, u32 wr_addr);
  182. void (*disable_block)(void __iomem *mem_base, u32 wr_addr);
  183. };
  184. /**
  185. * struct sde_dbg_regbuf - wraps buffer and tracking params for register dumps
  186. * @buf: pointer to allocated memory for storing register dumps in hw recovery
  187. * @buf_size: size of the memory allocated
  188. * @len: size of the dump data valid in the buffer
  189. * @rpos: cursor points to the buffer position read by client
  190. * @dump_done: to indicate if dumping to user memory is complete
  191. * @cur_blk: points to the current sde_dbg_reg_base block
  192. */
  193. struct sde_dbg_regbuf {
  194. char *buf;
  195. int buf_size;
  196. int len;
  197. int rpos;
  198. int dump_done;
  199. struct sde_dbg_reg_base *cur_blk;
  200. };
  201. /**
  202. * struct sde_dbg_base - global sde debug base structure
  203. * @evtlog: event log instance
  204. * @reglog: reg log instance
  205. * @reg_base_list: list of register dumping regions
  206. * @dev: device pointer
  207. * @mutex: mutex to serialize access to serialze dumps, debugfs access
  208. * @req_dump_blks: list of blocks requested for dumping
  209. * @panic_on_err: whether to kernel panic after triggering dump via debugfs
  210. * @dump_work: work struct for deferring register dump work to separate thread
  211. * @work_panic: panic after dump if internal user passed "panic" special region
  212. * @enable_reg_dump: whether to dump registers into memory, kernel log, or both
  213. * @enable_dbgbus_dump: whether to dump dbgbus into memory, kernel log, or both
  214. * @dbgbus_sde: debug bus structure for the sde
  215. * @dbgbus_vbif_rt: debug bus structure for the realtime vbif
  216. * @dbgbus_dsi: debug bus structure for the dsi
  217. * @dbgbus_rsc: debug bus structure for rscc
  218. * @dbgbus_lutdma: debug bus structure for the lutdma hw
  219. * @dbgbus_dp: debug bus structure for dp
  220. * @dump_blk_mask: mask of all the hw blk-ids that has to be dumped
  221. * @dump_secure: dump entries excluding few as it is in secure-session
  222. * @regbuf: buffer data to track the register dumping in hw recovery
  223. * @cur_evt_index: index used for tracking event logs dump in hw recovery
  224. * @cur_reglog_index: index used for tracking register logs dump in hw recovery
  225. * @dbgbus_dump_idx: index used for tracking dbg-bus dump in hw recovery
  226. * @vbif_dbgbus_dump_idx: index for tracking vbif dumps in hw recovery
  227. * @hw_ownership: indicates if the VM owns the HW resources
  228. */
  229. static struct sde_dbg_base {
  230. struct sde_dbg_evtlog *evtlog;
  231. struct sde_dbg_reglog *reglog;
  232. struct list_head reg_base_list;
  233. struct device *dev;
  234. struct mutex mutex;
  235. struct sde_dbg_reg_base *req_dump_blks[SDE_DBG_BASE_MAX];
  236. u32 panic_on_err;
  237. struct work_struct dump_work;
  238. bool work_panic;
  239. u32 enable_reg_dump;
  240. u32 enable_dbgbus_dump;
  241. struct sde_dbg_sde_debug_bus dbgbus_sde;
  242. struct sde_dbg_sde_debug_bus dbgbus_vbif_rt;
  243. struct sde_dbg_sde_debug_bus dbgbus_dsi;
  244. struct sde_dbg_sde_debug_bus dbgbus_rsc;
  245. struct sde_dbg_sde_debug_bus dbgbus_lutdma;
  246. struct sde_dbg_sde_debug_bus dbgbus_dp;
  247. u64 dump_blk_mask;
  248. bool dump_secure;
  249. u32 debugfs_ctrl;
  250. struct sde_dbg_regbuf regbuf;
  251. u32 cur_evt_index;
  252. u32 cur_reglog_index;
  253. enum sde_dbg_dump_context dump_mode;
  254. bool hw_ownership;
  255. } sde_dbg_base;
  256. static LIST_HEAD(sde_dbg_dsi_list);
  257. static DEFINE_MUTEX(sde_dbg_dsi_mutex);
  258. /* sde_dbg_base_evtlog - global pointer to main sde event log for macro use */
  259. struct sde_dbg_evtlog *sde_dbg_base_evtlog;
  260. /* sde_dbg_base_reglog - global pointer to main sde reg log for macro use */
  261. struct sde_dbg_reglog *sde_dbg_base_reglog;
  262. static void _sde_debug_bus_xbar_dump(u32 wr_addr, u32 block_id, u32 test_id, u32 val)
  263. {
  264. SDE_DBG_LOG_DEBUGBUS("xbar", wr_addr, block_id, test_id, val);
  265. }
  266. static void _sde_debug_bus_lm_dump(u32 wr_addr, u32 block_id, u32 test_id, u32 val)
  267. {
  268. if (!(val & 0xFFF000))
  269. return;
  270. SDE_DBG_LOG_DEBUGBUS("lm", wr_addr, block_id, test_id, val);
  271. }
  272. static void _sde_debug_bus_ppb0_dump(u32 wr_addr, u32 block_id, u32 test_id, u32 val)
  273. {
  274. if (!(val & BIT(15)))
  275. return;
  276. SDE_DBG_LOG_DEBUGBUS("pp0", wr_addr, block_id, test_id, val);
  277. }
  278. static void _sde_debug_bus_ppb1_dump(u32 wr_addr, u32 block_id, u32 test_id, u32 val)
  279. {
  280. if (!(val & BIT(15)))
  281. return;
  282. SDE_DBG_LOG_DEBUGBUS("pp1", wr_addr, block_id, test_id, val);
  283. }
  284. static struct sde_debug_bus_entry dbg_bus_sde_limited[] = {
  285. { DBGBUS_SSPP0, DBGBUS_DSPP_STATUS, 0, 9, 0, 8 },
  286. { DBGBUS_SSPP0, DBGBUS_DSPP_STATUS, 20, 34, 0, 8 },
  287. { DBGBUS_SSPP0, DBGBUS_DSPP_STATUS, 60, 4, 0, 8 },
  288. { DBGBUS_SSPP0, DBGBUS_DSPP_STATUS, 70, 4, 0, 8 },
  289. { DBGBUS_SSPP1, DBGBUS_DSPP_STATUS, 0, 9, 0, 8 },
  290. { DBGBUS_SSPP1, DBGBUS_DSPP_STATUS, 20, 34, 0, 8 },
  291. { DBGBUS_SSPP1, DBGBUS_DSPP_STATUS, 60, 4, 0, 8 },
  292. { DBGBUS_SSPP1, DBGBUS_DSPP_STATUS, 70, 4, 0, 8 },
  293. { DBGBUS_DSPP, DBGBUS_DSPP_STATUS, 0, 1, 0, 8 },
  294. { DBGBUS_DSPP, DBGBUS_DSPP_STATUS, 9, 1, 0, 8 },
  295. { DBGBUS_DSPP, DBGBUS_DSPP_STATUS, 13, 2, 0, 8 },
  296. { DBGBUS_DSPP, DBGBUS_DSPP_STATUS, 19, 2, 0, 8 },
  297. { DBGBUS_DSPP, DBGBUS_DSPP_STATUS, 24, 2, 0, 8 },
  298. { DBGBUS_DSPP, DBGBUS_DSPP_STATUS, 31, 8, 0, 8 },
  299. { DBGBUS_DSPP, DBGBUS_DSPP_STATUS, 42, 12, 0, 8 },
  300. { DBGBUS_DSPP, DBGBUS_DSPP_STATUS, 54, 2, 0, 32 },
  301. { DBGBUS_DSPP, DBGBUS_DSPP_STATUS, 56, 2, 0, 8 },
  302. { DBGBUS_DSPP, DBGBUS_DSPP_STATUS, 63, 73, 0, 8 },
  303. { DBGBUS_PERIPH, DBGBUS_DSPP_STATUS, 0, 1, 0, 8 },
  304. { DBGBUS_PERIPH, DBGBUS_DSPP_STATUS, 47, 7, 0, 8 },
  305. { DBGBUS_PERIPH, DBGBUS_DSPP_STATUS, 60, 14, 0, 8 },
  306. { DBGBUS_PERIPH, DBGBUS_DSPP_STATUS, 80, 3, 0, 8 },
  307. };
  308. static struct sde_debug_bus_entry dbg_bus_sde[] = {
  309. { DBGBUS_SSPP0, DBGBUS_DSPP_STATUS, 0, 74, 0, 32 },
  310. { DBGBUS_SSPP1, DBGBUS_DSPP_STATUS, 0, 74, 0, 32 },
  311. { DBGBUS_DSPP, DBGBUS_DSPP_STATUS, 0, 137, 0, 32 },
  312. { DBGBUS_PERIPH, DBGBUS_DSPP_STATUS, 0, 78, 0, 32 },
  313. { DBGBUS_AXI_INTF, DBGBUS_DSPP_STATUS, 0, 63, 0, 32 },
  314. /* ppb_0 */
  315. { DBGBUS_DSPP, DBGBUS_DSPP_STATUS, 31, 1, 0, 1, _sde_debug_bus_ppb0_dump },
  316. { DBGBUS_DSPP, DBGBUS_DSPP_STATUS, 33, 1, 0, 1, _sde_debug_bus_ppb0_dump },
  317. { DBGBUS_DSPP, DBGBUS_DSPP_STATUS, 35, 1, 0, 1, _sde_debug_bus_ppb0_dump },
  318. { DBGBUS_DSPP, DBGBUS_DSPP_STATUS, 42, 1, 0, 1, _sde_debug_bus_ppb0_dump },
  319. { DBGBUS_DSPP, DBGBUS_DSPP_STATUS, 47, 1, 0, 1, _sde_debug_bus_ppb0_dump },
  320. { DBGBUS_DSPP, DBGBUS_DSPP_STATUS, 49, 1, 0, 1, _sde_debug_bus_ppb0_dump },
  321. /* ppb_1 */
  322. { DBGBUS_DSPP, DBGBUS_DSPP_STATUS, 32, 1, 0, 1, _sde_debug_bus_ppb1_dump },
  323. { DBGBUS_DSPP, DBGBUS_DSPP_STATUS, 34, 1, 0, 1, _sde_debug_bus_ppb1_dump },
  324. { DBGBUS_DSPP, DBGBUS_DSPP_STATUS, 36, 1, 0, 1, _sde_debug_bus_ppb1_dump },
  325. { DBGBUS_DSPP, DBGBUS_DSPP_STATUS, 43, 1, 0, 1, _sde_debug_bus_ppb1_dump },
  326. { DBGBUS_DSPP, DBGBUS_DSPP_STATUS, 48, 1, 0, 1, _sde_debug_bus_ppb1_dump },
  327. { DBGBUS_DSPP, DBGBUS_DSPP_STATUS, 50, 1, 0, 1, _sde_debug_bus_ppb1_dump },
  328. /* crossbar */
  329. { DBGBUS_DSPP, DBGBUS_DSPP_STATUS, 0, 1, 0, 1, _sde_debug_bus_xbar_dump },
  330. /* blend */
  331. { DBGBUS_DSPP, DBGBUS_DSPP_STATUS, 63, 1, 7, 1, _sde_debug_bus_lm_dump },
  332. { DBGBUS_DSPP, DBGBUS_DSPP_STATUS, 70, 1, 7, 1, _sde_debug_bus_lm_dump },
  333. { DBGBUS_DSPP, DBGBUS_DSPP_STATUS, 77, 1, 7, 1, _sde_debug_bus_lm_dump },
  334. { DBGBUS_DSPP, DBGBUS_DSPP_STATUS, 110, 1, 7, 1, _sde_debug_bus_lm_dump },
  335. { DBGBUS_DSPP, DBGBUS_DSPP_STATUS, 96, 1, 7, 1, _sde_debug_bus_lm_dump },
  336. { DBGBUS_DSPP, DBGBUS_DSPP_STATUS, 124, 1, 7, 1, _sde_debug_bus_lm_dump }
  337. };
  338. static struct sde_debug_bus_entry vbif_dbg_bus_limited[] = {
  339. { MMSS_VBIF_TEST_BUS1_CTRL0, MMSS_VBIF_TEST_BUS_OUT, 0, 2, 0, 12},
  340. { MMSS_VBIF_TEST_BUS1_CTRL0, MMSS_VBIF_TEST_BUS_OUT, 4, 6, 0, 12},
  341. { MMSS_VBIF_TEST_BUS1_CTRL0, MMSS_VBIF_TEST_BUS_OUT, 12, 2, 0, 12},
  342. { MMSS_VBIF_TEST_BUS2_CTRL0, MMSS_VBIF_TEST_BUS_OUT, 0, 2, 0, 16},
  343. { MMSS_VBIF_TEST_BUS2_CTRL0, MMSS_VBIF_TEST_BUS_OUT, 0, 2, 128, 208},
  344. { MMSS_VBIF_TEST_BUS2_CTRL0, MMSS_VBIF_TEST_BUS_OUT, 4, 6, 0, 16},
  345. { MMSS_VBIF_TEST_BUS2_CTRL0, MMSS_VBIF_TEST_BUS_OUT, 4, 6, 128, 208},
  346. { MMSS_VBIF_TEST_BUS2_CTRL0, MMSS_VBIF_TEST_BUS_OUT, 12, 2, 0, 16},
  347. { MMSS_VBIF_TEST_BUS2_CTRL0, MMSS_VBIF_TEST_BUS_OUT, 12, 2, 128, 208},
  348. { MMSS_VBIF_TEST_BUS2_CTRL0, MMSS_VBIF_TEST_BUS_OUT, 16, 2, 0, 16},
  349. { MMSS_VBIF_TEST_BUS2_CTRL0, MMSS_VBIF_TEST_BUS_OUT, 16, 2, 128, 208},
  350. };
  351. static struct sde_debug_bus_entry vbif_dbg_bus[] = {
  352. { MMSS_VBIF_TEST_BUS1_CTRL0, MMSS_VBIF_TEST_BUS_OUT, 0, 15, 0, 512},
  353. { MMSS_VBIF_TEST_BUS2_CTRL0, MMSS_VBIF_TEST_BUS_OUT, 0, 18, 0, 512},
  354. };
  355. static struct sde_debug_bus_entry dsi_dbg_bus[] = {
  356. {DSI_DEBUG_BUS_CTRL, DSI_DEBUG_BUS, 0, 4, 0, 64},
  357. };
  358. static struct sde_debug_bus_entry rsc_dbg_bus[] = {
  359. {RSC_WRAPPER_DEBUG_BUS, RSC_WRAPPER_DEBUG_BUS_DATA, 0, 1, 0, 16},
  360. };
  361. static struct sde_debug_bus_entry dbg_bus_lutdma[] = {
  362. { LUTDMA_0_DEBUG_BUS_CTRL, LUTDMA_0_DEBUG_BUS_STATUS, 0, 1, 0, 12 },
  363. { LUTDMA_0_DEBUG_BUS_CTRL, LUTDMA_0_DEBUG_BUS_STATUS, 0, 1, 256, 1 },
  364. { LUTDMA_0_DEBUG_BUS_CTRL, LUTDMA_0_DEBUG_BUS_STATUS, 0, 1, 512, 4 },
  365. { LUTDMA_0_DEBUG_BUS_CTRL, LUTDMA_0_DEBUG_BUS_STATUS, 0, 1, 768, 1 },
  366. { LUTDMA_0_DEBUG_BUS_CTRL, LUTDMA_0_DEBUG_BUS_STATUS, 0, 1, 8192, 2 },
  367. { LUTDMA_0_DEBUG_BUS_CTRL, LUTDMA_0_DEBUG_BUS_STATUS, 0, 1, 8448, 1 },
  368. { LUTDMA_0_DEBUG_BUS_CTRL, LUTDMA_0_DEBUG_BUS_STATUS, 0, 1, 8704, 1 },
  369. { LUTDMA_0_DEBUG_BUS_CTRL, LUTDMA_0_DEBUG_BUS_STATUS, 0, 1, 8960, 1 },
  370. { LUTDMA_1_DEBUG_BUS_CTRL, LUTDMA_1_DEBUG_BUS_STATUS, 0, 1, 0, 12 },
  371. { LUTDMA_1_DEBUG_BUS_CTRL, LUTDMA_1_DEBUG_BUS_STATUS, 0, 1, 256, 1 },
  372. { LUTDMA_1_DEBUG_BUS_CTRL, LUTDMA_1_DEBUG_BUS_STATUS, 0, 1, 512, 4 },
  373. { LUTDMA_1_DEBUG_BUS_CTRL, LUTDMA_1_DEBUG_BUS_STATUS, 0, 1, 768, 1 },
  374. { LUTDMA_1_DEBUG_BUS_CTRL, LUTDMA_1_DEBUG_BUS_STATUS, 0, 1, 8192, 2 },
  375. { LUTDMA_1_DEBUG_BUS_CTRL, LUTDMA_1_DEBUG_BUS_STATUS, 0, 1, 8448, 1 },
  376. { LUTDMA_1_DEBUG_BUS_CTRL, LUTDMA_1_DEBUG_BUS_STATUS, 0, 1, 8704, 1 },
  377. { LUTDMA_1_DEBUG_BUS_CTRL, LUTDMA_1_DEBUG_BUS_STATUS, 0, 1, 8960, 1 },
  378. };
  379. static struct sde_debug_bus_entry dp_dbg_bus[] = {
  380. {DPTX_DEBUG_BUS_CTRL, DPTX_DEBUG_BUS_OUTPUT, 0, 1, 0, 145},
  381. };
  382. /**
  383. * _sde_power_check - check if power needs to enabled
  384. * @dump_mode: to check if power need to be enabled
  385. * Return: true if success; false otherwise
  386. */
  387. static inline bool _sde_power_check(enum sde_dbg_dump_context dump_mode)
  388. {
  389. return (dump_mode == SDE_DBG_DUMP_CLK_ENABLED_CTX ||
  390. dump_mode == SDE_DBG_DUMP_IRQ_CTX) ? false : true;
  391. }
  392. /**
  393. * _sde_dump_reg - helper function for dumping rotator register set content
  394. * @dump_name: register set name
  395. * @reg_dump_flag: dumping flag controlling in-log/memory dump location
  396. * @base_addr: starting address of io region for calculating offsets to print
  397. * @addr: starting address offset for dumping
  398. * @len_bytes: range of the register set
  399. * @dump_mem: output buffer for memory dump location option
  400. * @from_isr: whether being called from isr context
  401. */
  402. static void _sde_dump_reg(const char *dump_name, u32 reg_dump_flag,
  403. char *base_addr, char *addr, size_t len_bytes, u32 **dump_mem)
  404. {
  405. u32 in_log, in_mem, len_align, len_padded;
  406. u32 *dump_addr = NULL;
  407. char *end_addr;
  408. int i;
  409. if (!len_bytes || !dump_mem)
  410. return;
  411. in_log = (reg_dump_flag & SDE_DBG_DUMP_IN_LOG)
  412. | (reg_dump_flag & SDE_DBG_DUMP_IN_LOG_LIMITED);
  413. in_mem = (reg_dump_flag & SDE_DBG_DUMP_IN_MEM);
  414. pr_debug("%s: reg_dump_flag=%d in_log=%d in_mem=%d\n",
  415. dump_name, reg_dump_flag, in_log, in_mem);
  416. if (!in_log && !in_mem)
  417. return;
  418. len_align = (len_bytes + REG_DUMP_ALIGN - 1) / REG_DUMP_ALIGN;
  419. len_padded = len_align * REG_DUMP_ALIGN;
  420. end_addr = addr + len_bytes;
  421. if (in_mem && !(*dump_mem))
  422. *dump_mem = devm_kzalloc(sde_dbg_base.dev, len_padded, GFP_KERNEL);
  423. dump_addr = *dump_mem;
  424. SDE_DBG_LOG_DUMP_ADDR(dump_name, dump_addr, len_padded, (unsigned long)(addr - base_addr));
  425. for (i = 0; i < len_align; i++) {
  426. u32 x0, x4, x8, xc;
  427. x0 = (addr < end_addr) ? readl_relaxed(addr + 0x0) : 0;
  428. x4 = (addr + 0x4 < end_addr) ? readl_relaxed(addr + 0x4) : 0;
  429. x8 = (addr + 0x8 < end_addr) ? readl_relaxed(addr + 0x8) : 0;
  430. xc = (addr + 0xc < end_addr) ? readl_relaxed(addr + 0xc) : 0;
  431. if (in_log)
  432. SDE_DBG_LOG_ENTRY((unsigned long)(addr - base_addr), x0, x4, x8, xc);
  433. if (dump_addr) {
  434. dump_addr[i * 4] = x0;
  435. dump_addr[i * 4 + 1] = x4;
  436. dump_addr[i * 4 + 2] = x8;
  437. dump_addr[i * 4 + 3] = xc;
  438. }
  439. addr += REG_DUMP_ALIGN;
  440. }
  441. }
  442. /**
  443. * _sde_dbg_get_dump_range - helper to retrieve dump length for a range node
  444. * @range_node: range node to dump
  445. * @max_offset: max offset of the register base
  446. * @Return: length
  447. */
  448. static u32 _sde_dbg_get_dump_range(struct sde_dbg_reg_offset *range_node,
  449. size_t max_offset)
  450. {
  451. u32 length = 0;
  452. if (range_node->start == 0 && range_node->end == 0) {
  453. length = max_offset;
  454. } else if (range_node->start < max_offset) {
  455. if (range_node->end > max_offset)
  456. length = max_offset - range_node->start;
  457. else if (range_node->start < range_node->end)
  458. length = range_node->end - range_node->start;
  459. }
  460. return length;
  461. }
  462. static int _sde_dump_reg_range_cmp(void *priv, struct list_head *a,
  463. struct list_head *b)
  464. {
  465. struct sde_dbg_reg_range *ar, *br;
  466. if (!a || !b)
  467. return 0;
  468. ar = container_of(a, struct sde_dbg_reg_range, head);
  469. br = container_of(b, struct sde_dbg_reg_range, head);
  470. return ar->offset.start - br->offset.start;
  471. }
  472. static const char *const exclude_modules[] = {
  473. "vbif_rt",
  474. "vbif_nrt",
  475. "wb_2",
  476. NULL
  477. };
  478. static bool is_block_exclude(char **modules, char *name)
  479. {
  480. char **ptr = modules;
  481. while (*ptr != NULL) {
  482. if (!strcmp(name, *ptr))
  483. return true;
  484. ++ptr;
  485. }
  486. return false;
  487. }
  488. /**
  489. * _sde_dump_reg_by_ranges - dump ranges or full range of the register blk base
  490. * @dbg: register blk base structure
  491. * @reg_dump_flag: dump target, memory, kernel log, or both
  492. */
  493. static void _sde_dump_reg_by_ranges(struct sde_dbg_reg_base *dbg, u32 reg_dump_flag)
  494. {
  495. char *addr;
  496. size_t len;
  497. struct sde_dbg_reg_range *range_node;
  498. if (!dbg || !(dbg->base || dbg->cb)) {
  499. pr_err("dbg base is null!\n");
  500. return;
  501. }
  502. SDE_DBG_LOG_MARKER(dbg->name, SDE_DBG_LOG_START);
  503. if (dbg->cb) {
  504. dbg->cb(dbg->cb_ptr);
  505. /* If there is a list to dump the registers by ranges, use the ranges */
  506. } else if (!list_empty(&dbg->sub_range_list)) {
  507. /* sort the list by start address first */
  508. list_sort(NULL, &dbg->sub_range_list, _sde_dump_reg_range_cmp);
  509. list_for_each_entry(range_node, &dbg->sub_range_list, head) {
  510. len = _sde_dbg_get_dump_range(&range_node->offset, dbg->max_offset);
  511. addr = dbg->base + range_node->offset.start;
  512. pr_debug("%s: range_base=0x%pK start=0x%x end=0x%x\n",
  513. range_node->range_name, addr, range_node->offset.start,
  514. range_node->offset.end);
  515. _sde_dump_reg(range_node->range_name, reg_dump_flag,
  516. dbg->base, addr, len, &range_node->reg_dump);
  517. }
  518. } else {
  519. /* If there is no list to dump ranges, dump all registers */
  520. dev_info(sde_dbg_base.dev, "Ranges not found, will dump full registers\n");
  521. SDE_DBG_LOG_DUMP_ADDR("base", dbg->base, dbg->max_offset, 0);
  522. addr = dbg->base;
  523. len = dbg->max_offset;
  524. _sde_dump_reg(dbg->name, reg_dump_flag, dbg->base, addr, len, &dbg->reg_dump);
  525. }
  526. }
  527. /**
  528. * _sde_dump_reg_mask - dump register regions based on mask
  529. * @dump_blk_mask: mask of all the hw blk-ids that has to be dumped
  530. * @dump_secure: flag to indicate dumping in secure-session
  531. */
  532. static void _sde_dump_reg_mask(u64 dump_blk_mask, bool dump_secure)
  533. {
  534. struct sde_dbg_base *dbg_base = &sde_dbg_base;
  535. struct sde_dbg_reg_base *blk_base;
  536. if (!dump_blk_mask)
  537. return;
  538. list_for_each_entry(blk_base, &dbg_base->reg_base_list, reg_base_head) {
  539. if ((!(blk_base->blk_id & dump_blk_mask)) || (!strlen(blk_base->name)))
  540. continue;
  541. if (dump_secure && is_block_exclude((char **)exclude_modules, blk_base->name))
  542. continue;
  543. _sde_dump_reg_by_ranges(blk_base, dbg_base->enable_reg_dump);
  544. }
  545. }
  546. /**
  547. * _sde_dump_get_blk_addr - retrieve register block address by name
  548. * @blk_name: register blk name
  549. * @Return: register blk base, or NULL
  550. */
  551. static struct sde_dbg_reg_base *_sde_dump_get_blk_addr(const char *blk_name)
  552. {
  553. struct sde_dbg_base *dbg_base = &sde_dbg_base;
  554. struct sde_dbg_reg_base *blk_base;
  555. list_for_each_entry(blk_base, &dbg_base->reg_base_list, reg_base_head)
  556. if (strlen(blk_base->name) && !strcmp(blk_base->name, blk_name))
  557. return blk_base;
  558. return NULL;
  559. }
  560. static u32 _sde_dbg_cmn_read_test_point(void __iomem *mem_base, u32 wr_addr, u32 rd_addr, u32 val)
  561. {
  562. writel_relaxed(val, mem_base + wr_addr);
  563. wmb(); /* make sure debug-bus test point is enabled */
  564. return readl_relaxed(mem_base + rd_addr);
  565. }
  566. static void _sde_dbg_cmn_clear_test_point(void __iomem *mem_base, u32 wr_addr)
  567. {
  568. writel_relaxed(0, mem_base + wr_addr);
  569. }
  570. static u32 _sde_dbg_dp_read_test_point(void __iomem *mem_base, u32 wr_addr, u32 rd_addr,
  571. u32 block_id, u32 test_id)
  572. {
  573. u32 val = (test_id << 4) | BIT(0);
  574. return _sde_dbg_cmn_read_test_point(mem_base, wr_addr, rd_addr, val);
  575. }
  576. static u32 _sde_dbg_rsc_read_test_point(void __iomem *mem_base, u32 wr_addr, u32 rd_addr,
  577. u32 block_id, u32 test_id)
  578. {
  579. u32 val = ((test_id & 0xf) << 1) | BIT(0);
  580. return _sde_dbg_cmn_read_test_point(mem_base, wr_addr, rd_addr, val);
  581. }
  582. static u32 _sde_dbg_lutdma_read_test_point(void __iomem *mem_base, u32 wr_addr, u32 rd_addr,
  583. u32 block_id, u32 test_id)
  584. {
  585. u32 val = (BIT(0) | (test_id << 1)) & 0xFFFF;
  586. return _sde_dbg_cmn_read_test_point(mem_base, wr_addr, rd_addr, val);
  587. }
  588. static u32 _sde_dbg_dsi_read_test_point(void __iomem *mem_base, u32 wr_addr, u32 rd_addr,
  589. u32 block_id, u32 test_id)
  590. {
  591. u32 val = (((block_id & 0x3) << 12) | ((test_id & 0x3f) << 4) | BIT(0));
  592. return _sde_dbg_cmn_read_test_point(mem_base, wr_addr, rd_addr, val);
  593. }
  594. static void _sde_dbg_vbif_disable_block(void __iomem *mem_base, u32 wr_addr)
  595. {
  596. u32 disable_addr;
  597. /* make sure that other bus is off */
  598. disable_addr = (wr_addr == MMSS_VBIF_TEST_BUS1_CTRL0) ?
  599. MMSS_VBIF_TEST_BUS2_CTRL0 : MMSS_VBIF_TEST_BUS1_CTRL0;
  600. writel_relaxed(0, mem_base + disable_addr);
  601. writel_relaxed(BIT(0), mem_base + MMSS_VBIF_TEST_BUS_OUT_CTRL);
  602. }
  603. static u32 _sde_dbg_vbif_read_test_point(void __iomem *mem_base, u32 wr_addr, u32 rd_addr,
  604. u32 block_id, u32 test_id)
  605. {
  606. writel_relaxed((1 << block_id), mem_base + wr_addr);
  607. writel_relaxed(test_id, mem_base + wr_addr + 0x4);
  608. wmb(); /* make sure debug-bus test point is enabled */
  609. return readl_relaxed(mem_base + rd_addr);
  610. }
  611. static void _sde_dbg_vbif_clear_test_point(void __iomem *mem_base, u32 wr_addr)
  612. {
  613. writel_relaxed(0, mem_base + wr_addr);
  614. writel_relaxed(0, mem_base + wr_addr + 0x4);
  615. }
  616. static u32 _sde_dbg_sde_read_test_point(void __iomem *mem_base, u32 wr_addr, u32 rd_addr,
  617. u32 block_id, u32 test_id)
  618. {
  619. if (block_id > EXT_TEST_GROUP_SEL_EN)
  620. writel_relaxed(TEST_EXT_MASK(block_id, test_id), mem_base + wr_addr);
  621. else
  622. writel_relaxed(TEST_MASK(block_id, test_id), mem_base + wr_addr);
  623. /* keep DSPP test point enabled */
  624. if (wr_addr != DBGBUS_DSPP)
  625. writel_relaxed(DSPP_DEBUGBUS_CTRL_EN, mem_base + DBGBUS_DSPP);
  626. wmb(); /* make sure test bits were written */
  627. return readl_relaxed(mem_base + rd_addr);
  628. }
  629. static void _sde_dbg_sde_clear_test_point(void __iomem *mem_base, u32 wr_addr)
  630. {
  631. writel_relaxed(0x0, mem_base + wr_addr);
  632. if (wr_addr != DBGBUS_DSPP)
  633. writel_relaxed(0x0, mem_base + DBGBUS_DSPP);
  634. }
  635. static void _sde_dbg_dump_vbif_err_info(void __iomem *mem_base)
  636. {
  637. u32 value, d0, d1;
  638. unsigned long reg, reg1, reg2;
  639. int i;
  640. value = readl_relaxed(mem_base + MMSS_VBIF_CLKON);
  641. writel_relaxed(value | BIT(1), mem_base + MMSS_VBIF_CLKON);
  642. wmb(); /* make sure that vbif core is on */
  643. /*
  644. * Extract VBIF error info based on XIN halt and error status.
  645. * If the XIN client is not in HALT state, or an error is detected,
  646. * then retrieve the VBIF error info for it.
  647. */
  648. reg = readl_relaxed(mem_base + MMSS_VBIF_XIN_HALT_CTRL1);
  649. reg1 = readl_relaxed(mem_base + MMSS_VBIF_PND_ERR);
  650. reg2 = readl_relaxed(mem_base + MMSS_VBIF_SRC_ERR);
  651. dev_err(sde_dbg_base.dev, "xin halt:0x%lx, pnd err:0x%lx, src err:0x%lx\n",
  652. reg, reg1, reg2);
  653. reg >>= 16;
  654. reg &= ~(reg1 | reg2);
  655. for (i = 0; i < MMSS_VBIF_CLIENT_NUM; i++) {
  656. if (!test_bit(0, &reg)) {
  657. writel_relaxed(i, mem_base + MMSS_VBIF_ERR_INFO);
  658. wmb(); /* make sure reg write goes through */
  659. d0 = readl_relaxed(mem_base + MMSS_VBIF_ERR_INFO);
  660. d1 = readl_relaxed(mem_base + MMSS_VBIF_ERR_INFO_1);
  661. dev_err(sde_dbg_base.dev, "Client:%d, errinfo=0x%x, errinfo1=0x%x\n",
  662. i, d0, d1);
  663. }
  664. reg >>= 1;
  665. }
  666. }
  667. static bool _is_dbg_bus_limited_valid(struct sde_dbg_sde_debug_bus *bus,
  668. u32 wr_addr, u32 block_id, u32 test_id)
  669. {
  670. struct sde_debug_bus_entry *entry;
  671. u32 block_id_max, test_id_max;
  672. int i;
  673. if (!bus->limited_entries || !bus->cmn.limited_entries_size)
  674. return true;
  675. for (i = 0; i < bus->cmn.limited_entries_size; i++) {
  676. entry = bus->limited_entries + i;
  677. block_id_max = entry->block_id + entry->block_id_max;
  678. test_id_max = entry->test_id + entry->test_id_max;
  679. if ((wr_addr == entry->wr_addr)
  680. && ((block_id >= entry->block_id) && (block_id < block_id_max))
  681. && ((test_id >= entry->test_id) && (test_id < test_id_max)))
  682. return true;
  683. }
  684. return false;
  685. }
  686. static void _sde_dbg_dump_bus_entry(struct sde_dbg_sde_debug_bus *bus,
  687. struct sde_debug_bus_entry *entries, u32 bus_size,
  688. void __iomem *mem_base, u32 *dump_addr, u32 enable_mask)
  689. {
  690. u32 status = 0;
  691. int i, j, k;
  692. bool in_mem, in_log, in_log_limited;
  693. struct sde_debug_bus_entry *entry;
  694. if (!bus->read_tp || !bus->clear_tp)
  695. return;
  696. in_mem = (enable_mask & SDE_DBG_DUMP_IN_MEM);
  697. in_log = (enable_mask & SDE_DBG_DUMP_IN_LOG);
  698. in_log_limited = (enable_mask & SDE_DBG_DUMP_IN_LOG_LIMITED);
  699. for (k = 0; k < bus_size; k++) {
  700. entry = entries + k;
  701. if (bus->disable_block)
  702. bus->disable_block(mem_base, entry->wr_addr);
  703. for (i = entry->block_id; i < (entry->block_id + entry->block_id_max); i++) {
  704. for (j = entry->test_id; j < (entry->test_id + entry->test_id_max); j++) {
  705. status = bus->read_tp(mem_base, entry->wr_addr,
  706. entry->rd_addr, i, j);
  707. if (!entry->analyzer && (in_log || (in_log_limited &&
  708. _is_dbg_bus_limited_valid(bus, entry->wr_addr, i, j))))
  709. SDE_DBG_LOG_ENTRY(0, entry->wr_addr, i, j, status);
  710. if (dump_addr && in_mem) {
  711. *dump_addr++ = entry->wr_addr;
  712. *dump_addr++ = i;
  713. *dump_addr++ = j;
  714. *dump_addr++ = status;
  715. }
  716. if (entry->analyzer)
  717. entry->analyzer(entry->wr_addr, i, j, status);
  718. }
  719. }
  720. /* Disable debug bus once we are done */
  721. bus->clear_tp(mem_base, entry->wr_addr);
  722. }
  723. }
  724. static void _sde_dbg_dump_sde_dbg_bus(struct sde_dbg_sde_debug_bus *bus, u32 enable_mask)
  725. {
  726. bool in_mem;
  727. u32 **dump_mem = NULL;
  728. u32 *dump_addr = NULL;
  729. int i, list_size = 0;
  730. void __iomem *mem_base = NULL;
  731. struct sde_dbg_reg_base *reg_base;
  732. struct sde_debug_bus_entry *entries;
  733. u32 bus_size;
  734. char name[20];
  735. reg_base = _sde_dump_get_blk_addr(bus->cmn.name);
  736. if (!reg_base || !reg_base->base) {
  737. pr_err("unable to find mem_base for %s\n", bus->cmn.name);
  738. return;
  739. }
  740. mem_base = reg_base->base;
  741. if (!strcmp(bus->cmn.name, DBGBUS_NAME_SDE))
  742. mem_base += bus->top_blk_off;
  743. if (!strcmp(bus->cmn.name, DBGBUS_NAME_VBIF_RT))
  744. _sde_dbg_dump_vbif_err_info(mem_base);
  745. entries = bus->entries;
  746. bus_size = bus->cmn.entries_size;
  747. dump_mem = &bus->cmn.dumped_content;
  748. if (!dump_mem || !entries || !bus_size)
  749. return;
  750. /* allocate memory for each test id */
  751. for (i = 0; i < bus_size; i++)
  752. list_size += (entries[i].block_id_max * entries[i].test_id_max);
  753. list_size *= sizeof(u32) * DUMP_CLMN_COUNT;
  754. snprintf(name, sizeof(name), "%s-debugbus", bus->cmn.name);
  755. SDE_DBG_LOG_MARKER(name, SDE_DBG_LOG_START);
  756. in_mem = (enable_mask & SDE_DBG_DUMP_IN_MEM);
  757. if (in_mem && (!(*dump_mem))) {
  758. *dump_mem = devm_kzalloc(sde_dbg_base.dev, list_size, GFP_KERNEL);
  759. bus->cmn.content_size = list_size / sizeof(u32);
  760. }
  761. dump_addr = *dump_mem;
  762. SDE_DBG_LOG_DUMP_ADDR(bus->cmn.name, dump_addr, list_size, 0);
  763. _sde_dbg_dump_bus_entry(bus, entries, bus_size, mem_base, dump_addr, enable_mask);
  764. SDE_DBG_LOG_MARKER(name, SDE_DBG_LOG_END);
  765. }
  766. static void _sde_dbg_dump_dsi_dbg_bus(struct sde_dbg_sde_debug_bus *bus, u32 enable_mask)
  767. {
  768. struct sde_dbg_dsi_ctrl_list_entry *ctl_entry;
  769. struct list_head *list;
  770. int list_size = 0;
  771. bool in_mem, i, dsi_count = 0;
  772. u32 **dump_mem = NULL;
  773. u32 *dump_addr = NULL;
  774. struct sde_debug_bus_entry *entries;
  775. u32 bus_size;
  776. char name[20];
  777. entries = bus->entries;
  778. bus_size = bus->cmn.entries_size;
  779. dump_mem = &bus->cmn.dumped_content;
  780. if (!dump_mem || !entries || !bus_size || list_empty(&sde_dbg_dsi_list))
  781. return;
  782. list_for_each(list, &sde_dbg_dsi_list)
  783. dsi_count++;
  784. for (i = 0; i < bus_size; i++)
  785. list_size += (entries[i].block_id_max * entries[i].test_id_max);
  786. list_size *= sizeof(u32) * DUMP_CLMN_COUNT * dsi_count;
  787. snprintf(name, sizeof(name), "%s-debugbus", bus->cmn.name);
  788. SDE_DBG_LOG_MARKER(name, SDE_DBG_LOG_START);
  789. mutex_lock(&sde_dbg_dsi_mutex);
  790. in_mem = (enable_mask & SDE_DBG_DUMP_IN_MEM);
  791. if (in_mem && (!(*dump_mem))) {
  792. *dump_mem = devm_kzalloc(sde_dbg_base.dev, list_size, GFP_KERNEL);
  793. bus->cmn.content_size = list_size / sizeof(u32);
  794. }
  795. dump_addr = *dump_mem;
  796. list_for_each_entry(ctl_entry, &sde_dbg_dsi_list, list) {
  797. SDE_DBG_LOG_DUMP_ADDR(ctl_entry->name, dump_addr, list_size / dsi_count, 0);
  798. _sde_dbg_dump_bus_entry(bus, entries, bus_size, ctl_entry->base,
  799. dump_addr, enable_mask);
  800. }
  801. mutex_unlock(&sde_dbg_dsi_mutex);
  802. SDE_DBG_LOG_MARKER(name, SDE_DBG_LOG_END);
  803. }
  804. /**
  805. * _sde_dump_array - dump array of register bases
  806. * @do_panic: whether to trigger a panic after dumping
  807. * @name: string indicating origin of dump
  808. * @dump_secure: flag to indicate dumping in secure-session
  809. * @dump_blk_mask: mask of all the hw blk-ids that has to be dumped
  810. */
  811. static void _sde_dump_array(bool do_panic, const char *name, bool dump_secure, u64 dump_blk_mask)
  812. {
  813. int rc;
  814. ktime_t start, end;
  815. struct sde_dbg_base *dbg_base = &sde_dbg_base;
  816. mutex_lock(&dbg_base->mutex);
  817. sde_evtlog_dump_all(dbg_base->evtlog);
  818. if (_sde_power_check(dbg_base->dump_mode)) {
  819. rc = pm_runtime_get_sync(dbg_base->dev);
  820. if (rc < 0) {
  821. pr_err("failed to enable power %d\n", rc);
  822. return;
  823. }
  824. }
  825. start = ktime_get();
  826. _sde_dump_reg_mask(dump_blk_mask, dump_secure);
  827. end = ktime_get();
  828. dev_info(dbg_base->dev,
  829. "reg-dump logging time start_us:%llu, end_us:%llu , duration_us:%llu\n",
  830. ktime_to_us(start), ktime_to_us(end), ktime_us_delta(end, start));
  831. start = ktime_get();
  832. if (dump_blk_mask & SDE_DBG_SDE_DBGBUS)
  833. _sde_dbg_dump_sde_dbg_bus(&dbg_base->dbgbus_sde, dbg_base->enable_dbgbus_dump);
  834. if (dump_blk_mask & SDE_DBG_LUTDMA_DBGBUS)
  835. _sde_dbg_dump_sde_dbg_bus(&dbg_base->dbgbus_lutdma, dbg_base->enable_dbgbus_dump);
  836. if (dump_blk_mask & SDE_DBG_RSC_DBGBUS)
  837. _sde_dbg_dump_sde_dbg_bus(&dbg_base->dbgbus_rsc, dbg_base->enable_dbgbus_dump);
  838. if (dump_blk_mask & SDE_DBG_VBIF_RT_DBGBUS)
  839. _sde_dbg_dump_sde_dbg_bus(&dbg_base->dbgbus_vbif_rt, dbg_base->enable_dbgbus_dump);
  840. if (dump_blk_mask & SDE_DBG_DSI_DBGBUS)
  841. _sde_dbg_dump_dsi_dbg_bus(&dbg_base->dbgbus_dsi, dbg_base->enable_dbgbus_dump);
  842. if (dump_blk_mask & SDE_DBG_DP_DBGBUS)
  843. _sde_dbg_dump_sde_dbg_bus(&dbg_base->dbgbus_dp, dbg_base->enable_dbgbus_dump);
  844. end = ktime_get();
  845. dev_info(dbg_base->dev,
  846. "debug-bus logging time start_us:%llu, end_us:%llu , duration_us:%llu\n",
  847. ktime_to_us(start), ktime_to_us(end), ktime_us_delta(end, start));
  848. if (_sde_power_check(dbg_base->dump_mode))
  849. pm_runtime_put_sync(dbg_base->dev);
  850. if (do_panic && dbg_base->panic_on_err)
  851. panic(name);
  852. mutex_unlock(&dbg_base->mutex);
  853. }
  854. /**
  855. * _sde_dump_work - deferred dump work function
  856. * @work: work structure
  857. */
  858. static void _sde_dump_work(struct work_struct *work)
  859. {
  860. _sde_dump_array(sde_dbg_base.work_panic, "evtlog_workitem",
  861. sde_dbg_base.dump_secure, sde_dbg_base.dump_blk_mask);
  862. }
  863. void sde_dbg_dump(enum sde_dbg_dump_context dump_mode, const char *name, u64 dump_blk_mask, ...)
  864. {
  865. int i = 0;
  866. bool do_panic = false;
  867. bool dump_secure = false;
  868. va_list args;
  869. char *str = NULL;
  870. if (!sde_evtlog_is_enabled(sde_dbg_base.evtlog, SDE_EVTLOG_ALWAYS))
  871. return;
  872. if ((dump_mode == SDE_DBG_DUMP_IRQ_CTX) && work_pending(&sde_dbg_base.dump_work))
  873. return;
  874. sde_dbg_base.dump_mode = dump_mode;
  875. va_start(args, dump_blk_mask);
  876. while ((str = va_arg(args, char*))) {
  877. if (i++ >= SDE_EVTLOG_MAX_DATA) {
  878. pr_err("could not parse all dump arguments\n");
  879. break;
  880. }
  881. if (!strcmp(str, "panic"))
  882. do_panic = true;
  883. else if (!strcmp(str, "secure"))
  884. dump_secure = true;
  885. }
  886. va_end(args);
  887. if (dump_mode == SDE_DBG_DUMP_IRQ_CTX) {
  888. /* schedule work to dump later */
  889. sde_dbg_base.work_panic = do_panic;
  890. sde_dbg_base.dump_blk_mask = dump_blk_mask;
  891. schedule_work(&sde_dbg_base.dump_work);
  892. } else {
  893. _sde_dump_array(do_panic, name, dump_secure, dump_blk_mask);
  894. }
  895. }
  896. void sde_dbg_ctrl(const char *name, ...)
  897. {
  898. int i = 0;
  899. va_list args;
  900. char *blk_name = NULL;
  901. /* no debugfs controlled events are enabled, just return */
  902. if (!sde_dbg_base.debugfs_ctrl)
  903. return;
  904. va_start(args, name);
  905. while ((blk_name = va_arg(args, char*))) {
  906. if (i++ >= SDE_EVTLOG_MAX_DATA) {
  907. pr_err("could not parse all dbg arguments\n");
  908. break;
  909. }
  910. if (IS_ERR_OR_NULL(blk_name))
  911. break;
  912. if (!strcmp(blk_name, "stop_ftrace") &&
  913. sde_dbg_base.debugfs_ctrl & DBG_CTRL_STOP_FTRACE) {
  914. pr_debug("tracing off\n");
  915. tracing_off();
  916. }
  917. if (!strcmp(blk_name, "panic_underrun") &&
  918. sde_dbg_base.debugfs_ctrl & DBG_CTRL_PANIC_UNDERRUN) {
  919. pr_err("panic underrun\n");
  920. SDE_DBG_DUMP_WQ(SDE_DBG_BUILT_IN_ALL, "panic");
  921. }
  922. if (!strcmp(blk_name, "reset_hw_panic") &&
  923. sde_dbg_base.debugfs_ctrl & DBG_CTRL_RESET_HW_PANIC) {
  924. pr_debug("reset hw panic\n");
  925. panic("reset_hw");
  926. }
  927. }
  928. va_end(args);
  929. }
  930. #ifdef CONFIG_DEBUG_FS
  931. /*
  932. * sde_dbg_debugfs_open - debugfs open handler for evtlog dump
  933. * @inode: debugfs inode
  934. * @file: file handle
  935. */
  936. static int sde_dbg_debugfs_open(struct inode *inode, struct file *file)
  937. {
  938. if (!inode || !file)
  939. return -EINVAL;
  940. /* non-seekable */
  941. file->f_mode &= ~(FMODE_LSEEK | FMODE_PREAD | FMODE_PWRITE);
  942. file->private_data = inode->i_private;
  943. mutex_lock(&sde_dbg_base.mutex);
  944. sde_dbg_base.cur_evt_index = 0;
  945. sde_dbg_base.evtlog->first = sde_dbg_base.evtlog->curr + 1;
  946. sde_dbg_base.evtlog->last =
  947. sde_dbg_base.evtlog->first + SDE_EVTLOG_ENTRY;
  948. mutex_unlock(&sde_dbg_base.mutex);
  949. return 0;
  950. }
  951. /*
  952. * sde_dbg_reg_base_open - debugfs open handler for reg base
  953. * @inode: debugfs inode
  954. * @file: file handle
  955. */
  956. static int sde_dbg_reg_base_open(struct inode *inode, struct file *file)
  957. {
  958. char base_name[64] = {0};
  959. struct sde_dbg_reg_base *reg_base = NULL;
  960. if (!inode || !file)
  961. return -EINVAL;
  962. snprintf(base_name, sizeof(base_name), "%s",
  963. file->f_path.dentry->d_iname);
  964. base_name[strlen(file->f_path.dentry->d_iname) - 4] = '\0';
  965. reg_base = _sde_dump_get_blk_addr(base_name);
  966. if (!reg_base) {
  967. pr_err("error: unable to locate base %s\n",
  968. base_name);
  969. return -EINVAL;
  970. }
  971. /* non-seekable */
  972. file->f_mode &= ~(FMODE_LSEEK | FMODE_PREAD | FMODE_PWRITE);
  973. file->private_data = reg_base;
  974. return 0;
  975. }
  976. /**
  977. * sde_evtlog_dump_read - debugfs read handler for evtlog dump
  978. * @file: file handler
  979. * @buff: user buffer content for debugfs
  980. * @count: size of user buffer
  981. * @ppos: position offset of user buffer
  982. */
  983. static ssize_t sde_evtlog_dump_read(struct file *file, char __user *buff,
  984. size_t count, loff_t *ppos)
  985. {
  986. ssize_t len = 0;
  987. char evtlog_buf[SDE_EVTLOG_BUF_MAX];
  988. if (!buff || !ppos)
  989. return -EINVAL;
  990. mutex_lock(&sde_dbg_base.mutex);
  991. len = sde_evtlog_dump_to_buffer(sde_dbg_base.evtlog,
  992. evtlog_buf, SDE_EVTLOG_BUF_MAX,
  993. !sde_dbg_base.cur_evt_index, true);
  994. sde_dbg_base.cur_evt_index++;
  995. mutex_unlock(&sde_dbg_base.mutex);
  996. if (len < 0 || len > count) {
  997. pr_err("len is more than user buffer size\n");
  998. return 0;
  999. }
  1000. if (copy_to_user(buff, evtlog_buf, len))
  1001. return -EFAULT;
  1002. *ppos += len;
  1003. return len;
  1004. }
  1005. /**
  1006. * sde_evtlog_dump_write - debugfs write handler for evtlog dump
  1007. * @file: file handler
  1008. * @user_buf: user buffer content from debugfs
  1009. * @count: size of user buffer
  1010. * @ppos: position offset of user buffer
  1011. */
  1012. static ssize_t sde_evtlog_dump_write(struct file *file,
  1013. const char __user *user_buf, size_t count, loff_t *ppos)
  1014. {
  1015. _sde_dump_array(sde_dbg_base.panic_on_err, "dump_debugfs", false,
  1016. sde_dbg_base.dump_blk_mask);
  1017. return count;
  1018. }
  1019. static const struct file_operations sde_evtlog_fops = {
  1020. .open = sde_dbg_debugfs_open,
  1021. .read = sde_evtlog_dump_read,
  1022. .write = sde_evtlog_dump_write,
  1023. };
  1024. /**
  1025. * sde_dbg_ctrl_read - debugfs read handler for debug ctrl read
  1026. * @file: file handler
  1027. * @buff: user buffer content for debugfs
  1028. * @count: size of user buffer
  1029. * @ppos: position offset of user buffer
  1030. */
  1031. static ssize_t sde_dbg_ctrl_read(struct file *file, char __user *buff,
  1032. size_t count, loff_t *ppos)
  1033. {
  1034. ssize_t len = 0;
  1035. char buf[24] = {'\0'};
  1036. if (!buff || !ppos)
  1037. return -EINVAL;
  1038. if (*ppos)
  1039. return 0; /* the end */
  1040. len = snprintf(buf, sizeof(buf), "0x%x\n", sde_dbg_base.debugfs_ctrl);
  1041. pr_debug("%s: ctrl:0x%x len:0x%zx\n",
  1042. __func__, sde_dbg_base.debugfs_ctrl, len);
  1043. if (len < 0 || len >= sizeof(buf))
  1044. return 0;
  1045. if ((count < sizeof(buf)) || copy_to_user(buff, buf, len)) {
  1046. pr_err("error copying the buffer! count:0x%zx\n", count);
  1047. return -EFAULT;
  1048. }
  1049. *ppos += len; /* increase offset */
  1050. return len;
  1051. }
  1052. /**
  1053. * sde_dbg_ctrl_write - debugfs read handler for debug ctrl write
  1054. * @file: file handler
  1055. * @user_buf: user buffer content from debugfs
  1056. * @count: size of user buffer
  1057. * @ppos: position offset of user buffer
  1058. */
  1059. static ssize_t sde_dbg_ctrl_write(struct file *file,
  1060. const char __user *user_buf, size_t count, loff_t *ppos)
  1061. {
  1062. u32 dbg_ctrl = 0;
  1063. char buf[24];
  1064. if (!file) {
  1065. pr_err("DbgDbg: %s: error no file --\n", __func__);
  1066. return -EINVAL;
  1067. }
  1068. if (count >= sizeof(buf))
  1069. return -EFAULT;
  1070. if (copy_from_user(buf, user_buf, count))
  1071. return -EFAULT;
  1072. buf[count] = 0; /* end of string */
  1073. if (kstrtouint(buf, 0, &dbg_ctrl)) {
  1074. pr_err("%s: error in the number of bytes\n", __func__);
  1075. return -EFAULT;
  1076. }
  1077. pr_debug("dbg_ctrl_read:0x%x\n", dbg_ctrl);
  1078. sde_dbg_base.debugfs_ctrl = dbg_ctrl;
  1079. return count;
  1080. }
  1081. static const struct file_operations sde_dbg_ctrl_fops = {
  1082. .open = sde_dbg_debugfs_open,
  1083. .read = sde_dbg_ctrl_read,
  1084. .write = sde_dbg_ctrl_write,
  1085. };
  1086. static int sde_recovery_regdump_open(struct inode *inode, struct file *file)
  1087. {
  1088. if (!inode || !file)
  1089. return -EINVAL;
  1090. /* non-seekable */
  1091. file->f_mode &= ~(FMODE_LSEEK | FMODE_PREAD | FMODE_PWRITE);
  1092. file->private_data = inode->i_private;
  1093. /* initialize to start position */
  1094. sde_dbg_base.regbuf.rpos = 0;
  1095. sde_dbg_base.regbuf.cur_blk = NULL;
  1096. sde_dbg_base.regbuf.dump_done = false;
  1097. return 0;
  1098. }
  1099. static ssize_t _sde_dbg_dump_reg_rows(u32 reg_start,
  1100. void *start, int count, char *buf, int buflen)
  1101. {
  1102. int i;
  1103. int len = 0;
  1104. u32 *addr;
  1105. u32 reg_offset = 0;
  1106. int rows = min(count / DUMP_CLMN_COUNT, DUMP_MAX_LINES_PER_BLK);
  1107. if (!start || !buf) {
  1108. pr_err("invalid address for dump\n");
  1109. return len;
  1110. }
  1111. if (buflen < PAGE_SIZE) {
  1112. pr_err("buffer too small for dump\n");
  1113. return len;
  1114. }
  1115. for (i = 0; i < rows; i++) {
  1116. addr = start + (i * DUMP_CLMN_COUNT * sizeof(u32));
  1117. reg_offset = reg_start + (i * DUMP_CLMN_COUNT * sizeof(u32));
  1118. if (buflen < (len + DUMP_LINE_SIZE))
  1119. break;
  1120. len += snprintf(buf + len, DUMP_LINE_SIZE,
  1121. "0x%.8X | %.8X %.8X %.8X %.8X\n",
  1122. reg_offset, addr[0], addr[1], addr[2], addr[3]);
  1123. }
  1124. return len;
  1125. }
  1126. static int _sde_dbg_recovery_dump_sub_blk(struct sde_dbg_reg_range *sub_blk,
  1127. char *buf, int buflen)
  1128. {
  1129. int count = 0;
  1130. int len = 0;
  1131. if (!sub_blk || (buflen < PAGE_SIZE)) {
  1132. pr_err("invalid params buflen:%d subblk valid:%d\n",
  1133. buflen, sub_blk != NULL);
  1134. return len;
  1135. }
  1136. count = (sub_blk->offset.end - sub_blk->offset.start) / (sizeof(u32));
  1137. if (count < DUMP_CLMN_COUNT) {
  1138. pr_err("invalid count for register dumps :%d\n", count);
  1139. return len;
  1140. }
  1141. len += snprintf(buf + len, DUMP_LINE_SIZE,
  1142. "------------------------------------------\n");
  1143. len += snprintf(buf + len, DUMP_LINE_SIZE,
  1144. "**** sub block [%s] - size:%d ****\n",
  1145. sub_blk->range_name, count);
  1146. len += _sde_dbg_dump_reg_rows(sub_blk->offset.start, sub_blk->reg_dump,
  1147. count, buf + len, buflen - len);
  1148. return len;
  1149. }
  1150. static int _sde_dbg_recovery_dump_reg_blk(struct sde_dbg_reg_base *blk,
  1151. char *buf, int buf_size, int *out_len)
  1152. {
  1153. int ret = 0;
  1154. int len = 0;
  1155. struct sde_dbg_reg_range *sub_blk;
  1156. if (buf_size < PAGE_SIZE) {
  1157. pr_err("buffer too small for dump\n");
  1158. return len;
  1159. }
  1160. if (!blk || !strlen(blk->name)) {
  1161. len += snprintf(buf + len, DUMP_LINE_SIZE,
  1162. "Found one invalid block - skip dump\n");
  1163. *out_len = len;
  1164. return len;
  1165. }
  1166. len += snprintf(buf + len, DUMP_LINE_SIZE,
  1167. "******************************************\n");
  1168. len += snprintf(buf + len, DUMP_LINE_SIZE,
  1169. "==========================================\n");
  1170. len += snprintf(buf + len, DUMP_LINE_SIZE,
  1171. "*********** DUMP of %s block *************\n",
  1172. blk->name);
  1173. len += snprintf(buf + len, DUMP_LINE_SIZE,
  1174. "count:%ld max-off:0x%lx has_sub_blk:%d\n",
  1175. blk->cnt, blk->max_offset,
  1176. !list_empty(&blk->sub_range_list));
  1177. if (list_empty(&blk->sub_range_list)) {
  1178. len += _sde_dbg_dump_reg_rows(0, blk->reg_dump,
  1179. blk->max_offset / sizeof(u32), buf + len,
  1180. buf_size - len);
  1181. } else {
  1182. list_for_each_entry(sub_blk, &blk->sub_range_list, head)
  1183. len += _sde_dbg_recovery_dump_sub_blk(sub_blk,
  1184. buf + len, buf_size - len);
  1185. }
  1186. *out_len = len;
  1187. return ret;
  1188. }
  1189. static ssize_t sde_recovery_regdump_read(struct file *file, char __user *ubuf,
  1190. size_t count, loff_t *ppos)
  1191. {
  1192. ssize_t len = 0;
  1193. int usize = 0;
  1194. struct sde_dbg_base *dbg_base = &sde_dbg_base;
  1195. struct sde_dbg_regbuf *rbuf = &dbg_base->regbuf;
  1196. mutex_lock(&sde_dbg_base.mutex);
  1197. if (!sde_dbg_base.hw_ownership) {
  1198. pr_debug("op not supported due to HW unavailablity\n");
  1199. len = -EOPNOTSUPP;
  1200. goto err;
  1201. }
  1202. if (!rbuf->dump_done && !rbuf->cur_blk) {
  1203. if (!rbuf->buf)
  1204. rbuf->buf = kzalloc(DUMP_BUF_SIZE, GFP_KERNEL);
  1205. if (!rbuf->buf) {
  1206. len = -ENOMEM;
  1207. goto err;
  1208. }
  1209. rbuf->rpos = 0;
  1210. rbuf->len = 0;
  1211. rbuf->buf_size = DUMP_BUF_SIZE;
  1212. rbuf->cur_blk = list_first_entry(&dbg_base->reg_base_list,
  1213. struct sde_dbg_reg_base, reg_base_head);
  1214. if (rbuf->cur_blk)
  1215. _sde_dbg_recovery_dump_reg_blk(rbuf->cur_blk,
  1216. rbuf->buf,
  1217. rbuf->buf_size,
  1218. &rbuf->len);
  1219. pr_debug("dumping done for blk:%s len:%d\n", rbuf->cur_blk ?
  1220. rbuf->cur_blk->name : "unknown", rbuf->len);
  1221. } else if (rbuf->len == rbuf->rpos && rbuf->cur_blk) {
  1222. rbuf->rpos = 0;
  1223. rbuf->len = 0;
  1224. rbuf->buf_size = DUMP_BUF_SIZE;
  1225. if (rbuf->cur_blk == list_last_entry(&dbg_base->reg_base_list,
  1226. struct sde_dbg_reg_base, reg_base_head))
  1227. rbuf->cur_blk = NULL;
  1228. else
  1229. rbuf->cur_blk = list_next_entry(rbuf->cur_blk,
  1230. reg_base_head);
  1231. if (rbuf->cur_blk)
  1232. _sde_dbg_recovery_dump_reg_blk(rbuf->cur_blk,
  1233. rbuf->buf,
  1234. rbuf->buf_size,
  1235. &rbuf->len);
  1236. pr_debug("dumping done for blk:%s len:%d\n", rbuf->cur_blk ?
  1237. rbuf->cur_blk->name : "unknown", rbuf->len);
  1238. }
  1239. if ((rbuf->len - rbuf->rpos) > 0) {
  1240. usize = ((rbuf->len - rbuf->rpos) > count) ?
  1241. count : rbuf->len - rbuf->rpos;
  1242. if (copy_to_user(ubuf, rbuf->buf + rbuf->rpos, usize)) {
  1243. len = -EFAULT;
  1244. goto err;
  1245. }
  1246. len = usize;
  1247. rbuf->rpos += usize;
  1248. *ppos += usize;
  1249. }
  1250. if (!len && rbuf->buf)
  1251. rbuf->dump_done = true;
  1252. err:
  1253. mutex_unlock(&sde_dbg_base.mutex);
  1254. return len;
  1255. }
  1256. static const struct file_operations sde_recovery_reg_fops = {
  1257. .open = sde_recovery_regdump_open,
  1258. .read = sde_recovery_regdump_read,
  1259. };
  1260. static ssize_t sde_recovery_dbgbus_dump_read(struct file *file,
  1261. char __user *buff,
  1262. size_t count, loff_t *ppos)
  1263. {
  1264. ssize_t len = 0;
  1265. char log_buf[SDE_EVTLOG_BUF_MAX];
  1266. u32 *data;
  1267. struct sde_dbg_debug_bus_common *cmn = file->private_data;
  1268. u32 entry_size = DUMP_CLMN_COUNT;
  1269. u32 max_size = min_t(size_t, count, SDE_EVTLOG_BUF_MAX);
  1270. memset(log_buf, 0, sizeof(log_buf));
  1271. mutex_lock(&sde_dbg_base.mutex);
  1272. if (!sde_dbg_base.hw_ownership) {
  1273. pr_debug("op not supported due to HW unavailablity\n");
  1274. len = -EOPNOTSUPP;
  1275. goto dump_done;
  1276. }
  1277. if (!cmn->dumped_content || !cmn->entries_size)
  1278. goto dump_done;
  1279. if (cmn->content_idx < cmn->content_size) {
  1280. data = &cmn->dumped_content[cmn->content_idx];
  1281. len = scnprintf(log_buf, max_size,
  1282. "0x%.8lX | %.8X %.8X %.8X %.8X\n",
  1283. cmn->content_idx * sizeof(*data),
  1284. data[0], data[1], data[2], data[3]);
  1285. cmn->content_idx += entry_size;
  1286. if (copy_to_user(buff, log_buf, len)) {
  1287. len = -EFAULT;
  1288. goto dump_done;
  1289. }
  1290. *ppos += len;
  1291. }
  1292. dump_done:
  1293. mutex_unlock(&sde_dbg_base.mutex);
  1294. return len;
  1295. }
  1296. static int sde_recovery_dbgbus_dump_open(struct inode *inode, struct file *file)
  1297. {
  1298. if (!inode || !file)
  1299. return -EINVAL;
  1300. /* non-seekable */
  1301. file->f_mode &= ~(FMODE_LSEEK | FMODE_PREAD | FMODE_PWRITE);
  1302. file->private_data = (void *)&sde_dbg_base.dbgbus_sde.cmn;
  1303. mutex_lock(&sde_dbg_base.mutex);
  1304. sde_dbg_base.dbgbus_sde.cmn.content_idx = 0;
  1305. mutex_unlock(&sde_dbg_base.mutex);
  1306. return 0;
  1307. }
  1308. static const struct file_operations sde_recovery_dbgbus_fops = {
  1309. .open = sde_recovery_dbgbus_dump_open,
  1310. .read = sde_recovery_dbgbus_dump_read,
  1311. };
  1312. static int sde_recovery_vbif_dbgbus_dump_open(struct inode *inode,
  1313. struct file *file)
  1314. {
  1315. if (!inode || !file)
  1316. return -EINVAL;
  1317. /* non-seekable */
  1318. file->f_mode &= ~(FMODE_LSEEK | FMODE_PREAD | FMODE_PWRITE);
  1319. file->private_data = (void *)&sde_dbg_base.dbgbus_vbif_rt.cmn;
  1320. mutex_lock(&sde_dbg_base.mutex);
  1321. sde_dbg_base.dbgbus_vbif_rt.cmn.content_idx = 0;
  1322. mutex_unlock(&sde_dbg_base.mutex);
  1323. return 0;
  1324. }
  1325. static const struct file_operations sde_recovery_vbif_dbgbus_fops = {
  1326. .open = sde_recovery_vbif_dbgbus_dump_open,
  1327. .read = sde_recovery_dbgbus_dump_read,
  1328. };
  1329. static int sde_recovery_dsi_dbgbus_dump_open(struct inode *inode,
  1330. struct file *file)
  1331. {
  1332. if (!inode || !file)
  1333. return -EINVAL;
  1334. /* non-seekable */
  1335. file->f_mode &= ~(FMODE_LSEEK | FMODE_PREAD | FMODE_PWRITE);
  1336. file->private_data = (void *)&sde_dbg_base.dbgbus_dsi.cmn;
  1337. mutex_lock(&sde_dbg_base.mutex);
  1338. sde_dbg_base.dbgbus_dsi.cmn.content_idx = 0;
  1339. mutex_unlock(&sde_dbg_base.mutex);
  1340. return 0;
  1341. }
  1342. static const struct file_operations sde_recovery_dsi_dbgbus_fops = {
  1343. .open = sde_recovery_dsi_dbgbus_dump_open,
  1344. .read = sde_recovery_dbgbus_dump_read,
  1345. };
  1346. static int sde_recovery_rsc_dbgbus_dump_open(struct inode *inode,
  1347. struct file *file)
  1348. {
  1349. if (!inode || !file)
  1350. return -EINVAL;
  1351. /* non-seekable */
  1352. file->f_mode &= ~(FMODE_LSEEK | FMODE_PREAD | FMODE_PWRITE);
  1353. file->private_data = (void *)&sde_dbg_base.dbgbus_rsc.cmn;
  1354. mutex_lock(&sde_dbg_base.mutex);
  1355. sde_dbg_base.dbgbus_rsc.cmn.content_idx = 0;
  1356. mutex_unlock(&sde_dbg_base.mutex);
  1357. return 0;
  1358. }
  1359. static const struct file_operations sde_recovery_rsc_dbgbus_fops = {
  1360. .open = sde_recovery_rsc_dbgbus_dump_open,
  1361. .read = sde_recovery_dbgbus_dump_read,
  1362. };
  1363. static int sde_recovery_lutdma_dbgbus_dump_open(struct inode *inode,
  1364. struct file *file)
  1365. {
  1366. if (!inode || !file)
  1367. return -EINVAL;
  1368. /* non-seekable */
  1369. file->f_mode &= ~(FMODE_LSEEK | FMODE_PREAD | FMODE_PWRITE);
  1370. file->private_data = (void *)&sde_dbg_base.dbgbus_lutdma.cmn;
  1371. mutex_lock(&sde_dbg_base.mutex);
  1372. sde_dbg_base.dbgbus_lutdma.cmn.content_idx = 0;
  1373. mutex_unlock(&sde_dbg_base.mutex);
  1374. return 0;
  1375. }
  1376. static const struct file_operations sde_recovery_lutdma_dbgbus_fops = {
  1377. .open = sde_recovery_lutdma_dbgbus_dump_open,
  1378. .read = sde_recovery_dbgbus_dump_read,
  1379. };
  1380. static int sde_recovery_dp_dbgbus_dump_open(struct inode *inode,
  1381. struct file *file)
  1382. {
  1383. if (!inode || !file)
  1384. return -EINVAL;
  1385. /* non-seekable */
  1386. file->f_mode &= ~(FMODE_LSEEK | FMODE_PREAD | FMODE_PWRITE);
  1387. file->private_data = (void *)&sde_dbg_base.dbgbus_dp.cmn;
  1388. mutex_lock(&sde_dbg_base.mutex);
  1389. sde_dbg_base.dbgbus_dp.cmn.content_idx = 0;
  1390. mutex_unlock(&sde_dbg_base.mutex);
  1391. return 0;
  1392. }
  1393. static const struct file_operations sde_recovery_dp_dbgbus_fops = {
  1394. .open = sde_recovery_dp_dbgbus_dump_open,
  1395. .read = sde_recovery_dbgbus_dump_read,
  1396. };
  1397. /**
  1398. * sde_dbg_reg_base_release - release allocated reg dump file private data
  1399. * @inode: debugfs inode
  1400. * @file: file handle
  1401. * @Return: 0 on success
  1402. */
  1403. static int sde_dbg_reg_base_release(struct inode *inode, struct file *file)
  1404. {
  1405. struct sde_dbg_reg_base *dbg;
  1406. if (!file)
  1407. return -EINVAL;
  1408. dbg = file->private_data;
  1409. if (!dbg)
  1410. return -ENODEV;
  1411. mutex_lock(&sde_dbg_base.mutex);
  1412. if (dbg && dbg->buf) {
  1413. kfree(dbg->buf);
  1414. dbg->buf_len = 0;
  1415. dbg->buf = NULL;
  1416. }
  1417. mutex_unlock(&sde_dbg_base.mutex);
  1418. return 0;
  1419. }
  1420. /**
  1421. * sde_dbg_reg_base_is_valid_range - verify if requested memory range is valid
  1422. * @off: address offset in bytes
  1423. * @cnt: memory size in bytes
  1424. * Return: true if valid; false otherwise
  1425. */
  1426. static bool sde_dbg_reg_base_is_valid_range(
  1427. struct sde_dbg_reg_base *base,
  1428. u32 off, u32 cnt)
  1429. {
  1430. struct sde_dbg_reg_range *node;
  1431. pr_debug("check offset=0x%x cnt=0x%x\n", off, cnt);
  1432. list_for_each_entry(node, &base->sub_range_list, head) {
  1433. pr_debug("%s: start=0x%x end=0x%x\n", node->range_name,
  1434. node->offset.start, node->offset.end);
  1435. if (node->offset.start <= off
  1436. && off <= node->offset.end
  1437. && off + cnt <= node->offset.end) {
  1438. pr_debug("valid range requested\n");
  1439. return true;
  1440. }
  1441. }
  1442. pr_err("invalid range requested\n");
  1443. return false;
  1444. }
  1445. /**
  1446. * sde_dbg_reg_base_offset_write - set new offset and len to debugfs reg base
  1447. * @file: file handler
  1448. * @user_buf: user buffer content from debugfs
  1449. * @count: size of user buffer
  1450. * @ppos: position offset of user buffer
  1451. */
  1452. static ssize_t sde_dbg_reg_base_offset_write(struct file *file,
  1453. const char __user *user_buf, size_t count, loff_t *ppos)
  1454. {
  1455. struct sde_dbg_reg_base *dbg;
  1456. u32 off = 0;
  1457. u32 cnt = DEFAULT_BASE_REG_CNT;
  1458. char buf[24];
  1459. int rc;
  1460. if (!file)
  1461. return -EINVAL;
  1462. dbg = file->private_data;
  1463. if (!dbg)
  1464. return -ENODEV;
  1465. if (count >= sizeof(buf))
  1466. return -EFAULT;
  1467. if (copy_from_user(buf, user_buf, count))
  1468. return -EFAULT;
  1469. buf[count] = 0; /* end of string */
  1470. if (sscanf(buf, "%5x %x", &off, &cnt) != 2)
  1471. return -EFAULT;
  1472. if (off > dbg->max_offset)
  1473. return -EINVAL;
  1474. if (off % sizeof(u32))
  1475. return -EINVAL;
  1476. if (cnt > (dbg->max_offset - off))
  1477. cnt = dbg->max_offset - off;
  1478. if (cnt == 0)
  1479. return -EINVAL;
  1480. if (!list_empty(&dbg->sub_range_list)) {
  1481. rc = sde_dbg_reg_base_is_valid_range(dbg, off, cnt);
  1482. if (!rc)
  1483. return -EINVAL;
  1484. }
  1485. mutex_lock(&sde_dbg_base.mutex);
  1486. dbg->off = off;
  1487. dbg->cnt = cnt;
  1488. mutex_unlock(&sde_dbg_base.mutex);
  1489. pr_debug("offset=%x cnt=%x\n", off, cnt);
  1490. return count;
  1491. }
  1492. /**
  1493. * sde_dbg_reg_base_offset_read - read current offset and len of register base
  1494. * @file: file handler
  1495. * @user_buf: user buffer content from debugfs
  1496. * @count: size of user buffer
  1497. * @ppos: position offset of user buffer
  1498. */
  1499. static ssize_t sde_dbg_reg_base_offset_read(struct file *file,
  1500. char __user *buff, size_t count, loff_t *ppos)
  1501. {
  1502. struct sde_dbg_reg_base *dbg;
  1503. int len = 0;
  1504. char buf[24] = {'\0'};
  1505. if (!file)
  1506. return -EINVAL;
  1507. dbg = file->private_data;
  1508. if (!dbg)
  1509. return -ENODEV;
  1510. if (!ppos)
  1511. return -EINVAL;
  1512. if (*ppos)
  1513. return 0; /* the end */
  1514. mutex_lock(&sde_dbg_base.mutex);
  1515. if (dbg->off % sizeof(u32)) {
  1516. mutex_unlock(&sde_dbg_base.mutex);
  1517. return -EFAULT;
  1518. }
  1519. len = snprintf(buf, sizeof(buf), "0x%08zx %zx\n", dbg->off, dbg->cnt);
  1520. if (len < 0 || len >= sizeof(buf)) {
  1521. mutex_unlock(&sde_dbg_base.mutex);
  1522. return 0;
  1523. }
  1524. if ((count < sizeof(buf)) || copy_to_user(buff, buf, len)) {
  1525. mutex_unlock(&sde_dbg_base.mutex);
  1526. return -EFAULT;
  1527. }
  1528. *ppos += len; /* increase offset */
  1529. mutex_unlock(&sde_dbg_base.mutex);
  1530. return len;
  1531. }
  1532. #ifdef CONFIG_DYNAMIC_DEBUG
  1533. /**
  1534. * sde_dbg_reg_base_reg_write - write to reg base hw at offset a given value
  1535. * @file: file handler
  1536. * @user_buf: user buffer content from debugfs
  1537. * @count: size of user buffer
  1538. * @ppos: position offset of user buffer
  1539. */
  1540. static ssize_t sde_dbg_reg_base_reg_write(struct file *file,
  1541. const char __user *user_buf, size_t count, loff_t *ppos)
  1542. {
  1543. struct sde_dbg_reg_base *dbg;
  1544. size_t off;
  1545. u32 data, cnt;
  1546. char buf[24];
  1547. int rc;
  1548. if (!file)
  1549. return -EINVAL;
  1550. dbg = file->private_data;
  1551. if (!dbg)
  1552. return -ENODEV;
  1553. if (count >= sizeof(buf))
  1554. return -EFAULT;
  1555. if (copy_from_user(buf, user_buf, count))
  1556. return -EFAULT;
  1557. buf[count] = 0; /* end of string */
  1558. cnt = sscanf(buf, "%zx %x", &off, &data);
  1559. if (cnt < 2)
  1560. return -EFAULT;
  1561. if (off % sizeof(u32))
  1562. return -EFAULT;
  1563. mutex_lock(&sde_dbg_base.mutex);
  1564. if (!sde_dbg_base.hw_ownership) {
  1565. pr_debug("op not supported due to hw unavailablity\n");
  1566. count = -EOPNOTSUPP;
  1567. goto end;
  1568. }
  1569. if (off >= dbg->max_offset) {
  1570. count = -EFAULT;
  1571. goto end;
  1572. }
  1573. if (!list_empty(&dbg->sub_range_list)) {
  1574. rc = sde_dbg_reg_base_is_valid_range(dbg, off, cnt);
  1575. if (!rc) {
  1576. count = -EINVAL;
  1577. goto end;
  1578. }
  1579. }
  1580. rc = pm_runtime_get_sync(sde_dbg_base.dev);
  1581. if (rc < 0) {
  1582. pr_err("failed to enable power %d\n", rc);
  1583. count = rc;
  1584. goto end;
  1585. }
  1586. writel_relaxed(data, dbg->base + off);
  1587. pm_runtime_put_sync(sde_dbg_base.dev);
  1588. pr_debug("addr=%zx data=%x\n", off, data);
  1589. end:
  1590. mutex_unlock(&sde_dbg_base.mutex);
  1591. return count;
  1592. }
  1593. #endif
  1594. /**
  1595. * sde_dbg_reg_base_reg_read - read len from reg base hw at current offset
  1596. * @file: file handler
  1597. * @user_buf: user buffer content from debugfs
  1598. * @count: size of user buffer
  1599. * @ppos: position offset of user buffer
  1600. */
  1601. static ssize_t sde_dbg_reg_base_reg_read(struct file *file,
  1602. char __user *user_buf, size_t count, loff_t *ppos)
  1603. {
  1604. struct sde_dbg_reg_base *dbg;
  1605. size_t len;
  1606. int rc;
  1607. if (!file)
  1608. return -EINVAL;
  1609. dbg = file->private_data;
  1610. if (!dbg) {
  1611. pr_err("invalid handle\n");
  1612. return -ENODEV;
  1613. }
  1614. if (!ppos)
  1615. return -EINVAL;
  1616. mutex_lock(&sde_dbg_base.mutex);
  1617. if (!sde_dbg_base.hw_ownership) {
  1618. pr_debug("op not supported due to hw unavailablity\n");
  1619. len = -EOPNOTSUPP;
  1620. goto end;
  1621. }
  1622. if (!dbg->buf) {
  1623. char dump_buf[64];
  1624. char *ptr;
  1625. int cnt, tot;
  1626. dbg->buf_len = sizeof(dump_buf) *
  1627. DIV_ROUND_UP(dbg->cnt, ROW_BYTES);
  1628. dbg->buf = kzalloc(dbg->buf_len, GFP_KERNEL);
  1629. if (!dbg->buf) {
  1630. len = -ENOMEM;
  1631. goto end;
  1632. }
  1633. if (dbg->off % sizeof(u32)) {
  1634. len = -EFAULT;
  1635. goto end;
  1636. }
  1637. ptr = dbg->base + dbg->off;
  1638. tot = 0;
  1639. rc = pm_runtime_get_sync(sde_dbg_base.dev);
  1640. if (rc < 0) {
  1641. pr_err("failed to enable power %d\n", rc);
  1642. len = rc;
  1643. goto end;
  1644. }
  1645. for (cnt = dbg->cnt; cnt > 0; cnt -= ROW_BYTES) {
  1646. hex_dump_to_buffer(ptr, min(cnt, ROW_BYTES),
  1647. ROW_BYTES, GROUP_BYTES, dump_buf,
  1648. sizeof(dump_buf), false);
  1649. len = scnprintf(dbg->buf + tot, dbg->buf_len - tot,
  1650. "0x%08x: %s\n",
  1651. ((int) (unsigned long) ptr) -
  1652. ((int) (unsigned long) dbg->base),
  1653. dump_buf);
  1654. ptr += ROW_BYTES;
  1655. tot += len;
  1656. if (tot >= dbg->buf_len)
  1657. break;
  1658. }
  1659. pm_runtime_put_sync(sde_dbg_base.dev);
  1660. dbg->buf_len = tot;
  1661. }
  1662. if (*ppos >= dbg->buf_len) {
  1663. len = 0; /* done reading */
  1664. goto end;
  1665. }
  1666. len = min(count, dbg->buf_len - (size_t) *ppos);
  1667. if (copy_to_user(user_buf, dbg->buf + *ppos, len)) {
  1668. pr_err("failed to copy to user\n");
  1669. len = -EFAULT;
  1670. goto end;
  1671. }
  1672. *ppos += len; /* increase offset */
  1673. end:
  1674. mutex_unlock(&sde_dbg_base.mutex);
  1675. return len;
  1676. }
  1677. static const struct file_operations sde_off_fops = {
  1678. .open = sde_dbg_reg_base_open,
  1679. .release = sde_dbg_reg_base_release,
  1680. .read = sde_dbg_reg_base_offset_read,
  1681. .write = sde_dbg_reg_base_offset_write,
  1682. };
  1683. static const struct file_operations sde_reg_fops = {
  1684. .open = sde_dbg_reg_base_open,
  1685. .release = sde_dbg_reg_base_release,
  1686. .read = sde_dbg_reg_base_reg_read,
  1687. #ifdef CONFIG_DYNAMIC_DEBUG
  1688. .write = sde_dbg_reg_base_reg_write,
  1689. #endif
  1690. };
  1691. int sde_dbg_debugfs_register(struct device *dev)
  1692. {
  1693. static struct sde_dbg_base *dbg = &sde_dbg_base;
  1694. struct sde_dbg_reg_base *blk_base;
  1695. char debug_name[80] = "";
  1696. struct dentry *debugfs_root = NULL;
  1697. struct platform_device *pdev = to_platform_device(dev);
  1698. struct drm_device *ddev = platform_get_drvdata(pdev);
  1699. struct msm_drm_private *priv = NULL;
  1700. if (!ddev || !ddev->dev_private) {
  1701. pr_err("Invalid drm device node\n");
  1702. return -EINVAL;
  1703. }
  1704. priv = ddev->dev_private;
  1705. debugfs_root = debugfs_create_dir("debug", ddev->primary->debugfs_root);
  1706. if (IS_ERR_OR_NULL(debugfs_root)) {
  1707. pr_err("debugfs_root create_dir fail, error %ld\n", PTR_ERR(debugfs_root));
  1708. priv->debug_root = NULL;
  1709. return -EINVAL;
  1710. }
  1711. priv->debug_root = debugfs_root;
  1712. debugfs_create_file("dbg_ctrl", 0600, debugfs_root, NULL, &sde_dbg_ctrl_fops);
  1713. debugfs_create_file("dump", 0600, debugfs_root, NULL, &sde_evtlog_fops);
  1714. debugfs_create_file("recovery_reg", 0400, debugfs_root, NULL, &sde_recovery_reg_fops);
  1715. debugfs_create_u32("enable", 0600, debugfs_root, &(sde_dbg_base.evtlog->enable));
  1716. debugfs_create_u32("panic", 0600, debugfs_root, &sde_dbg_base.panic_on_err);
  1717. debugfs_create_u32("reg_dump", 0600, debugfs_root, &sde_dbg_base.enable_reg_dump);
  1718. debugfs_create_u32("dbgbus_dump", 0600, debugfs_root, &sde_dbg_base.enable_dbgbus_dump);
  1719. debugfs_create_u64("reg_dump_blk_mask", 0600, debugfs_root, &sde_dbg_base.dump_blk_mask);
  1720. if (dbg->dbgbus_sde.entries)
  1721. debugfs_create_file("recovery_dbgbus", 0400, debugfs_root, NULL,
  1722. &sde_recovery_dbgbus_fops);
  1723. if (dbg->dbgbus_vbif_rt.entries)
  1724. debugfs_create_file("recovery_vbif_dbgbus", 0400, debugfs_root,
  1725. NULL, &sde_recovery_vbif_dbgbus_fops);
  1726. if (dbg->dbgbus_dsi.entries)
  1727. debugfs_create_file("recovery_dsi_dbgbus", 0400, debugfs_root,
  1728. NULL, &sde_recovery_dsi_dbgbus_fops);
  1729. if (dbg->dbgbus_rsc.entries)
  1730. debugfs_create_file("recovery_rsc_dbgbus", 0400, debugfs_root,
  1731. NULL, &sde_recovery_rsc_dbgbus_fops);
  1732. if (dbg->dbgbus_lutdma.entries)
  1733. debugfs_create_file("recovery_lutdma_dbgbus", 0400, debugfs_root,
  1734. NULL, &sde_recovery_lutdma_dbgbus_fops);
  1735. if (dbg->dbgbus_dp.entries)
  1736. debugfs_create_file("recovery_dp_dbgbus", 0400, debugfs_root,
  1737. NULL, &sde_recovery_dp_dbgbus_fops);
  1738. list_for_each_entry(blk_base, &dbg->reg_base_list, reg_base_head) {
  1739. snprintf(debug_name, sizeof(debug_name), "%s_off", blk_base->name);
  1740. debugfs_create_file(debug_name, 0600, debugfs_root, blk_base, &sde_off_fops);
  1741. snprintf(debug_name, sizeof(debug_name), "%s_reg", blk_base->name);
  1742. debugfs_create_file(debug_name, 0400, debugfs_root, blk_base, &sde_reg_fops);
  1743. }
  1744. return 0;
  1745. }
  1746. #else
  1747. int sde_dbg_debugfs_register(struct device *dev)
  1748. {
  1749. return 0;
  1750. }
  1751. #endif
  1752. static void _sde_dbg_debugfs_destroy(void)
  1753. {
  1754. }
  1755. void sde_dbg_init_dbg_buses(u32 hwversion)
  1756. {
  1757. static struct sde_dbg_base *dbg = &sde_dbg_base;
  1758. memset(&dbg->dbgbus_sde, 0, sizeof(dbg->dbgbus_sde));
  1759. memset(&dbg->dbgbus_vbif_rt, 0, sizeof(dbg->dbgbus_vbif_rt));
  1760. memset(&dbg->dbgbus_dsi, 0, sizeof(dbg->dbgbus_dsi));
  1761. memset(&dbg->dbgbus_rsc, 0, sizeof(dbg->dbgbus_rsc));
  1762. memset(&dbg->dbgbus_dp, 0, sizeof(dbg->dbgbus_dp));
  1763. dbg->dbgbus_sde.entries = dbg_bus_sde;
  1764. dbg->dbgbus_sde.cmn.entries_size = ARRAY_SIZE(dbg_bus_sde);
  1765. dbg->dbgbus_sde.limited_entries = dbg_bus_sde_limited;
  1766. dbg->dbgbus_sde.cmn.limited_entries_size = ARRAY_SIZE(dbg_bus_sde_limited);
  1767. dbg->dbgbus_sde.cmn.name = DBGBUS_NAME_SDE;
  1768. dbg->dbgbus_sde.cmn.blk_id = SDE_DBG_SDE_DBGBUS;
  1769. dbg->dbgbus_sde.read_tp = _sde_dbg_sde_read_test_point;
  1770. dbg->dbgbus_sde.clear_tp = _sde_dbg_sde_clear_test_point;
  1771. dbg->dbgbus_vbif_rt.entries = vbif_dbg_bus;
  1772. dbg->dbgbus_vbif_rt.cmn.entries_size = ARRAY_SIZE(vbif_dbg_bus);
  1773. dbg->dbgbus_vbif_rt.limited_entries = vbif_dbg_bus_limited;
  1774. dbg->dbgbus_vbif_rt.cmn.limited_entries_size = ARRAY_SIZE(vbif_dbg_bus_limited);
  1775. dbg->dbgbus_vbif_rt.cmn.name = DBGBUS_NAME_VBIF_RT;
  1776. dbg->dbgbus_vbif_rt.cmn.blk_id = SDE_DBG_VBIF_RT_DBGBUS;
  1777. dbg->dbgbus_vbif_rt.read_tp = _sde_dbg_vbif_read_test_point;
  1778. dbg->dbgbus_vbif_rt.clear_tp = _sde_dbg_vbif_clear_test_point;
  1779. dbg->dbgbus_vbif_rt.disable_block = _sde_dbg_vbif_disable_block;
  1780. dbg->dbgbus_dsi.entries = dsi_dbg_bus;
  1781. dbg->dbgbus_dsi.cmn.entries_size = ARRAY_SIZE(dsi_dbg_bus);
  1782. dbg->dbgbus_dsi.cmn.name = DBGBUS_NAME_DSI;
  1783. dbg->dbgbus_dsi.cmn.blk_id = SDE_DBG_DSI_DBGBUS;
  1784. dbg->dbgbus_dsi.read_tp = _sde_dbg_dsi_read_test_point;
  1785. dbg->dbgbus_dsi.clear_tp = _sde_dbg_cmn_clear_test_point;
  1786. dbg->dbgbus_rsc.entries = rsc_dbg_bus;
  1787. dbg->dbgbus_rsc.cmn.entries_size = ARRAY_SIZE(rsc_dbg_bus);
  1788. dbg->dbgbus_rsc.cmn.name = DBGBUS_NAME_RSC;
  1789. dbg->dbgbus_rsc.cmn.blk_id = SDE_DBG_RSC_DBGBUS;
  1790. dbg->dbgbus_rsc.read_tp = _sde_dbg_rsc_read_test_point;
  1791. dbg->dbgbus_rsc.clear_tp = _sde_dbg_cmn_clear_test_point;
  1792. dbg->dbgbus_dp.entries = dp_dbg_bus;
  1793. dbg->dbgbus_dp.cmn.entries_size = ARRAY_SIZE(dp_dbg_bus);
  1794. dbg->dbgbus_dp.cmn.name = DBGBUS_NAME_DP;
  1795. dbg->dbgbus_dp.cmn.blk_id = SDE_DBG_DP_DBGBUS;
  1796. dbg->dbgbus_dp.read_tp = _sde_dbg_dp_read_test_point;
  1797. dbg->dbgbus_dp.clear_tp = _sde_dbg_cmn_clear_test_point;
  1798. dbg->dbgbus_lutdma.entries = dbg_bus_lutdma;
  1799. dbg->dbgbus_lutdma.cmn.name = DBGBUS_NAME_LUTDMA;
  1800. dbg->dbgbus_lutdma.cmn.blk_id = SDE_DBG_LUTDMA_DBGBUS;
  1801. dbg->dbgbus_lutdma.cmn.entries_size = ARRAY_SIZE(dbg_bus_lutdma);
  1802. dbg->dbgbus_lutdma.read_tp = _sde_dbg_lutdma_read_test_point;
  1803. dbg->dbgbus_lutdma.clear_tp = _sde_dbg_cmn_clear_test_point;
  1804. }
  1805. int sde_dbg_init(struct device *dev)
  1806. {
  1807. if (!dev) {
  1808. pr_err("invalid params\n");
  1809. return -EINVAL;
  1810. }
  1811. mutex_init(&sde_dbg_base.mutex);
  1812. INIT_LIST_HEAD(&sde_dbg_base.reg_base_list);
  1813. sde_dbg_base.dev = dev;
  1814. sde_dbg_base.evtlog = sde_evtlog_init();
  1815. if (IS_ERR_OR_NULL(sde_dbg_base.evtlog))
  1816. return PTR_ERR(sde_dbg_base.evtlog);
  1817. sde_dbg_base_evtlog = sde_dbg_base.evtlog;
  1818. sde_dbg_base.reglog = sde_reglog_init();
  1819. if (IS_ERR_OR_NULL(sde_dbg_base.reglog))
  1820. return PTR_ERR(sde_dbg_base.reglog);
  1821. sde_dbg_base_reglog = sde_dbg_base.reglog;
  1822. INIT_WORK(&sde_dbg_base.dump_work, _sde_dump_work);
  1823. sde_dbg_base.work_panic = false;
  1824. sde_dbg_base.panic_on_err = DEFAULT_PANIC;
  1825. sde_dbg_base.enable_reg_dump = DEFAULT_REGDUMP;
  1826. sde_dbg_base.enable_dbgbus_dump = DEFAULT_DBGBUS_DUMP;
  1827. sde_dbg_base.dump_blk_mask = SDE_DBG_BUILT_IN_ALL;
  1828. memset(&sde_dbg_base.regbuf, 0, sizeof(sde_dbg_base.regbuf));
  1829. pr_info("evtlog_status: enable:%d, panic:%d, dump:%d\n",
  1830. sde_dbg_base.evtlog->enable, sde_dbg_base.panic_on_err,
  1831. sde_dbg_base.enable_reg_dump);
  1832. return 0;
  1833. }
  1834. static void sde_dbg_reg_base_destroy(void)
  1835. {
  1836. struct sde_dbg_reg_range *range_node, *range_tmp;
  1837. struct sde_dbg_reg_base *blk_base, *blk_tmp;
  1838. struct sde_dbg_base *dbg_base = &sde_dbg_base;
  1839. if (!dbg_base)
  1840. return;
  1841. list_for_each_entry_safe(blk_base, blk_tmp, &dbg_base->reg_base_list,
  1842. reg_base_head) {
  1843. list_for_each_entry_safe(range_node, range_tmp,
  1844. &blk_base->sub_range_list, head) {
  1845. list_del(&range_node->head);
  1846. kfree(range_node);
  1847. }
  1848. list_del(&blk_base->reg_base_head);
  1849. kfree(blk_base);
  1850. }
  1851. }
  1852. static void sde_dbg_dsi_ctrl_destroy(void)
  1853. {
  1854. struct sde_dbg_dsi_ctrl_list_entry *entry, *tmp;
  1855. mutex_lock(&sde_dbg_dsi_mutex);
  1856. list_for_each_entry_safe(entry, tmp, &sde_dbg_dsi_list, list) {
  1857. list_del(&entry->list);
  1858. kfree(entry);
  1859. }
  1860. mutex_unlock(&sde_dbg_dsi_mutex);
  1861. }
  1862. /**
  1863. * sde_dbg_destroy - destroy sde debug facilities
  1864. */
  1865. void sde_dbg_destroy(void)
  1866. {
  1867. kfree(sde_dbg_base.regbuf.buf);
  1868. memset(&sde_dbg_base.regbuf, 0, sizeof(sde_dbg_base.regbuf));
  1869. _sde_dbg_debugfs_destroy();
  1870. sde_dbg_base_evtlog = NULL;
  1871. sde_evtlog_destroy(sde_dbg_base.evtlog);
  1872. sde_dbg_base.evtlog = NULL;
  1873. sde_reglog_destroy(sde_dbg_base.reglog);
  1874. sde_dbg_base.reglog = NULL;
  1875. sde_dbg_reg_base_destroy();
  1876. sde_dbg_dsi_ctrl_destroy();
  1877. mutex_destroy(&sde_dbg_base.mutex);
  1878. }
  1879. int sde_dbg_dsi_ctrl_register(void __iomem *base, const char *name)
  1880. {
  1881. struct sde_dbg_dsi_ctrl_list_entry *entry;
  1882. entry = kzalloc(sizeof(*entry), GFP_KERNEL);
  1883. if (!entry)
  1884. return -ENOMEM;
  1885. entry->name = name;
  1886. entry->base = base;
  1887. mutex_lock(&sde_dbg_dsi_mutex);
  1888. list_add_tail(&entry->list, &sde_dbg_dsi_list);
  1889. mutex_unlock(&sde_dbg_dsi_mutex);
  1890. pr_debug("registered DSI CTRL %s for debugbus support\n", entry->name);
  1891. return 0;
  1892. }
  1893. int sde_dbg_reg_register_base(const char *name, void __iomem *base, size_t max_offset, u64 blk_id)
  1894. {
  1895. struct sde_dbg_base *dbg_base = &sde_dbg_base;
  1896. struct sde_dbg_reg_base *reg_base;
  1897. if (!name || !strlen(name)) {
  1898. pr_err("no debug name provided\n");
  1899. return -EINVAL;
  1900. }
  1901. reg_base = kzalloc(sizeof(*reg_base), GFP_KERNEL);
  1902. if (!reg_base)
  1903. return -ENOMEM;
  1904. strlcpy(reg_base->name, name, sizeof(reg_base->name));
  1905. reg_base->base = base;
  1906. reg_base->max_offset = max_offset;
  1907. reg_base->off = 0;
  1908. reg_base->cnt = DEFAULT_BASE_REG_CNT;
  1909. reg_base->reg_dump = NULL;
  1910. reg_base->blk_id = blk_id;
  1911. /* Initialize list to make sure check for null list will be valid */
  1912. INIT_LIST_HEAD(&reg_base->sub_range_list);
  1913. pr_debug("%s base: %pK max_offset 0x%zX\n", reg_base->name,
  1914. reg_base->base, reg_base->max_offset);
  1915. list_add(&reg_base->reg_base_head, &dbg_base->reg_base_list);
  1916. return 0;
  1917. }
  1918. int sde_dbg_reg_register_cb(const char *name, void (*cb)(void *), void *ptr)
  1919. {
  1920. struct sde_dbg_base *dbg_base = &sde_dbg_base;
  1921. struct sde_dbg_reg_base *reg_base;
  1922. if (!name || !strlen(name)) {
  1923. pr_err("no debug name provided\n");
  1924. return -EINVAL;
  1925. }
  1926. reg_base = kzalloc(sizeof(*reg_base), GFP_KERNEL);
  1927. if (!reg_base)
  1928. return -ENOMEM;
  1929. strlcpy(reg_base->name, name, sizeof(reg_base->name));
  1930. reg_base->base = NULL;
  1931. reg_base->max_offset = 0;
  1932. reg_base->off = 0;
  1933. reg_base->cnt = DEFAULT_BASE_REG_CNT;
  1934. reg_base->reg_dump = NULL;
  1935. reg_base->cb = cb;
  1936. reg_base->cb_ptr = ptr;
  1937. /* Initialize list to make sure check for null list will be valid */
  1938. INIT_LIST_HEAD(&reg_base->sub_range_list);
  1939. pr_debug("%s cb: %pK cb_ptr: %pK\n", reg_base->name,
  1940. reg_base->cb, reg_base->cb_ptr);
  1941. list_add(&reg_base->reg_base_head, &dbg_base->reg_base_list);
  1942. return 0;
  1943. }
  1944. void sde_dbg_reg_unregister_cb(const char *name, void (*cb)(void *), void *ptr)
  1945. {
  1946. struct sde_dbg_base *dbg_base = &sde_dbg_base;
  1947. struct sde_dbg_reg_base *reg_base;
  1948. if (!dbg_base)
  1949. return;
  1950. list_for_each_entry(reg_base, &dbg_base->reg_base_list, reg_base_head) {
  1951. if (strlen(reg_base->name) &&
  1952. !strcmp(reg_base->name, name)) {
  1953. pr_debug("%s cb: %pK cb_ptr: %pK\n", reg_base->name,
  1954. reg_base->cb, reg_base->cb_ptr);
  1955. list_del(&reg_base->reg_base_head);
  1956. kfree(reg_base);
  1957. break;
  1958. }
  1959. }
  1960. }
  1961. void sde_dbg_reg_register_dump_range(const char *base_name,
  1962. const char *range_name, u32 offset_start, u32 offset_end,
  1963. uint32_t xin_id)
  1964. {
  1965. struct sde_dbg_reg_base *reg_base;
  1966. struct sde_dbg_reg_range *range;
  1967. reg_base = _sde_dump_get_blk_addr(base_name);
  1968. if (!reg_base) {
  1969. pr_err("error: for range %s unable to locate base %s\n",
  1970. range_name, base_name);
  1971. return;
  1972. }
  1973. if (!range_name || strlen(range_name) == 0) {
  1974. pr_err("%pS: bad range name, base_name %s, offset_start 0x%X, end 0x%X\n",
  1975. __builtin_return_address(0), base_name,
  1976. offset_start, offset_end);
  1977. return;
  1978. }
  1979. if (offset_end - offset_start < REG_DUMP_ALIGN ||
  1980. offset_start > offset_end) {
  1981. pr_err("%pS: bad range, base_name %s, range_name %s, offset_start 0x%X, end 0x%X\n",
  1982. __builtin_return_address(0), base_name,
  1983. range_name, offset_start, offset_end);
  1984. return;
  1985. }
  1986. range = kzalloc(sizeof(*range), GFP_KERNEL);
  1987. if (!range)
  1988. return;
  1989. strlcpy(range->range_name, range_name, sizeof(range->range_name));
  1990. range->offset.start = offset_start;
  1991. range->offset.end = offset_end;
  1992. range->xin_id = xin_id;
  1993. list_add_tail(&range->head, &reg_base->sub_range_list);
  1994. pr_debug("base %s, range %s, start 0x%X, end 0x%X\n",
  1995. base_name, range->range_name,
  1996. range->offset.start, range->offset.end);
  1997. }
  1998. void sde_dbg_set_hw_ownership_status(bool enable)
  1999. {
  2000. mutex_lock(&sde_dbg_base.mutex);
  2001. sde_dbg_base.hw_ownership = enable;
  2002. mutex_unlock(&sde_dbg_base.mutex);
  2003. }
  2004. void sde_dbg_set_sde_top_offset(u32 blk_off)
  2005. {
  2006. sde_dbg_base.dbgbus_sde.top_blk_off = blk_off;
  2007. }