sde_dbg.c 82 KB

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