12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003 |
- // SPDX-License-Identifier: GPL-2.0
- /*
- *
- * Copyright (C) 2016-2023 Samsung, Inc.
- * Author: Dongrak Shin <[email protected]>
- *
- */
- /* usb notify layer v4.0 */
- #define pr_fmt(fmt) "usb_notify: " fmt
- #include <linux/types.h>
- #include <linux/errno.h>
- #include <linux/time.h>
- #include <linux/ktime.h>
- #include <linux/rtc.h>
- #include <linux/kernel.h>
- #include <linux/vmalloc.h>
- #include <linux/security.h>
- #include <linux/syscalls.h>
- #include <linux/proc_fs.h>
- #include <linux/spinlock.h>
- #include <linux/seq_file.h>
- /* clock.h should be included since kernel 4.14 */
- #include <linux/sched/clock.h>
- #include <linux/usb_notify.h>
- #define USBLOG_MAX_BUF_SIZE (1 << 6) /* 64 */
- #define USBLOG_MAX_BUF2_SIZE (1 << 7) /* 128 */
- #define USBLOG_MAX_BUF3_SIZE (1 << 8) /* 256 */
- #define USBLOG_MAX_BUF4_SIZE (1 << 9) /* 512 */
- #define USBLOG_MAX_STRING_SIZE (1 << 5) /* 32 */
- #define USBLOG_CMP_INDEX 3
- #define USBLOG_MAX_STORE_PORT (1 << 6) /* 64 */
- #define USBLOG_CCIC_BUFFER_SIZE USBLOG_MAX_BUF4_SIZE
- #define USBLOG_MODE_BUFFER_SIZE USBLOG_MAX_BUF_SIZE
- #define USBLOG_STATE_BUFFER_SIZE USBLOG_MAX_BUF3_SIZE
- #define USBLOG_EVENT_BUFFER_SIZE USBLOG_MAX_BUF_SIZE
- #define USBLOG_PORT_BUFFER_SIZE USBLOG_MAX_BUF2_SIZE
- #define USBLOG_PCM_BUFFER_SIZE USBLOG_MAX_BUF_SIZE
- #define USBLOG_EXTRA_BUFFER_SIZE USBLOG_MAX_BUF2_SIZE
- #define USBLOG_INDEX 0xABCDABCD
- #define USBLOG_CC1 0xffffffff00000000
- #define USBLOG_CC2 0x00000000ffffffff
- #define PRINTK_USB_BUF_SIZE SZ_64K
- #define PRINTK_USB_BOOT_BUF_SIZE SZ_64K
- #define PRINTK_USB_MAX_STRING_SIZE (1 << 8) /* 256 */
- struct usblog_rtc_time {
- int tm_sec;
- int tm_min;
- int tm_hour;
- int tm_mday;
- int tm_mon;
- };
- struct ccic_buf {
- unsigned long long ts_nsec;
- int cc_type;
- uint64_t noti;
- };
- struct mode_buf {
- unsigned long long ts_nsec;
- char usbmode_str[USBLOG_MAX_STRING_SIZE];
- };
- struct state_buf {
- unsigned long long ts_nsec;
- int usbstate;
- };
- struct event_buf {
- unsigned long long ts_nsec;
- unsigned long event;
- int enable;
- };
- struct port_buf {
- unsigned long long ts_nsec;
- int type;
- uint16_t param1;
- uint16_t param2;
- uint16_t count;
- };
- struct port_count {
- uint16_t vid;
- uint16_t pid;
- uint16_t count;
- };
- struct pcm_buf {
- struct usblog_rtc_time rt;
- unsigned long long ts_nsec;
- int type;
- int enable;
- };
- struct extra_buf {
- unsigned long long ts_nsec;
- int event;
- };
- struct usblog_rtc_buf {
- struct usblog_rtc_time ccic_buf_rt[USBLOG_CCIC_BUFFER_SIZE];
- struct usblog_rtc_time mode_buf_rt[USBLOG_MODE_BUFFER_SIZE];
- struct usblog_rtc_time state_buf_rt[USBLOG_STATE_BUFFER_SIZE];
- struct usblog_rtc_time event_buf_rt[USBLOG_EVENT_BUFFER_SIZE];
- struct usblog_rtc_time port_buf_rt[USBLOG_PORT_BUFFER_SIZE];
- struct usblog_rtc_time extra_buf_rt[USBLOG_EXTRA_BUFFER_SIZE];
- };
- struct usblog_buf {
- unsigned long long ccic_count;
- unsigned long long mode_count;
- unsigned long long state_count;
- unsigned long long event_count;
- unsigned long long port_count;
- unsigned long long extra_count;
- unsigned long ccic_index;
- unsigned long mode_index;
- unsigned long state_index;
- unsigned long event_index;
- unsigned long port_index;
- unsigned long extra_index;
- struct ccic_buf ccic_buffer[USBLOG_CCIC_BUFFER_SIZE];
- struct mode_buf mode_buffer[USBLOG_MODE_BUFFER_SIZE];
- struct state_buf state_buffer[USBLOG_STATE_BUFFER_SIZE];
- struct event_buf event_buffer[USBLOG_EVENT_BUFFER_SIZE];
- struct port_buf port_buffer[USBLOG_PORT_BUFFER_SIZE];
- struct port_count store_port_cnt[USBLOG_MAX_STORE_PORT];
- struct extra_buf extra_buffer[USBLOG_EXTRA_BUFFER_SIZE];
- };
- struct usblog_vm_buf {
- unsigned long long pcm_count;
- unsigned long pcm_index;
- struct pcm_buf pcm_buffer[USBLOG_PCM_BUFFER_SIZE];
- };
- struct ccic_version {
- unsigned char hw_version[4];
- unsigned char sw_main[3];
- unsigned char sw_boot;
- };
- struct printk_usb_data {
- unsigned long usb_index;
- unsigned long usb_tail;
- unsigned long usb_snap_index;
- unsigned long usb_snap_tail;
- unsigned long usb_boot_index;
- bool usb_full;
- bool usb_snap_full;
- bool usb_boot_full;
- bool snap_done;
- };
- struct usblog_root_str {
- unsigned long usblog_index;
- struct usblog_buf *usblog_buffer;
- struct usblog_vm_buf *usblog_vm_buffer;
- struct usblog_rtc_buf *usblog_rtc_buffer;
- struct ccic_version ccic_ver;
- struct ccic_version ccic_bin_ver;
- struct printk_usb_data prk_usb;
- char tcpc_name[USBLOG_MAX_STRING_SIZE];
- spinlock_t usblog_lock;
- int init;
- };
- struct ccic_type {
- uint64_t src:4;
- uint64_t dest:4;
- uint64_t id:8;
- uint64_t sub1:16;
- uint64_t sub2:16;
- uint64_t sub3:16;
- };
- static struct usblog_root_str usblog_root;
- static char printk_usb_boot_buf[PRINTK_USB_BOOT_BUF_SIZE];
- static char printk_usb_buf[PRINTK_USB_BUF_SIZE];
- static char printk_usb_snap_buf[PRINTK_USB_BUF_SIZE];
- static const char *usbstate_string(enum usblog_state usbstate)
- {
- switch (usbstate) {
- case NOTIFY_CONFIGURED:
- return "CONFIGURED";
- case NOTIFY_CONNECTED:
- return "CONNECTED";
- case NOTIFY_DISCONNECTED:
- return "DISCONNECTED";
- case NOTIFY_RESET:
- return "RESET";
- case NOTIFY_RESET_FULL:
- return "RESET : FULL";
- case NOTIFY_RESET_HIGH:
- return "RESET: HIGH";
- case NOTIFY_RESET_SUPER:
- return "RESET : SUPER";
- case NOTIFY_PULLUP:
- return "VBUS_PULLUP (EN OR DIS)";
- case NOTIFY_PULLUP_ENABLE:
- return "VBUS_PULLUP_EN";
- case NOTIFY_PULLUP_EN_SUCCESS:
- return "VBUS_PULLUP_EN : S";
- case NOTIFY_PULLUP_EN_FAIL:
- return "VBUS_PULLUP_EN : F";
- case NOTIFY_PULLUP_DISABLE:
- return "VBUS_PULLUP_DIS";
- case NOTIFY_PULLUP_DIS_SUCCESS:
- return "VBUS_PULLUP_DIS : S";
- case NOTIFY_PULLUP_DIS_FAIL:
- return "VBUS_PULLUP_DIS : F";
- case NOTIFY_VBUS_SESSION:
- return "VBUS_SESSION (EN OR DIS)";
- case NOTIFY_VBUS_SESSION_ENABLE:
- return "VBUS_SESSION_EN";
- case NOTIFY_VBUS_EN_SUCCESS:
- return "VBUS_SESSION_EN : S";
- case NOTIFY_VBUS_EN_FAIL:
- return "VBUS_SESSION_EN : F";
- case NOTIFY_VBUS_SESSION_DISABLE:
- return "VBUS_SESSIOIN_DIS";
- case NOTIFY_VBUS_DIS_SUCCESS:
- return "VBUS_SESSION_DIS : S";
- case NOTIFY_VBUS_DIS_FAIL:
- return "VBUS_SESSION_DIS : F";
- case NOTIFY_ACCSTART:
- return "ACCSTART";
- case NOTIFY_HIGH:
- return "HIGH SPEED";
- case NOTIFY_SUPER:
- return "SUPER SPEED";
- case NOTIFY_GET_DES:
- return "GET_DES";
- case NOTIFY_SET_CON:
- return "SET_CON";
- case NOTIFY_CONNDONE_SSP:
- return "CONNDONE SSP";
- case NOTIFY_CONNDONE_SS:
- return "CONNDONE SS";
- case NOTIFY_CONNDONE_HS:
- return "CONNDONE HS";
- case NOTIFY_CONNDONE_FS:
- return "CONNDONE FS";
- case NOTIFY_CONNDONE_LS:
- return "CONNDONE LS";
- default:
- return "UNDEFINED";
- }
- }
- static const char *usbstatus_string(enum usblog_status usbstatus)
- {
- switch (usbstatus) {
- case NOTIFY_DETACH:
- return "DETACH";
- case NOTIFY_ATTACH_DFP:
- return "ATTACH_DFP";
- case NOTIFY_ATTACH_UFP:
- return "ATTACH_UFP";
- case NOTIFY_ATTACH_DRP:
- return "ATTACH_DRP";
- default:
- return "UNDEFINED";
- }
- }
- static const char *ccic_dev_string(enum ccic_device dev)
- {
- switch (dev) {
- case NOTIFY_DEV_INITIAL:
- return "INITIAL";
- case NOTIFY_DEV_USB:
- return "USB";
- case NOTIFY_DEV_BATTERY:
- return "BATTERY";
- case NOTIFY_DEV_PDIC:
- return "PDIC";
- case NOTIFY_DEV_MUIC:
- return "MUIC";
- case NOTIFY_DEV_CCIC:
- return "CCIC";
- case NOTIFY_DEV_MANAGER:
- return "MANAGER";
- case NOTIFY_DEV_DP:
- return "DP";
- case NOTIFY_DEV_USB_DP:
- return "USB_DP";
- case NOTIFY_DEV_SUB_BATTERY:
- return "BATTERY2";
- case NOTIFY_DEV_SECOND_MUIC:
- return "MUIC2";
- case NOTIFY_DEV_DEDICATED_MUIC:
- return "DEDICATED MUIC";
- case NOTIFY_DEV_ALL:
- return "DEV ALL";
- default:
- return "UNDEFINED";
- }
- }
- static const char *ccic_id_string(enum ccic_id id)
- {
- switch (id) {
- case NOTIFY_ID_INITIAL:
- return "ID_INITIAL";
- case NOTIFY_ID_ATTACH:
- return "ID_CONNECT";
- case NOTIFY_ID_RID:
- return "ID_RID";
- case NOTIFY_ID_USB:
- return "ID_USB";
- case NOTIFY_ID_POWER_STATUS:
- return "ID_POWER_STATUS";
- case NOTIFY_ID_WATER:
- return "ID_WATER";
- case NOTIFY_ID_VCONN:
- return "ID_VCONN";
- case NOTIFY_ID_OTG:
- return "ID_OTG";
- case NOTIFY_ID_TA:
- return "ID_TA";
- case NOTIFY_ID_DP_CONNECT:
- return "ID_DP_CONNECT";
- case NOTIFY_ID_DP_HPD:
- return "ID_DP_HPD";
- case NOTIFY_ID_DP_LINK_CONF:
- return "ID_DP_LINK_CONF";
- case NOTIFY_ID_USB_DP:
- return "ID_USB_DP";
- case NOTIFY_ID_ROLE_SWAP:
- return "ID_ROLE_SWAP";
- case NOTIFY_ID_FAC:
- return "ID_FAC";
- case NOTIFY_ID_CC_PIN_STATUS:
- return "ID_PIN_STATUS";
- case NOTIFY_ID_WATER_CABLE:
- return "ID_WATER_CABLE";
- case NOTIFY_ID_POFF_WATER:
- return "ID_POWEROFF_WATER";
- case NOTIFY_ID_DEVICE_INFO:
- return "ID_DEVICE_INFO";
- case NOTIFY_ID_SVID_INFO:
- return "ID_SVID_INFO";
- case NOTIFY_ID_CLEAR_INFO:
- return "ID_CLEAR_INFO";
- default:
- return "UNDEFINED";
- }
- }
- static const char *ccic_rid_string(enum ccic_rid rid)
- {
- switch (rid) {
- case NOTIFY_RID_UNDEFINED:
- return "RID_UNDEFINED";
- #if defined(CONFIG_USB_CCIC_NOTIFIER_USING_QC)
- case NOTIFY_RID_GND:
- return "RID_GND";
- case NOTIFY_RID_056K:
- return "RID_056K";
- #else
- case NOTIFY_RID_000K:
- return "RID_000K";
- case NOTIFY_RID_001K:
- return "RID_001K";
- #endif
- case NOTIFY_RID_255K:
- return "RID_255K";
- case NOTIFY_RID_301K:
- return "RID_301K";
- case NOTIFY_RID_523K:
- return "RID_523K";
- case NOTIFY_RID_619K:
- return "RID_619K";
- case NOTIFY_RID_OPEN:
- return "RID_OPEN";
- default:
- return "UNDEFINED";
- }
- }
- static const char *ccic_con_string(enum ccic_con con)
- {
- switch (con) {
- case NOTIFY_CON_DETACH:
- return "DETACHED";
- case NOTIFY_CON_ATTACH:
- return "ATTACHED";
- default:
- return "UNDEFINED";
- }
- }
- static const char *ccic_rprd_string(enum ccic_rprd rprd)
- {
- switch (rprd) {
- case NOTIFY_RD:
- return "RD";
- case NOTIFY_RP:
- return "RP";
- default:
- return "UNDEFINED";
- }
- }
- static const char *ccic_rpstatus_string(enum ccic_rpstatus rprd)
- {
- switch (rprd) {
- case NOTIFY_RP_NONE:
- return "NONE";
- case NOTIFY_RP_56K:
- return "RP_56K";
- case NOTIFY_RP_22K:
- return "RP_22K";
- case NOTIFY_RP_10K:
- return "RP_10K";
- case NOTIFY_RP_ABNORMAL:
- return "RP_ABNORMAL";
- default:
- return "UNDEFINED";
- }
- }
- static const char *ccic_hpd_string(enum ccic_hpd hpd)
- {
- switch (hpd) {
- case NOTIFY_HPD_LOW:
- return "LOW";
- case NOTIFY_HPD_HIGH:
- return "HIGH";
- case NOTIFY_HPD_IRQ:
- return "IRQ";
- default:
- return "UNDEFINED";
- }
- }
- static const char *ccic_pin_string(enum ccic_pin_assignment pin)
- {
- switch (pin) {
- case NOTIFY_DP_PIN_UNKNOWN:
- return "UNKNOWN";
- case NOTIFY_DP_PIN_A:
- return "DP_PIN_A";
- case NOTIFY_DP_PIN_B:
- return "DP_PIN_B";
- case NOTIFY_DP_PIN_C:
- return "DP_PIN_C";
- case NOTIFY_DP_PIN_D:
- return "DP_PIN_D";
- case NOTIFY_DP_PIN_E:
- return "DP_PIN_E";
- case NOTIFY_DP_PIN_F:
- return "DP_PIN_F";
- default:
- return "UNKNOWN";
- }
- }
- static const char *ccic_alternatemode_string(uint64_t id)
- {
- if ((id & ALTERNATE_MODE_READY) && (id & ALTERNATE_MODE_START))
- return "READY & START";
- else if ((id & ALTERNATE_MODE_READY) && (id & ALTERNATE_MODE_STOP))
- return "READY & STOP";
- else if (id & ALTERNATE_MODE_READY)
- return "MODE READY";
- else if (id & ALTERNATE_MODE_START)
- return "START";
- else if (id & ALTERNATE_MODE_STOP)
- return "STOP";
- else if (id & ALTERNATE_MODE_RESET)
- return "RESET";
- else
- return "UNDEFINED";
- }
- static const char *ccic_voltage_string(uint8_t cc)
- {
- switch (cc) {
- case NOTIFY_CC_VOLT_OPEN:
- return "open";
- case NOTIFY_CC_VOLT_RA:
- return "ra";
- case NOTIFY_CC_VOLT_RD:
- return "rd";
- case NOTIFY_CC_VOLT_SNK_DFT:
- return "rp 56k";
- case NOTIFY_CC_VOLT_SNK_1_5:
- return "rp 22k";
- case NOTIFY_CC_VOLT_SNK_3_0:
- return "rp 10k";
- case NOTIFY_CC_DRP_TOGGLING:
- return "cc toggle";
- default:
- return "undefined";
- }
- }
- static const char *ccic_pinstatus_string(enum ccic_pin_status pinstatus)
- {
- switch (pinstatus) {
- case NOTIFY_PIN_NOTERMINATION:
- return "NO TERMINATION";
- case NOTIFY_PIN_CC1_ACTIVE:
- return "CC1_ACTIVE";
- case NOTIFY_PIN_CC2_ACTIVE:
- return "CC2_ACTIVE";
- case NOTIFY_PIN_AUDIO_ACCESSORY:
- return "AUDIO_ACCESSORY";
- default:
- return "ETC";
- }
- }
- static const char *extra_string(enum extra event)
- {
- switch (event) {
- case NOTIFY_EXTRA_USBKILLER:
- return "USB_KILLER";
- case NOTIFY_EXTRA_HARDRESET_SENT:
- return "PDIC HARDRESET_SENT";
- case NOTIFY_EXTRA_HARDRESET_RECEIVED:
- return "PDIC HARDRESET_RECEIVED";
- case NOTIFY_EXTRA_SYSERROR_BOOT_WDT:
- return "PDIC WDT RESET";
- case NOTIFY_EXTRA_SYSMSG_BOOT_POR:
- return "PDIC POR RESET";
- case NOTIFY_EXTRA_SYSMSG_CC_SHORT:
- return "CC VBUS SHORT";
- case NOTIFY_EXTRA_SYSMSG_SBU_GND_SHORT:
- return "SBU GND SHORT";
- case NOTIFY_EXTRA_SYSMSG_SBU_VBUS_SHORT:
- return "SBU VBUS SHORT";
- case NOTIFY_EXTRA_UVDM_TIMEOUT:
- return "UVDM TIMEOUT";
- case NOTIFY_EXTRA_CCOPEN_REQ_SET:
- return "CC OPEN SET";
- case NOTIFY_EXTRA_CCOPEN_REQ_CLEAR:
- return "CC OPEN CLEAR";
- case NOTIFY_EXTRA_USB_ANALOGAUDIO:
- return "USB ANALOG AUDIO";
- case NOTIFY_EXTRA_USBHOST_OVERCURRENT:
- return "USB HOST OVERCURRENT";
- case NOTIFY_EXTRA_ROOTHUB_SUSPEND_FAIL:
- return "ROOTHUB SUSPEND FAIL";
- case NOTIFY_EXTRA_PORT_SUSPEND_FAIL:
- return "PORT SUSPEND FAIL";
- case NOTIFY_EXTRA_PORT_SUSPEND_WAKEUP_FAIL:
- return "PORT REMOTE WAKEUP FAIL";
- case NOTIFY_EXTRA_PORT_SUSPEND_LTM_FAIL:
- return "PORT LTM FAIL";
- case NOTIFY_EXTRA_VIB_FW_LOAD_SUCCESS:
- return "VIBRATOR FIRMWARE LOAD SUCCESS";
- default:
- return "ETC";
- }
- }
- static const char * const tcpm_states[] = {
- NOTIFY_FOREACH_STATE(NOTIFY_GENERATE_STRING)
- };
- static void usblog_get_rt(struct usblog_rtc_time *rt)
- {
- struct rtc_time tm;
- struct timespec64 ts64;
- ktime_get_real_ts64(&ts64);
- rtc_time64_to_tm(ts64.tv_sec - (sys_tz.tz_minuteswest * 60), &tm);
- rt->tm_mon = tm.tm_mon + 1;
- rt->tm_mday = tm.tm_mday;
- rt->tm_hour = tm.tm_hour;
- rt->tm_min = tm.tm_min;
- rt->tm_sec = tm.tm_sec;
- }
- static void print_ccic_event(struct seq_file *m, unsigned long long ts,
- unsigned long rem_nsec, int cc_type, uint64_t *noti)
- {
- struct ccic_type type = *(struct ccic_type *)noti;
- uint8_t cc1 = 0, cc2 = 0;
- int cable = type.sub3;
- switch (cc_type) {
- case NOTIFY_FUNCSTATE:
- seq_printf(m, "[%5lu.%06lu] function state = %llu\n",
- (unsigned long)ts, rem_nsec / 1000, *noti);
- break;
- case NOTIFY_TCPMSTATE:
- if (*noti >= ARRAY_SIZE(tcpm_states)) {
- seq_printf(m, "[%5lu.%06lu] tcpm state = %llu\n",
- (unsigned long)ts, rem_nsec / 1000, *noti);
- } else {
- seq_printf(m, "[%5lu.%06lu] tcpm state = %s(%llu)\n",
- (unsigned long)ts, rem_nsec / 1000,
- tcpm_states[*noti], *noti);
- }
- break;
- case NOTIFY_CCSTATE:
- cc1 = (*noti & USBLOG_CC1) >> 32;
- cc2 = (*noti & USBLOG_CC2);
- seq_printf(m, "[%5lu.%06lu] cc1=%s cc2=%s\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_voltage_string(cc1), ccic_voltage_string(cc2));
- break;
- case NOTIFY_ALTERNATEMODE:
- seq_printf(m, "[%5lu.%06lu] ccic alternate mode is %s 0x%04llx\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_alternatemode_string(*noti), *noti);
- break;
- case NOTIFY_CCIC_EVENT:
- if (type.id == NOTIFY_ID_ATTACH) {
- if (type.src == NOTIFY_DEV_MUIC
- || type.src == NOTIFY_DEV_SECOND_MUIC
- || type.src == NOTIFY_DEV_DEDICATED_MUIC)
- seq_printf(m,
- "[%5lu.%06lu] ccic notify: id=%s src=%s dest=%s rprd=%s cable=%d %s\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- ccic_rprd_string(type.sub2),
- cable, ccic_con_string(type.sub1));
- else
- seq_printf(m,
- "[%5lu.%06lu] ccic notify: id=%s src=%s dest=%s rprd=%s rp status=%s %s\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- ccic_rprd_string(type.sub2),
- ccic_rpstatus_string(type.sub3),
- ccic_con_string(type.sub1));
- } else if (type.id == NOTIFY_ID_RID)
- seq_printf(m, "[%5lu.%06lu] ccic notify: id=%s src=%s dest=%s rid=%s\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- ccic_rid_string(type.sub1));
- else if (type.id == NOTIFY_ID_USB)
- seq_printf(m, "[%5lu.%06lu] ccic notify: id=%s src=%s dest=%s status=%s\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- usbstatus_string(type.sub2));
- else if (type.id == NOTIFY_ID_POWER_STATUS)
- seq_printf(m, "[%5lu.%06lu] ccic notify: id=%s src=%s dest=%s %s\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- ccic_con_string(type.sub1));
- else if (type.id == NOTIFY_ID_WATER)
- seq_printf(m, "[%5lu.%06lu] ccic notify: id=%s src=%s dest=%s %s detected\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- type.sub1 ? "WATER":"DRY");
- else if (type.id == NOTIFY_ID_VCONN)
- seq_printf(m, "[%5lu.%06lu] ccic notify: id=%s src=%s dest=%s\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest));
- else if (type.id == NOTIFY_ID_OTG)
- seq_printf(m, "[%5lu.%06lu] ccic notify: id=%s src=%s dest=%s %s\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- type.sub2 ? "Enable":"Disable");
- else if (type.id == NOTIFY_ID_TA)
- seq_printf(m, "[%5lu.%06lu] ccic notify: id=%s src=%s dest=%s %s\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- ccic_con_string(type.sub1));
- else if (type.id == NOTIFY_ID_DP_CONNECT)
- seq_printf(m, "[%5lu.%06lu] ccic notify: id=%s src=%s dest=%s 0x%04x/0x%04x %s\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- type.sub2,
- type.sub3,
- ccic_con_string(type.sub1));
- else if (type.id == NOTIFY_ID_DP_HPD)
- seq_printf(m, "[%5lu.%06lu] ccic notify: id=%s src=%s dest=%s hpd=%s irq=%s\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- ccic_hpd_string(type.sub1),
- type.sub2 ? "VALID":"NONE");
- else if (type.id == NOTIFY_ID_DP_LINK_CONF)
- seq_printf(m, "[%5lu.%06lu] ccic notify: id=%s src=%s dest=%s PIN-assign=%s\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- ccic_pin_string(type.sub1));
- else if (type.id == NOTIFY_ID_USB_DP)
- seq_printf(m, "[%5lu.%06lu] ccic notify: id=%s src=%s dest=%s CON=%d HS=%d\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- type.sub1,
- type.sub2);
- else if (type.id == NOTIFY_ID_ROLE_SWAP)
- seq_printf(m, "[%5lu.%06lu] ccic notify: id=%s src=%s dest=%s sub1=%d sub2=%d\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- type.sub1,
- type.sub2);
- else if (type.id == NOTIFY_ID_FAC)
- seq_printf(m, "[%5lu.%06lu] ccic notify: id=%s src=%s dest=%s ErrState=%d\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- type.sub1);
- else if (type.id == NOTIFY_ID_CC_PIN_STATUS)
- seq_printf(m, "[%5lu.%06lu] ccic notify: id=%s src=%s dest=%s pinstatus=%s\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- ccic_pinstatus_string(type.sub1));
- else if (type.id == NOTIFY_ID_WATER_CABLE)
- seq_printf(m, "[%5lu.%06lu] ccic notify: id=%s src=%s dest=%s %s\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- ccic_con_string(type.sub1));
- else if (type.id == NOTIFY_ID_POFF_WATER)
- seq_printf(m, "[%5lu.%06lu] ccic notify: id=%s src=%s dest=%s POWEROFF %s detected\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- type.sub1 ? "WATER":"DRY");
- else if (type.id == NOTIFY_ID_DEVICE_INFO)
- seq_printf(m, "[%5lu.%06lu] ccic notify: id=%s src=%s dest=%s vid=%04x pid=%04x bcd=%04x\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- type.sub1, type.sub2, type.sub3);
- else if (type.id == NOTIFY_ID_SVID_INFO)
- seq_printf(m, "[%5lu.%06lu] ccic notify: id=%s src=%s dest=%s svid=%04x\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- type.sub1);
- else if (type.id == NOTIFY_ID_CLEAR_INFO)
- seq_printf(m, "[%5lu.%06lu] ccic notify: id=%s src=%s dest=%s clear %s\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- (type.sub1 == NOTIFY_ID_DEVICE_INFO) ? "DEVICE INFO" : "SVID INFO");
- else
- seq_printf(m, "[%5lu.%06lu] ccic notify: id=%s src=%s dest=%s rprd=%s %s\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- ccic_rprd_string(type.sub2),
- ccic_con_string(type.sub1));
- break;
- case NOTIFY_MANAGER:
- if (type.id == NOTIFY_ID_ATTACH) {
- if (type.src == NOTIFY_DEV_MUIC
- || type.src == NOTIFY_DEV_SECOND_MUIC
- || type.src == NOTIFY_DEV_DEDICATED_MUIC)
- seq_printf(m,
- "[%5lu.%06lu] manager notify: id=%s src=%s dest=%s rprd=%s cable=%d %s\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- ccic_rprd_string(type.sub2),
- cable, ccic_con_string(type.sub1));
- else
- seq_printf(m,
- "[%5lu.%06lu] manager notify: id=%s src=%s dest=%s rprd=%s rp status=%s %s\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- ccic_rprd_string(type.sub2),
- ccic_rpstatus_string(type.sub3),
- ccic_con_string(type.sub1));
- } else if (type.id == NOTIFY_ID_RID)
- seq_printf(m, "[%5lu.%06lu] manager notify: id=%s src=%s dest=%s rid=%s\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- ccic_rid_string(type.sub1));
- else if (type.id == NOTIFY_ID_USB)
- seq_printf(m, "[%5lu.%06lu] manager notify: id=%s src=%s dest=%s status=%s\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- usbstatus_string(type.sub2));
- else if (type.id == NOTIFY_ID_POWER_STATUS)
- seq_printf(m, "[%5lu.%06lu] manager notify: id=%s src=%s dest=%s %s\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- ccic_con_string(type.sub1));
- else if (type.id == NOTIFY_ID_WATER)
- seq_printf(m, "[%5lu.%06lu] manager notify: id=%s src=%s dest=%s %s detected\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- type.sub1 ? "WATER":"DRY");
- else if (type.id == NOTIFY_ID_VCONN)
- seq_printf(m, "[%5lu.%06lu] manager notify: id=%s src=%s dest=%s\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest));
- else if (type.id == NOTIFY_ID_OTG)
- seq_printf(m, "[%5lu.%06lu] ccic notify: id=%s src=%s dest=%s %s\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- type.sub2 ? "Enable":"Disable");
- else if (type.id == NOTIFY_ID_TA)
- seq_printf(m, "[%5lu.%06lu] ccic notify: id=%s src=%s dest=%s %s\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- ccic_con_string(type.sub1));
- else if (type.id == NOTIFY_ID_DP_CONNECT)
- seq_printf(m, "[%5lu.%06lu] manager notify: id=%s src=%s dest=%s 0x%04x/0x%04x %s\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- type.sub2,
- type.sub3,
- ccic_con_string(type.sub1));
- else if (type.id == NOTIFY_ID_DP_HPD)
- seq_printf(m, "[%5lu.%06lu] manager notify: id=%s src=%s dest=%s hpd=%s irq=%s\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- ccic_hpd_string(type.sub1),
- type.sub2 ? "VALID":"NONE");
- else if (type.id == NOTIFY_ID_DP_LINK_CONF)
- seq_printf(m, "[%5lu.%06lu] manager notify: id=%s src=%s dest=%s PIN-assign=%s\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- ccic_pin_string(type.sub1));
- else if (type.id == NOTIFY_ID_USB_DP)
- seq_printf(m, "[%5lu.%06lu] manager notify: id=%s src=%s dest=%s CON=%d HS=%d\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- type.sub1,
- type.sub2);
- else if (type.id == NOTIFY_ID_ROLE_SWAP)
- seq_printf(m, "[%5lu.%06lu] manager notify: id=%s src=%s dest=%s sub1=%d sub2=%d\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- type.sub1,
- type.sub2);
- else if (type.id == NOTIFY_ID_FAC)
- seq_printf(m, "[%5lu.%06lu] manager notify: id=%s src=%s dest=%s ErrState=%d\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- type.sub1);
- else if (type.id == NOTIFY_ID_CC_PIN_STATUS)
- seq_printf(m, "[%5lu.%06lu] manager notify: id=%s src=%s dest=%s pinstatus=%s\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- ccic_pinstatus_string(type.sub1));
- else if (type.id == NOTIFY_ID_WATER_CABLE)
- seq_printf(m, "[%5lu.%06lu] manager notify: id=%s src=%s dest=%s %s\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- ccic_con_string(type.sub1));
- else if (type.id == NOTIFY_ID_DEVICE_INFO)
- seq_printf(m, "[%5lu.%06lu] manager notify: id=%s src=%s dest=%s vid=%04x pid=%04x bcd=%04x\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- type.sub1, type.sub2, type.sub3);
- else if (type.id == NOTIFY_ID_SVID_INFO)
- seq_printf(m, "[%5lu.%06lu] manager notify: id=%s src=%s dest=%s svid=%04x\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- type.sub1);
- else if (type.id == NOTIFY_ID_CLEAR_INFO)
- seq_printf(m, "[%5lu.%06lu] manager notify: id=%s src=%s dest=%s clear %s\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- (type.sub1 == NOTIFY_ID_DEVICE_INFO) ? "DEVICE INFO" : "SVID INFO");
- else
- seq_printf(m, "[%5lu.%06lu] manager notify: id=%s src=%s dest=%s rprd=%s %s\n",
- (unsigned long)ts, rem_nsec / 1000,
- ccic_id_string(type.id),
- ccic_dev_string(type.src),
- ccic_dev_string(type.dest),
- ccic_rprd_string(type.sub2),
- ccic_con_string(type.sub1));
- break;
- default:
- seq_printf(m, "[%5lu.%06lu] undefined event\n",
- (unsigned long)ts, rem_nsec / 1000);
- break;
- }
- }
- static void print_port_string(struct seq_file *m, unsigned long long ts,
- unsigned long rem_nsec, int type, uint16_t param1,
- uint16_t param2, uint16_t cnt)
- {
- switch (type) {
- case NOTIFY_PORT_CONNECT:
- seq_printf(m, "[%5lu.%06lu] port connect - VID:0x%04x PID:0x%04x cnt:%d\n",
- (unsigned long)ts, rem_nsec / 1000,
- param1, param2, cnt);
- break;
- case NOTIFY_PORT_DISCONNECT:
- seq_printf(m, "[%5lu.%06lu] port disconnect - VID:0x%04x PID:0x%04x\n",
- (unsigned long)ts, rem_nsec / 1000, param1, param2);
- break;
- case NOTIFY_PORT_CLASS:
- seq_printf(m, "[%5lu.%06lu] device class %d, interface class %d\n",
- (unsigned long)ts, rem_nsec / 1000, param1, param2);
- break;
- case NOTIFY_PORT_CLASS_BLOCK:
- seq_printf(m, "[%5lu.%06lu] block device class %d, interface class %d\n",
- (unsigned long)ts, rem_nsec / 1000, param1, param2);
- break;
- default:
- seq_printf(m, "[%5lu.%06lu] undefined event\n",
- (unsigned long)ts, rem_nsec / 1000);
- break;
- }
- }
- static uint16_t set_port_count(uint16_t vid, uint16_t pid)
- {
- int i;
- uint16_t ret = 0;
- struct port_count *temp_port;
- for (i = 0; i < USBLOG_MAX_STORE_PORT; i++) {
- temp_port = &usblog_root.usblog_buffer->store_port_cnt[i];
- if ((temp_port->vid == vid)
- && temp_port->pid == pid) {
- temp_port->count++;
- ret = temp_port->count;
- break;
- }
- if (!temp_port->vid && !temp_port->pid) {
- temp_port->vid = vid;
- temp_port->pid = pid;
- temp_port->count++;
- ret = temp_port->count;
- break;
- }
- }
- if (i == USBLOG_MAX_STORE_PORT)
- unl_err("%s store port overflow\n", __func__);
- return ret;
- }
- static void print_pcm_string(struct seq_file *m, struct usblog_rtc_time *rt,
- unsigned long long ts, unsigned long rem_nsec, int type, int enable)
- {
- switch (type) {
- case NOTIFY_PCM_PLAYBACK:
- seq_printf(m, "[%02d-%02d %02d:%02d:%02d][%5lu.%06lu] USB PCM PLAYBACK %s\n",
- rt->tm_mon, rt->tm_mday, rt->tm_hour, rt->tm_min, rt->tm_sec,
- (unsigned long)ts, rem_nsec / 1000,
- enable ? "OPEN" : "CLOSE");
- break;
- case NOTIFY_PCM_CAPTURE:
- seq_printf(m, "[%02d-%02d %02d:%02d:%02d][%5lu.%06lu] USB PCM CAPTURE %s\n",
- rt->tm_mon, rt->tm_mday, rt->tm_hour, rt->tm_min, rt->tm_sec,
- (unsigned long)ts, rem_nsec / 1000,
- enable ? "OPEN" : "CLOSE");
- break;
- default:
- seq_printf(m, "[%02d-%02d %02d:%02d:%02d][%5lu.%06lu] undefined event\n",
- rt->tm_mon, rt->tm_mday, rt->tm_hour, rt->tm_min, rt->tm_sec,
- (unsigned long)ts, rem_nsec / 1000);
- break;
- }
- }
- static int usblog_proc_show(struct seq_file *m, void *v)
- {
- struct usblog_buf *temp_usblog_buffer;
- struct usblog_vm_buf *temp_usblog_vm_buffer;
- struct usblog_rtc_buf *temp_usblog_rt_buffer;
- struct usblog_rtc_time rt;
- unsigned long long ts;
- unsigned long rem_nsec;
- unsigned long i;
- unsigned long flags = 0;
- spin_lock_irqsave(&usblog_root.usblog_lock, flags);
- temp_usblog_buffer = usblog_root.usblog_buffer;
- temp_usblog_vm_buffer = usblog_root.usblog_vm_buffer;
- temp_usblog_rt_buffer = usblog_root.usblog_rtc_buffer;
- if (!temp_usblog_buffer || !temp_usblog_vm_buffer || !temp_usblog_rt_buffer)
- goto err;
- usblog_get_rt(&rt);
- ts = local_clock();
- rem_nsec = do_div(ts, 1000000000);
- seq_printf(m,
- "time sync: [%02d-%02d %02d:%02d:%02d][%5lu.%06lu]\n",
- rt.tm_mon, rt.tm_mday, rt.tm_hour, rt.tm_min, rt.tm_sec,
- (unsigned long)ts, rem_nsec / 1000);
- seq_printf(m,
- "usblog CC IC info:\n");
- seq_printf(m,
- "tcpc name: %s\n", usblog_root.tcpc_name);
- seq_printf(m,
- "hw version =%2x %2x %2x %2x\n",
- usblog_root.ccic_ver.hw_version[3],
- usblog_root.ccic_ver.hw_version[2],
- usblog_root.ccic_ver.hw_version[1],
- usblog_root.ccic_ver.hw_version[0]);
- seq_printf(m,
- "sw version =%2x %2x %2x %2x\n",
- usblog_root.ccic_ver.sw_main[2],
- usblog_root.ccic_ver.sw_main[1],
- usblog_root.ccic_ver.sw_main[0],
- usblog_root.ccic_ver.sw_boot);
- seq_printf(m,
- "bin version =%2x %2x %2x %2x\n",
- usblog_root.ccic_bin_ver.sw_main[2],
- usblog_root.ccic_bin_ver.sw_main[1],
- usblog_root.ccic_bin_ver.sw_main[0],
- usblog_root.ccic_bin_ver.sw_boot);
- seq_printf(m,
- "\n\n");
- seq_printf(m,
- "usblog CCIC EVENT: count=%llu maxline=%d\n",
- temp_usblog_buffer->ccic_count,
- USBLOG_CCIC_BUFFER_SIZE);
- if (temp_usblog_buffer->ccic_count >= USBLOG_CCIC_BUFFER_SIZE) {
- for (i = temp_usblog_buffer->ccic_index;
- i < USBLOG_CCIC_BUFFER_SIZE; i++) {
- rt = temp_usblog_rt_buffer->ccic_buf_rt[i];
- ts = temp_usblog_buffer->ccic_buffer[i].ts_nsec;
- rem_nsec = do_div(ts, 1000000000);
- seq_printf(m, "[%02d-%02d %02d:%02d:%02d] ",
- rt.tm_mon, rt.tm_mday, rt.tm_hour, rt.tm_min, rt.tm_sec);
- print_ccic_event(m, ts, rem_nsec,
- temp_usblog_buffer->ccic_buffer[i].cc_type,
- &temp_usblog_buffer->ccic_buffer[i].noti);
- }
- }
- for (i = 0; i < temp_usblog_buffer->ccic_index; i++) {
- rt = temp_usblog_rt_buffer->ccic_buf_rt[i];
- ts = temp_usblog_buffer->ccic_buffer[i].ts_nsec;
- rem_nsec = do_div(ts, 1000000000);
- seq_printf(m, "[%02d-%02d %02d:%02d:%02d] ",
- rt.tm_mon, rt.tm_mday, rt.tm_hour, rt.tm_min, rt.tm_sec);
- print_ccic_event(m, ts, rem_nsec,
- temp_usblog_buffer->ccic_buffer[i].cc_type,
- &temp_usblog_buffer->ccic_buffer[i].noti);
- }
- seq_printf(m,
- "\n\n");
- seq_printf(m,
- "usblog USB_MODE: count=%llu maxline=%d\n",
- temp_usblog_buffer->mode_count,
- USBLOG_MODE_BUFFER_SIZE);
- if (temp_usblog_buffer->mode_count >= USBLOG_MODE_BUFFER_SIZE) {
- for (i = temp_usblog_buffer->mode_index;
- i < USBLOG_MODE_BUFFER_SIZE; i++) {
- rt = temp_usblog_rt_buffer->mode_buf_rt[i];
- ts = temp_usblog_buffer->mode_buffer[i].ts_nsec;
- rem_nsec = do_div(ts, 1000000000);
- seq_printf(m, "[%02d-%02d %02d:%02d:%02d] [%5lu.%06lu] %s\n",
- rt.tm_mon, rt.tm_mday, rt.tm_hour, rt.tm_min, rt.tm_sec,
- (unsigned long)ts, rem_nsec / 1000,
- temp_usblog_buffer->mode_buffer[i].usbmode_str);
- }
- }
- for (i = 0; i < temp_usblog_buffer->mode_index; i++) {
- rt = temp_usblog_rt_buffer->mode_buf_rt[i];
- ts = temp_usblog_buffer->mode_buffer[i].ts_nsec;
- rem_nsec = do_div(ts, 1000000000);
- seq_printf(m, "[%02d-%02d %02d:%02d:%02d] [%5lu.%06lu] %s\n",
- rt.tm_mon, rt.tm_mday, rt.tm_hour, rt.tm_min, rt.tm_sec,
- (unsigned long)ts, rem_nsec / 1000,
- temp_usblog_buffer->mode_buffer[i].usbmode_str);
- }
- seq_printf(m,
- "\n\n");
- seq_printf(m,
- "usblog USB STATE: count=%llu maxline=%d\n",
- temp_usblog_buffer->state_count,
- USBLOG_STATE_BUFFER_SIZE);
- if (temp_usblog_buffer->state_count >= USBLOG_STATE_BUFFER_SIZE) {
- for (i = temp_usblog_buffer->state_index;
- i < USBLOG_STATE_BUFFER_SIZE; i++) {
- rt = temp_usblog_rt_buffer->state_buf_rt[i];
- ts = temp_usblog_buffer->state_buffer[i].ts_nsec;
- rem_nsec = do_div(ts, 1000000000);
- seq_printf(m, "[%02d-%02d %02d:%02d:%02d] [%5lu.%06lu] %s\n",
- rt.tm_mon, rt.tm_mday, rt.tm_hour, rt.tm_min, rt.tm_sec,
- (unsigned long)ts, rem_nsec / 1000,
- usbstate_string(temp_usblog_buffer
- ->state_buffer[i].usbstate));
- }
- }
- for (i = 0; i < temp_usblog_buffer->state_index; i++) {
- rt = temp_usblog_rt_buffer->state_buf_rt[i];
- ts = temp_usblog_buffer->state_buffer[i].ts_nsec;
- rem_nsec = do_div(ts, 1000000000);
- seq_printf(m, "[%02d-%02d %02d:%02d:%02d] [%5lu.%06lu] %s\n",
- rt.tm_mon, rt.tm_mday, rt.tm_hour, rt.tm_min, rt.tm_sec,
- (unsigned long)ts, rem_nsec / 1000,
- usbstate_string(temp_usblog_buffer
- ->state_buffer[i].usbstate));
- }
- seq_printf(m,
- "\n\n");
- seq_printf(m,
- "usblog USB EVENT: count=%llu maxline=%d\n",
- temp_usblog_buffer->event_count,
- USBLOG_EVENT_BUFFER_SIZE);
- if (temp_usblog_buffer->event_count >= USBLOG_EVENT_BUFFER_SIZE) {
- for (i = temp_usblog_buffer->event_index;
- i < USBLOG_EVENT_BUFFER_SIZE; i++) {
- rt = temp_usblog_rt_buffer->event_buf_rt[i];
- ts = temp_usblog_buffer->event_buffer[i].ts_nsec;
- rem_nsec = do_div(ts, 1000000000);
- seq_printf(m, "[%02d-%02d %02d:%02d:%02d] [%5lu.%06lu] %s %s\n",
- rt.tm_mon, rt.tm_mday, rt.tm_hour, rt.tm_min, rt.tm_sec,
- (unsigned long)ts, rem_nsec / 1000,
- event_string(temp_usblog_buffer->event_buffer[i].event),
- status_string(temp_usblog_buffer
- ->event_buffer[i].enable));
- }
- }
- for (i = 0; i < temp_usblog_buffer->event_index; i++) {
- rt = temp_usblog_rt_buffer->event_buf_rt[i];
- ts = temp_usblog_buffer->event_buffer[i].ts_nsec;
- rem_nsec = do_div(ts, 1000000000);
- seq_printf(m, "[%02d-%02d %02d:%02d:%02d] [%5lu.%06lu] %s %s\n",
- rt.tm_mon, rt.tm_mday, rt.tm_hour, rt.tm_min, rt.tm_sec,
- (unsigned long)ts, rem_nsec / 1000,
- event_string(temp_usblog_buffer->event_buffer[i].event),
- status_string(temp_usblog_buffer->event_buffer[i].enable));
- }
- seq_printf(m,
- "\n\n");
- seq_printf(m,
- "usblog PORT: count=%llu maxline=%d\n",
- temp_usblog_buffer->port_count,
- USBLOG_PORT_BUFFER_SIZE);
- if (temp_usblog_buffer->port_count >= USBLOG_PORT_BUFFER_SIZE) {
- for (i = temp_usblog_buffer->port_index;
- i < USBLOG_PORT_BUFFER_SIZE; i++) {
- rt = temp_usblog_rt_buffer->port_buf_rt[i];
- ts = temp_usblog_buffer->port_buffer[i].ts_nsec;
- rem_nsec = do_div(ts, 1000000000);
- seq_printf(m, "[%02d-%02d %02d:%02d:%02d] ",
- rt.tm_mon, rt.tm_mday, rt.tm_hour, rt.tm_min, rt.tm_sec);
- print_port_string(m, ts, rem_nsec,
- temp_usblog_buffer->port_buffer[i].type,
- temp_usblog_buffer->port_buffer[i].param1,
- temp_usblog_buffer->port_buffer[i].param2,
- temp_usblog_buffer->port_buffer[i].count);
- }
- }
- for (i = 0; i < temp_usblog_buffer->port_index; i++) {
- rt = temp_usblog_rt_buffer->port_buf_rt[i];
- ts = temp_usblog_buffer->port_buffer[i].ts_nsec;
- rem_nsec = do_div(ts, 1000000000);
- seq_printf(m, "[%02d-%02d %02d:%02d:%02d] ",
- rt.tm_mon, rt.tm_mday, rt.tm_hour, rt.tm_min, rt.tm_sec);
- print_port_string(m, ts, rem_nsec,
- temp_usblog_buffer->port_buffer[i].type,
- temp_usblog_buffer->port_buffer[i].param1,
- temp_usblog_buffer->port_buffer[i].param2,
- temp_usblog_buffer->port_buffer[i].count);
- }
- seq_printf(m,
- "\n\n");
- seq_printf(m,
- "usblog PCM: count=%llu maxline=%d\n",
- temp_usblog_vm_buffer->pcm_count,
- USBLOG_PCM_BUFFER_SIZE);
- if (temp_usblog_vm_buffer->pcm_count >= USBLOG_PCM_BUFFER_SIZE) {
- for (i = temp_usblog_vm_buffer->pcm_index;
- i < USBLOG_PCM_BUFFER_SIZE; i++) {
- ts = temp_usblog_vm_buffer->pcm_buffer[i].ts_nsec;
- rem_nsec = do_div(ts, 1000000000);
- print_pcm_string(m, &temp_usblog_vm_buffer->pcm_buffer[i].rt,
- ts, rem_nsec,
- temp_usblog_vm_buffer->pcm_buffer[i].type,
- temp_usblog_vm_buffer->pcm_buffer[i].enable);
- }
- }
- for (i = 0; i < temp_usblog_vm_buffer->pcm_index; i++) {
- ts = temp_usblog_vm_buffer->pcm_buffer[i].ts_nsec;
- rem_nsec = do_div(ts, 1000000000);
- print_pcm_string(m, &temp_usblog_vm_buffer->pcm_buffer[i].rt,
- ts, rem_nsec,
- temp_usblog_vm_buffer->pcm_buffer[i].type,
- temp_usblog_vm_buffer->pcm_buffer[i].enable);
- }
- seq_printf(m,
- "\n\n");
- seq_printf(m,
- "usblog EXTRA: count=%llu maxline=%d\n",
- temp_usblog_buffer->extra_count,
- USBLOG_EXTRA_BUFFER_SIZE);
- if (temp_usblog_buffer->extra_count >= USBLOG_EXTRA_BUFFER_SIZE) {
- for (i = temp_usblog_buffer->extra_index;
- i < USBLOG_EXTRA_BUFFER_SIZE; i++) {
- rt = temp_usblog_rt_buffer->extra_buf_rt[i];
- ts = temp_usblog_buffer->extra_buffer[i].ts_nsec;
- rem_nsec = do_div(ts, 1000000000);
- seq_printf(m, "[%02d-%02d %02d:%02d:%02d] [%5lu.%06lu] %s\n",
- rt.tm_mon, rt.tm_mday, rt.tm_hour, rt.tm_min, rt.tm_sec,
- (unsigned long)ts, rem_nsec / 1000,
- extra_string(temp_usblog_buffer
- ->extra_buffer[i].event));
- }
- }
- for (i = 0; i < temp_usblog_buffer->extra_index; i++) {
- rt = temp_usblog_rt_buffer->extra_buf_rt[i];
- ts = temp_usblog_buffer->extra_buffer[i].ts_nsec;
- rem_nsec = do_div(ts, 1000000000);
- seq_printf(m, "[%02d-%02d %02d:%02d:%02d] [%5lu.%06lu] %s\n",
- rt.tm_mon, rt.tm_mday, rt.tm_hour, rt.tm_min, rt.tm_sec,
- (unsigned long)ts, rem_nsec / 1000,
- extra_string(temp_usblog_buffer->extra_buffer[i].event));
- }
- seq_printf(m,
- "\n\n");
- pr_info("%s boot_idx=%lu, usb_idx=%lu, usb_tail=%lu, b_full=%d, u_full=%d\n",
- __func__,
- usblog_root.prk_usb.usb_boot_index, usblog_root.prk_usb.usb_index,
- usblog_root.prk_usb.usb_tail, usblog_root.prk_usb.usb_boot_full,
- usblog_root.prk_usb.usb_full);
- seq_printf(m,
- "printk_usb boot:\n");
- seq_write(m, printk_usb_boot_buf, usblog_root.prk_usb.usb_boot_index);
- seq_printf(m,
- "\n\n");
- seq_printf(m,
- "printk_usb_snapshot:\n");
- if (usblog_root.prk_usb.snap_done) {
- if (usblog_root.prk_usb.usb_snap_full)
- seq_write(m, printk_usb_snap_buf + usblog_root.prk_usb.usb_snap_index,
- usblog_root.prk_usb.usb_snap_tail - usblog_root.prk_usb.usb_snap_index);
- seq_write(m, printk_usb_snap_buf, usblog_root.prk_usb.usb_snap_index);
- }
- seq_printf(m,
- "\n\n");
- seq_printf(m,
- "printk_usb:\n");
- if (usblog_root.prk_usb.usb_full)
- seq_write(m, printk_usb_buf + usblog_root.prk_usb.usb_index,
- usblog_root.prk_usb.usb_tail - usblog_root.prk_usb.usb_index);
- if (usblog_root.prk_usb.usb_boot_full)
- seq_write(m, printk_usb_buf, usblog_root.prk_usb.usb_index);
- err:
- spin_unlock_irqrestore(&usblog_root.usblog_lock, flags);
- return 0;
- }
- static int usblog_proc_open(struct inode *inode, struct file *file)
- {
- return single_open(file, usblog_proc_show, NULL);
- }
- static const struct proc_ops usblog_proc_fops = {
- .proc_open = usblog_proc_open,
- .proc_read = seq_read,
- .proc_lseek = seq_lseek,
- .proc_release = single_release,
- };
- void ccic_store_usblog_notify(int type, uint64_t *param1)
- {
- struct ccic_buf *ccic_buffer;
- struct usblog_rtc_time *ccic_rtc;
- unsigned long long *target_count;
- unsigned long *target_index;
- target_count = &usblog_root.usblog_buffer->ccic_count;
- target_index = &usblog_root.usblog_buffer->ccic_index;
- ccic_buffer = &usblog_root.usblog_buffer->ccic_buffer[*target_index];
- ccic_rtc = &usblog_root.usblog_rtc_buffer->ccic_buf_rt[*target_index];
- if (ccic_buffer == NULL) {
- unl_err("%s target_buffer error\n", __func__);
- goto err;
- }
- usblog_get_rt(ccic_rtc);
- ccic_buffer->ts_nsec = local_clock();
- ccic_buffer->cc_type = type;
- ccic_buffer->noti = *param1;
- *target_index = (*target_index+1)%USBLOG_CCIC_BUFFER_SIZE;
- (*target_count)++;
- err:
- return;
- }
- void mode_store_usblog_notify(int type, char *param1)
- {
- struct mode_buf *md_buffer;
- struct usblog_rtc_time *mode_rtc;
- unsigned long long *target_count;
- unsigned long *target_index;
- char buf[256], buf2[4];
- char *b, *name;
- int param_len;
- target_count = &usblog_root.usblog_buffer->mode_count;
- target_index = &usblog_root.usblog_buffer->mode_index;
- md_buffer = &usblog_root.usblog_buffer->mode_buffer[*target_index];
- mode_rtc = &usblog_root.usblog_rtc_buffer->mode_buf_rt[*target_index];
- if (md_buffer == NULL) {
- unl_err("%s target_buffer error\n", __func__);
- goto err;
- }
- usblog_get_rt(mode_rtc);
- md_buffer->ts_nsec = local_clock();
- strscpy(buf, param1, sizeof(buf));
- b = strim(buf);
- if (type == NOTIFY_USBMODE_EXTRA) {
- param_len = strlen(b);
- if (param_len >= USBLOG_MAX_STRING_SIZE)
- param_len = USBLOG_MAX_STRING_SIZE-1;
- strncpy(md_buffer->usbmode_str, b,
- sizeof(md_buffer->usbmode_str)-1);
- } else if (type == NOTIFY_USBMODE) {
- if (b) {
- name = strsep(&b, ",");
- strscpy(buf2, name, sizeof(buf2));
- strncpy(md_buffer->usbmode_str, buf2,
- sizeof(md_buffer->usbmode_str)-1);
- }
- while (b) {
- name = strsep(&b, ",");
- if (!name)
- continue;
- if (USBLOG_MAX_STRING_SIZE
- - strlen(md_buffer->usbmode_str) < 5) {
- strncpy(md_buffer->usbmode_str, "overflow",
- sizeof(md_buffer->usbmode_str)-1);
- b = NULL;
- } else {
- strncat(md_buffer->usbmode_str, ",", 1);
- strncat(md_buffer->usbmode_str, name, 3);
- }
- }
- }
- *target_index = (*target_index+1)%USBLOG_MODE_BUFFER_SIZE;
- (*target_count)++;
- err:
- return;
- }
- void state_store_usblog_notify(int type, char *param1)
- {
- struct state_buf *st_buffer;
- struct usblog_rtc_time *state_rtc;
- unsigned long long *target_count;
- unsigned long *target_index;
- char buf[256], index, index2, index3;
- char *b, *name;
- int usbstate = 0;
- target_count = &usblog_root.usblog_buffer->state_count;
- target_index = &usblog_root.usblog_buffer->state_index;
- st_buffer = &usblog_root.usblog_buffer->state_buffer[*target_index];
- state_rtc = &usblog_root.usblog_rtc_buffer->state_buf_rt[*target_index];
- if (st_buffer == NULL) {
- unl_err("%s target_buffer error\n", __func__);
- goto err;
- }
- usblog_get_rt(state_rtc);
- st_buffer->ts_nsec = local_clock();
- strscpy(buf, param1, sizeof(buf));
- b = strim(buf);
- name = strsep(&b, "=");
- index = *(b+USBLOG_CMP_INDEX);
- switch (index) {
- case 'F': /* CONFIGURED */
- usbstate = NOTIFY_CONFIGURED;
- break;
- case 'N': /* CONNECTED */
- usbstate = NOTIFY_CONNECTED;
- break;
- case 'C': /* DISCONNECTED */
- usbstate = NOTIFY_DISCONNECTED;
- break;
- case 'E': /* RESET */
- name = strsep(&b, ":");
- if (b) {
- index2 = *b;
- switch (index2) {
- case 'F': /* FULL SPEED */
- usbstate = NOTIFY_RESET_FULL;
- break;
- case 'H': /* HIGH SPEED */
- usbstate = NOTIFY_RESET_HIGH;
- break;
- case 'S': /* SUPER SPEED */
- usbstate = NOTIFY_RESET_SUPER;
- break;
- default:
- usbstate = NOTIFY_RESET;
- break;
- }
- } else
- usbstate = NOTIFY_RESET;
- break;
- case 'L': /* GADGET PULL UP/DN */
- name = strsep(&b, ":");
- if (b) {
- index2 = *b;
- name = strsep(&b, ":");
- if (b)
- index3 = *b;
- else /* X means none */
- index3 = 'X';
- } else /* X means none */
- index2 = 'X';
- switch (index2) {
- case 'E': /* VBUS SESSION ENABLE */
- if (index3 == 'S')
- usbstate = NOTIFY_PULLUP_EN_SUCCESS;
- else if (index3 == 'F')
- usbstate = NOTIFY_PULLUP_EN_FAIL;
- else
- usbstate = NOTIFY_PULLUP_ENABLE;
- break;
- case 'D': /* VBUS SESSION DISABLE */
- if (index3 == 'S')
- usbstate = NOTIFY_PULLUP_DIS_SUCCESS;
- else if (index3 == 'F')
- usbstate = NOTIFY_PULLUP_DIS_FAIL;
- else
- usbstate = NOTIFY_PULLUP_DISABLE;
- break;
- default:
- usbstate = NOTIFY_PULLUP;
- break;
- }
- break;
- case 'R': /* ACCESSORY START */
- usbstate = NOTIFY_ACCSTART;
- break;
- case 'S': /* GADGET_VBUS EN/DN*/
- name = strsep(&b, ":");
- if (b) {
- index2 = *b;
- name = strsep(&b, ":");
- if (b)
- index3 = *b;
- else /* X means none */
- index3 = 'X';
- } else /* X means none */
- index2 = 'X';
- switch (index2) {
- case 'E': /* VBUS SESSION ENABLE */
- if (index3 == 'S')
- usbstate = NOTIFY_VBUS_EN_SUCCESS;
- else if (index3 == 'F')
- usbstate = NOTIFY_VBUS_EN_FAIL;
- else
- usbstate = NOTIFY_VBUS_SESSION_ENABLE;
- break;
- case 'D': /* VBUS SESSION DISABLE */
- if (index3 == 'S')
- usbstate = NOTIFY_VBUS_DIS_SUCCESS;
- else if (index3 == 'F')
- usbstate = NOTIFY_VBUS_DIS_FAIL;
- else
- usbstate = NOTIFY_VBUS_SESSION_DISABLE;
- break;
- default:
- usbstate = NOTIFY_VBUS_SESSION;
- break;
- }
- break;
- case 'D': /* SUPER SPEED */
- usbstate = NOTIFY_SUPER;
- break;
- case 'H': /*HIGH SPEED */
- usbstate = NOTIFY_HIGH;
- break;
- case 'M': /* USB ENUMERATION */
- name = strsep(&b, ":");
- if (b) {
- index2 = *b;
- name = strsep(&b, ":");
- if (b)
- index3 = *b;
- else /* X means none */
- index3 = 'X';
- } else /* X means none */
- index2 = 'X';
- switch (index2) {
- case 'C': /* CONNDONE */
- if (index3 == 'P') /* SUPERSPEED_PLUS */
- usbstate = NOTIFY_CONNDONE_SSP;
- else if (index3 == 'S') /* SUPERSPEED */
- usbstate = NOTIFY_CONNDONE_SS;
- else if (index3 == 'H') /* HIGHSPEED */
- usbstate = NOTIFY_CONNDONE_HS;
- else if (index3 == 'F') /* FULLSPEED */
- usbstate = NOTIFY_CONNDONE_FS;
- else if (index3 == 'L') /* LOWSPEED */
- usbstate = NOTIFY_CONNDONE_LS;
- break;
- case 'G': /* GET */
- if (index3 == 'D') /* GET_DES */
- usbstate = NOTIFY_GET_DES;
- break;
- case 'S': /* SET */
- if (index3 == 'C') /* SET_CON */
- usbstate = NOTIFY_SET_CON;
- break;
- default:
- break;
- }
- break;
- default:
- unl_err("%s state param error. state=%s\n", __func__, param1);
- goto err;
- }
- st_buffer->usbstate = usbstate;
- *target_index = (*target_index+1)%USBLOG_STATE_BUFFER_SIZE;
- (*target_count)++;
- err:
- return;
- }
- void event_store_usblog_notify(int type, unsigned long *param1, int *param2)
- {
- struct event_buf *ev_buffer;
- struct usblog_rtc_time *event_rtc;
- unsigned long long *target_count;
- unsigned long *target_index;
- target_count = &usblog_root.usblog_buffer->event_count;
- target_index = &usblog_root.usblog_buffer->event_index;
- ev_buffer = &usblog_root.usblog_buffer->event_buffer[*target_index];
- event_rtc = &usblog_root.usblog_rtc_buffer->event_buf_rt[*target_index];
- if (ev_buffer == NULL) {
- unl_err("%s target_buffer error\n", __func__);
- goto err;
- }
- usblog_get_rt(event_rtc);
- ev_buffer->ts_nsec = local_clock();
- ev_buffer->event = *param1;
- ev_buffer->enable = *param2;
- *target_index = (*target_index+1)%USBLOG_EVENT_BUFFER_SIZE;
- (*target_count)++;
- err:
- return;
- }
- void port_store_usblog_notify(int type, void *param1, void *param2)
- {
- struct port_buf *pt_buffer;
- struct usblog_rtc_time *port_rtc;
- unsigned long long *target_count;
- unsigned long *target_index;
- target_count = &usblog_root.usblog_buffer->port_count;
- target_index = &usblog_root.usblog_buffer->port_index;
- pt_buffer = &usblog_root.usblog_buffer->port_buffer[*target_index];
- port_rtc = &usblog_root.usblog_rtc_buffer->port_buf_rt[*target_index];
- if (pt_buffer == NULL) {
- unl_err("%s target_buffer error\n", __func__);
- goto err;
- }
- usblog_get_rt(port_rtc);
- pt_buffer->ts_nsec = local_clock();
- pt_buffer->type = type;
- if (type == NOTIFY_PORT_CONNECT) {
- pt_buffer->param1 = le16_to_cpu(*(__le16 *)(param1));
- pt_buffer->param2 = le16_to_cpu(*(__le16 *)(param2));
- pt_buffer->count
- = set_port_count(pt_buffer->param1, pt_buffer->param2);
- } else if (type == NOTIFY_PORT_DISCONNECT) {
- pt_buffer->param1 = le16_to_cpu(*(__le16 *)(param1));
- pt_buffer->param2 = le16_to_cpu(*(__le16 *)(param2));
- } else {
- pt_buffer->param1 = (uint16_t)(*(__u8 *)(param1));
- pt_buffer->param2 = (uint16_t)(*(__u8 *)(param2));
- }
- *target_index = (*target_index+1)%USBLOG_PORT_BUFFER_SIZE;
- (*target_count)++;
- err:
- return;
- }
- void pcm_store_usblog_notify(int type, int *param1)
- {
- struct pcm_buf *pcm_buffer;
- unsigned long long *target_count;
- unsigned long *target_index;
- target_count = &usblog_root.usblog_vm_buffer->pcm_count;
- target_index = &usblog_root.usblog_vm_buffer->pcm_index;
- pcm_buffer = &usblog_root.usblog_vm_buffer->pcm_buffer[*target_index];
- if (pcm_buffer == NULL) {
- unl_err("%s target_buffer error\n", __func__);
- goto err;
- }
- usblog_get_rt(&pcm_buffer->rt);
- pcm_buffer->ts_nsec = local_clock();
- pcm_buffer->type = type;
- pcm_buffer->enable = *param1;
- *target_index = (*target_index+1)%USBLOG_PCM_BUFFER_SIZE;
- (*target_count)++;
- err:
- return;
- }
- void extra_store_usblog_notify(int type, int *param1)
- {
- struct extra_buf *ex_buffer;
- struct usblog_rtc_time *extra_rtc;
- unsigned long long *target_count;
- unsigned long *target_index;
- target_count = &usblog_root.usblog_buffer->extra_count;
- target_index = &usblog_root.usblog_buffer->extra_index;
- ex_buffer = &usblog_root.usblog_buffer->extra_buffer[*target_index];
- extra_rtc = &usblog_root.usblog_rtc_buffer->extra_buf_rt[*target_index];
- if (ex_buffer == NULL) {
- unl_err("%s target_buffer error\n", __func__);
- goto err;
- }
- usblog_get_rt(extra_rtc);
- ex_buffer->ts_nsec = local_clock();
- ex_buffer->event = *param1;
- *target_index = (*target_index+1)%USBLOG_EXTRA_BUFFER_SIZE;
- (*target_count)++;
- err:
- return;
- }
- void store_usblog_notify(int type, void *param1, void *param2)
- {
- unsigned long flags = 0;
- uint64_t temp = 0;
- if (!usblog_root.init)
- register_usblog_proc();
- spin_lock_irqsave(&usblog_root.usblog_lock, flags);
- if (!usblog_root.usblog_buffer) {
- unl_err("%s usblog_buffer is null\n", __func__);
- spin_unlock_irqrestore(&usblog_root.usblog_lock, flags);
- return;
- }
- if (!usblog_root.usblog_vm_buffer) {
- unl_err("%s usblog_vm_buffer is null\n", __func__);
- spin_unlock_irqrestore(&usblog_root.usblog_lock, flags);
- return;
- }
- if (type == NOTIFY_FUNCSTATE || type == NOTIFY_TCPMSTATE
- || type == NOTIFY_ALTERNATEMODE) {
- temp = *(int *)param1;
- ccic_store_usblog_notify(type, &temp);
- } else if (type == NOTIFY_CCSTATE || type == NOTIFY_CCIC_EVENT
- || type == NOTIFY_MANAGER)
- ccic_store_usblog_notify(type, (uint64_t *)param1);
- else if (type == NOTIFY_EVENT)
- event_store_usblog_notify(type,
- (unsigned long *)param1, (int *)param2);
- else if (type == NOTIFY_USBMODE
- || type == NOTIFY_USBMODE_EXTRA)
- mode_store_usblog_notify(type, (char *)param1);
- else if (type == NOTIFY_USBSTATE)
- state_store_usblog_notify(type, (char *)param1);
- else if (type == NOTIFY_PORT_CONNECT ||
- type == NOTIFY_PORT_DISCONNECT ||
- type == NOTIFY_PORT_CLASS ||
- type == NOTIFY_PORT_CLASS_BLOCK)
- port_store_usblog_notify(type, param1, param2);
- else if (type == NOTIFY_PCM_PLAYBACK ||
- type == NOTIFY_PCM_CAPTURE)
- pcm_store_usblog_notify(type, (int *)param1);
- else if (type == NOTIFY_EXTRA)
- extra_store_usblog_notify(type, (int *)param1);
- else
- unl_err("%s type error %d\n", __func__, type);
- spin_unlock_irqrestore(&usblog_root.usblog_lock, flags);
- }
- EXPORT_SYMBOL(store_usblog_notify);
- void store_ccic_version(unsigned char *hw, unsigned char *sw_main,
- unsigned char *sw_boot)
- {
- if (!hw || !sw_main || !sw_boot) {
- unl_err("%s null buffer\n", __func__);
- return;
- }
- memcpy(&usblog_root.ccic_ver.hw_version, hw, 4);
- memcpy(&usblog_root.ccic_ver.sw_main, sw_main, 3);
- memcpy(&usblog_root.ccic_ver.sw_boot, sw_boot, 1);
- }
- EXPORT_SYMBOL(store_ccic_version);
- void store_ccic_bin_version(const unsigned char *sw_main,
- const unsigned char *sw_boot)
- {
- if (!sw_main || !sw_boot) {
- unl_err("%s null buffer\n", __func__);
- return;
- }
- memcpy(&usblog_root.ccic_bin_ver.sw_main, sw_main, 3);
- memcpy(&usblog_root.ccic_bin_ver.sw_boot, sw_boot, 1);
- }
- EXPORT_SYMBOL(store_ccic_bin_version);
- void store_tcpc_name(char *name)
- {
- strncpy(usblog_root.tcpc_name, name,
- sizeof(usblog_root.tcpc_name)-1);
- }
- EXPORT_SYMBOL(store_tcpc_name);
- unsigned long long show_ccic_version(void)
- {
- unsigned long long ret = 0;
- memcpy(&ret, &usblog_root.ccic_ver, sizeof(unsigned long long));
- return ret;
- }
- EXPORT_SYMBOL(show_ccic_version);
- void printk_usb(int snapshot, char *fmt, ...)
- {
- struct usblog_rtc_time rt;
- unsigned long long ts;
- unsigned long rem_nsec;
- char buf[PRINTK_USB_MAX_STRING_SIZE] = {0,};
- int len = 0;
- va_list args;
- bool *boot_full, *usb_full;
- unsigned long *boot_index, *usb_index;
- unsigned long flags = 0;
- if (!usblog_root.init) {
- pr_err("%s usblog_root.init is null\n", __func__);
- return;
- }
- spin_lock_irqsave(&usblog_root.usblog_lock, flags);
- boot_full = &usblog_root.prk_usb.usb_boot_full;
- boot_index = &usblog_root.prk_usb.usb_boot_index;
- usb_full = &usblog_root.prk_usb.usb_full;
- usb_index = &usblog_root.prk_usb.usb_index;
- usblog_get_rt(&rt);
- ts = local_clock();
- rem_nsec = do_div(ts, 1000000000);
- len = snprintf(buf, sizeof(buf), "[%02d-%02d %02d:%02d:%02d][%5lu.%06lu] ",
- rt.tm_mon, rt.tm_mday, rt.tm_hour, rt.tm_min, rt.tm_sec,
- (unsigned long)ts, rem_nsec / 1000);
- va_start(args, fmt);
- len += vscnprintf(buf + len, PRINTK_USB_MAX_STRING_SIZE - len, fmt, args);
- va_end(args);
- if (*boot_full == false) {
- if (*boot_index + len + 1 > PRINTK_USB_BOOT_BUF_SIZE) {
- *boot_full = true;
- *usb_index = scnprintf(printk_usb_buf, len + 1, "%s", buf);
- } else {
- *boot_index += scnprintf(printk_usb_boot_buf + *boot_index,
- len + 1, "%s", buf);
- }
- } else {
- if (*usb_index + len + 1 > PRINTK_USB_BUF_SIZE) {
- usblog_root.prk_usb.usb_tail = *usb_index;
- memset(printk_usb_buf + *usb_index, 0, PRINTK_USB_BUF_SIZE - *usb_index);
- *usb_index = scnprintf(printk_usb_buf, len + 1, "%s", buf);
- if (*usb_index > usblog_root.prk_usb.usb_tail)
- usblog_root.prk_usb.usb_tail = *usb_index;
- *usb_full = true;
- } else {
- *usb_index += scnprintf(printk_usb_buf + *usb_index,
- len + 1, "%s", buf);
- if (*usb_index > usblog_root.prk_usb.usb_tail)
- usblog_root.prk_usb.usb_tail = *usb_index;
- }
- }
- if (*boot_full && snapshot && !usblog_root.prk_usb.snap_done) {
- memcpy(printk_usb_snap_buf, printk_usb_buf, PRINTK_USB_BUF_SIZE);
- if (*usb_full) {
- usblog_root.prk_usb.usb_snap_full = true;
- usblog_root.prk_usb.usb_snap_tail = usblog_root.prk_usb.usb_tail;
- }
- usblog_root.prk_usb.usb_snap_index = *usb_index;
- usblog_root.prk_usb.snap_done = true;
- pr_info("%s snapshot done!\n", __func__);
- }
- spin_unlock_irqrestore(&usblog_root.usblog_lock, flags);
- }
- EXPORT_SYMBOL(printk_usb);
- int register_usblog_proc(void)
- {
- int ret = 0;
- if (usblog_root.init) {
- pr_err("%s already registered\n", __func__);
- goto skip;
- }
- spin_lock_init(&usblog_root.usblog_lock);
- usblog_root.usblog_index = USBLOG_INDEX;
- usblog_root.init = 1;
- proc_create("usblog", 0444, NULL, &usblog_proc_fops);
- usblog_root.usblog_buffer
- = kzalloc(sizeof(struct usblog_buf), GFP_KERNEL);
- if (!usblog_root.usblog_buffer) {
- ret = -ENOMEM;
- goto err;
- }
- usblog_root.usblog_rtc_buffer = vzalloc(sizeof(struct usblog_rtc_buf));
- if (!usblog_root.usblog_rtc_buffer) {
- ret = -ENOMEM;
- goto err1;
- } else
- pr_info("usb: %s: usblog_root.usblog_rtc_buffer = %zu\n",
- __func__, sizeof(struct usblog_rtc_buf));
- usblog_root.usblog_vm_buffer
- = vzalloc(sizeof(struct usblog_vm_buf));
- if (!usblog_root.usblog_vm_buffer) {
- ret = -ENOMEM;
- goto err2;
- }
- unl_info("%s size=%zu\n", __func__, sizeof(struct usblog_buf));
- skip:
- return ret;
- err2:
- vfree(usblog_root.usblog_rtc_buffer);
- usblog_root.usblog_rtc_buffer = NULL;
- err1:
- kfree(usblog_root.usblog_buffer);
- usblog_root.usblog_buffer = NULL;
- err:
- remove_proc_entry("usblog", NULL);
- usblog_root.init = 0;
- pr_err("%s error\n", __func__);
- return ret;
- }
- EXPORT_SYMBOL(register_usblog_proc);
- void unregister_usblog_proc(void)
- {
- vfree(usblog_root.usblog_rtc_buffer);
- usblog_root.usblog_rtc_buffer = NULL;
- vfree(usblog_root.usblog_vm_buffer);
- usblog_root.usblog_vm_buffer = NULL;
- kfree(usblog_root.usblog_buffer);
- usblog_root.usblog_buffer = NULL;
- remove_proc_entry("usblog", NULL);
- usblog_root.init = 0;
- }
- EXPORT_SYMBOL(unregister_usblog_proc);
|