sde_dbg.c 71 KB

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