sde_dbg.c 83 KB

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