12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286 |
- /*
- * arch/s390/kernel/debug.c
- * S/390 debug facility
- *
- * Copyright (C) 1999, 2000 IBM Deutschland Entwicklung GmbH,
- * IBM Corporation
- * Author(s): Michael Holzheu (holzheu@de.ibm.com),
- * Holger Smolinski (Holger.Smolinski@de.ibm.com)
- *
- * Bugreports to: <Linux390@de.ibm.com>
- */
- #include <linux/config.h>
- #include <linux/stddef.h>
- #include <linux/kernel.h>
- #include <linux/errno.h>
- #include <linux/slab.h>
- #include <linux/ctype.h>
- #include <linux/sysctl.h>
- #include <asm/uaccess.h>
- #include <asm/semaphore.h>
- #include <linux/module.h>
- #include <linux/init.h>
- #include <asm/debug.h>
- #define DEBUG_PROLOG_ENTRY -1
- /* typedefs */
- typedef struct file_private_info {
- loff_t offset; /* offset of last read in file */
- int act_area; /* number of last formated area */
- int act_entry; /* last formated entry (offset */
- /* relative to beginning of last */
- /* formated area) */
- size_t act_entry_offset; /* up to this offset we copied */
- /* in last read the last formated */
- /* entry to userland */
- char temp_buf[2048]; /* buffer for output */
- debug_info_t *debug_info_org; /* original debug information */
- debug_info_t *debug_info_snap; /* snapshot of debug information */
- struct debug_view *view; /* used view of debug info */
- } file_private_info_t;
- typedef struct
- {
- char *string;
- /*
- * This assumes that all args are converted into longs
- * on L/390 this is the case for all types of parameter
- * except of floats, and long long (32 bit)
- *
- */
- long args[0];
- } debug_sprintf_entry_t;
- extern void tod_to_timeval(uint64_t todval, struct timeval *xtime);
- /* internal function prototyes */
- static int debug_init(void);
- static ssize_t debug_output(struct file *file, char __user *user_buf,
- size_t user_len, loff_t * offset);
- static ssize_t debug_input(struct file *file, const char __user *user_buf,
- size_t user_len, loff_t * offset);
- static int debug_open(struct inode *inode, struct file *file);
- static int debug_close(struct inode *inode, struct file *file);
- static debug_info_t* debug_info_create(char *name, int page_order, int nr_areas, int buf_size);
- static void debug_info_get(debug_info_t *);
- static void debug_info_put(debug_info_t *);
- static int debug_prolog_level_fn(debug_info_t * id,
- struct debug_view *view, char *out_buf);
- static int debug_input_level_fn(debug_info_t * id, struct debug_view *view,
- struct file *file, const char __user *user_buf,
- size_t user_buf_size, loff_t * offset);
- static int debug_input_flush_fn(debug_info_t * id, struct debug_view *view,
- struct file *file, const char __user *user_buf,
- size_t user_buf_size, loff_t * offset);
- static int debug_hex_ascii_format_fn(debug_info_t * id, struct debug_view *view,
- char *out_buf, const char *in_buf);
- static int debug_raw_format_fn(debug_info_t * id,
- struct debug_view *view, char *out_buf,
- const char *in_buf);
- static int debug_raw_header_fn(debug_info_t * id, struct debug_view *view,
- int area, debug_entry_t * entry, char *out_buf);
- static int debug_sprintf_format_fn(debug_info_t * id, struct debug_view *view,
- char *out_buf, debug_sprintf_entry_t *curr_event);
- /* globals */
- struct debug_view debug_raw_view = {
- "raw",
- NULL,
- &debug_raw_header_fn,
- &debug_raw_format_fn,
- NULL,
- NULL
- };
- struct debug_view debug_hex_ascii_view = {
- "hex_ascii",
- NULL,
- &debug_dflt_header_fn,
- &debug_hex_ascii_format_fn,
- NULL,
- NULL
- };
- struct debug_view debug_level_view = {
- "level",
- &debug_prolog_level_fn,
- NULL,
- NULL,
- &debug_input_level_fn,
- NULL
- };
- struct debug_view debug_flush_view = {
- "flush",
- NULL,
- NULL,
- NULL,
- &debug_input_flush_fn,
- NULL
- };
- struct debug_view debug_sprintf_view = {
- "sprintf",
- NULL,
- &debug_dflt_header_fn,
- (debug_format_proc_t*)&debug_sprintf_format_fn,
- NULL,
- NULL
- };
- unsigned int debug_feature_version = __DEBUG_FEATURE_VERSION;
- /* static globals */
- static debug_info_t *debug_area_first = NULL;
- static debug_info_t *debug_area_last = NULL;
- DECLARE_MUTEX(debug_lock);
- static int initialized;
- static struct file_operations debug_file_ops = {
- .owner = THIS_MODULE,
- .read = debug_output,
- .write = debug_input,
- .open = debug_open,
- .release = debug_close,
- };
- static struct proc_dir_entry *debug_proc_root_entry;
- /* functions */
- /*
- * debug_info_alloc
- * - alloc new debug-info
- */
- static debug_info_t* debug_info_alloc(char *name, int page_order,
- int nr_areas, int buf_size)
- {
- debug_info_t* rc;
- int i;
- /* alloc everything */
- rc = (debug_info_t*) kmalloc(sizeof(debug_info_t), GFP_ATOMIC);
- if(!rc)
- goto fail_malloc_rc;
- rc->active_entry = (int*)kmalloc(nr_areas * sizeof(int), GFP_ATOMIC);
- if(!rc->active_entry)
- goto fail_malloc_active_entry;
- memset(rc->active_entry, 0, nr_areas * sizeof(int));
- rc->areas = (debug_entry_t **) kmalloc(nr_areas *
- sizeof(debug_entry_t *),
- GFP_ATOMIC);
- if (!rc->areas)
- goto fail_malloc_areas;
- for (i = 0; i < nr_areas; i++) {
- rc->areas[i] = (debug_entry_t *) __get_free_pages(GFP_ATOMIC,
- page_order);
- if (!rc->areas[i]) {
- for (i--; i >= 0; i--) {
- free_pages((unsigned long) rc->areas[i],
- page_order);
- }
- goto fail_malloc_areas2;
- } else {
- memset(rc->areas[i], 0, PAGE_SIZE << page_order);
- }
- }
- /* initialize members */
- spin_lock_init(&rc->lock);
- rc->page_order = page_order;
- rc->nr_areas = nr_areas;
- rc->active_area = 0;
- rc->level = DEBUG_DEFAULT_LEVEL;
- rc->buf_size = buf_size;
- rc->entry_size = sizeof(debug_entry_t) + buf_size;
- strlcpy(rc->name, name, sizeof(rc->name));
- memset(rc->views, 0, DEBUG_MAX_VIEWS * sizeof(struct debug_view *));
- #ifdef CONFIG_PROC_FS
- memset(rc->proc_entries, 0 ,DEBUG_MAX_VIEWS *
- sizeof(struct proc_dir_entry*));
- #endif /* CONFIG_PROC_FS */
- atomic_set(&(rc->ref_count), 0);
- return rc;
- fail_malloc_areas2:
- kfree(rc->areas);
- fail_malloc_areas:
- kfree(rc->active_entry);
- fail_malloc_active_entry:
- kfree(rc);
- fail_malloc_rc:
- return NULL;
- }
- /*
- * debug_info_free
- * - free memory debug-info
- */
- static void debug_info_free(debug_info_t* db_info){
- int i;
- for (i = 0; i < db_info->nr_areas; i++) {
- free_pages((unsigned long) db_info->areas[i],
- db_info->page_order);
- }
- kfree(db_info->areas);
- kfree(db_info->active_entry);
- kfree(db_info);
- }
- /*
- * debug_info_create
- * - create new debug-info
- */
- static debug_info_t* debug_info_create(char *name, int page_order,
- int nr_areas, int buf_size)
- {
- debug_info_t* rc;
- rc = debug_info_alloc(name, page_order, nr_areas, buf_size);
- if(!rc)
- goto out;
- /* create proc rood directory */
- rc->proc_root_entry = proc_mkdir(rc->name, debug_proc_root_entry);
- /* append new element to linked list */
- if (debug_area_first == NULL) {
- /* first element in list */
- debug_area_first = rc;
- rc->prev = NULL;
- } else {
- /* append element to end of list */
- debug_area_last->next = rc;
- rc->prev = debug_area_last;
- }
- debug_area_last = rc;
- rc->next = NULL;
- debug_info_get(rc);
- out:
- return rc;
- }
- /*
- * debug_info_copy
- * - copy debug-info
- */
- static debug_info_t* debug_info_copy(debug_info_t* in)
- {
- int i;
- debug_info_t* rc;
- rc = debug_info_alloc(in->name, in->page_order,
- in->nr_areas, in->buf_size);
- if(!rc)
- goto out;
- for(i = 0; i < in->nr_areas; i++){
- memcpy(rc->areas[i],in->areas[i], PAGE_SIZE << in->page_order);
- }
- out:
- return rc;
- }
- /*
- * debug_info_get
- * - increments reference count for debug-info
- */
- static void debug_info_get(debug_info_t * db_info)
- {
- if (db_info)
- atomic_inc(&db_info->ref_count);
- }
- /*
- * debug_info_put:
- * - decreases reference count for debug-info and frees it if necessary
- */
- static void debug_info_put(debug_info_t *db_info)
- {
- int i;
- if (!db_info)
- return;
- if (atomic_dec_and_test(&db_info->ref_count)) {
- #ifdef DEBUG
- printk(KERN_INFO "debug: freeing debug area %p (%s)\n",
- db_info, db_info->name);
- #endif
- for (i = 0; i < DEBUG_MAX_VIEWS; i++) {
- if (db_info->views[i] == NULL)
- continue;
- #ifdef CONFIG_PROC_FS
- remove_proc_entry(db_info->proc_entries[i]->name,
- db_info->proc_root_entry);
- #endif
- }
- #ifdef CONFIG_PROC_FS
- remove_proc_entry(db_info->proc_root_entry->name,
- debug_proc_root_entry);
- #endif
- if(db_info == debug_area_first)
- debug_area_first = db_info->next;
- if(db_info == debug_area_last)
- debug_area_last = db_info->prev;
- if(db_info->prev) db_info->prev->next = db_info->next;
- if(db_info->next) db_info->next->prev = db_info->prev;
- debug_info_free(db_info);
- }
- }
- /*
- * debug_format_entry:
- * - format one debug entry and return size of formated data
- */
- static int debug_format_entry(file_private_info_t *p_info)
- {
- debug_info_t *id_org = p_info->debug_info_org;
- debug_info_t *id_snap = p_info->debug_info_snap;
- struct debug_view *view = p_info->view;
- debug_entry_t *act_entry;
- size_t len = 0;
- if(p_info->act_entry == DEBUG_PROLOG_ENTRY){
- /* print prolog */
- if (view->prolog_proc)
- len += view->prolog_proc(id_org, view,p_info->temp_buf);
- goto out;
- }
- act_entry = (debug_entry_t *) ((char*)id_snap->areas[p_info->act_area] +
- p_info->act_entry);
-
- if (act_entry->id.stck == 0LL)
- goto out; /* empty entry */
- if (view->header_proc)
- len += view->header_proc(id_org, view, p_info->act_area,
- act_entry, p_info->temp_buf + len);
- if (view->format_proc)
- len += view->format_proc(id_org, view, p_info->temp_buf + len,
- DEBUG_DATA(act_entry));
- out:
- return len;
- }
- /*
- * debug_next_entry:
- * - goto next entry in p_info
- */
- extern inline int debug_next_entry(file_private_info_t *p_info)
- {
- debug_info_t *id = p_info->debug_info_snap;
- if(p_info->act_entry == DEBUG_PROLOG_ENTRY){
- p_info->act_entry = 0;
- goto out;
- }
- if ((p_info->act_entry += id->entry_size)
- > ((PAGE_SIZE << (id->page_order))
- - id->entry_size)){
- /* next area */
- p_info->act_entry = 0;
- p_info->act_area++;
- if(p_info->act_area >= id->nr_areas)
- return 1;
- }
- out:
- return 0;
- }
- /*
- * debug_output:
- * - called for user read()
- * - copies formated debug entries to the user buffer
- */
- static ssize_t debug_output(struct file *file, /* file descriptor */
- char __user *user_buf, /* user buffer */
- size_t len, /* length of buffer */
- loff_t *offset) /* offset in the file */
- {
- size_t count = 0;
- size_t entry_offset, size = 0;
- file_private_info_t *p_info;
- p_info = ((file_private_info_t *) file->private_data);
- if (*offset != p_info->offset)
- return -EPIPE;
- if(p_info->act_area >= p_info->debug_info_snap->nr_areas)
- return 0;
- entry_offset = p_info->act_entry_offset;
- while(count < len){
- size = debug_format_entry(p_info);
- size = min((len - count), (size - entry_offset));
- if(size){
- if (copy_to_user(user_buf + count,
- p_info->temp_buf + entry_offset, size))
- return -EFAULT;
- }
- count += size;
- entry_offset = 0;
- if(count != len)
- if(debug_next_entry(p_info))
- goto out;
- }
- out:
- p_info->offset = *offset + count;
- p_info->act_entry_offset = size;
- *offset = p_info->offset;
- return count;
- }
- /*
- * debug_input:
- * - called for user write()
- * - calls input function of view
- */
- static ssize_t debug_input(struct file *file,
- const char __user *user_buf, size_t length,
- loff_t *offset)
- {
- int rc = 0;
- file_private_info_t *p_info;
- down(&debug_lock);
- p_info = ((file_private_info_t *) file->private_data);
- if (p_info->view->input_proc)
- rc = p_info->view->input_proc(p_info->debug_info_org,
- p_info->view, file, user_buf,
- length, offset);
- else
- rc = -EPERM;
- up(&debug_lock);
- return rc; /* number of input characters */
- }
- /*
- * debug_open:
- * - called for user open()
- * - copies formated output to private_data area of the file
- * handle
- */
- static int debug_open(struct inode *inode, struct file *file)
- {
- int i = 0, rc = 0;
- file_private_info_t *p_info;
- debug_info_t *debug_info, *debug_info_snapshot;
- #ifdef DEBUG
- printk("debug_open\n");
- #endif
- down(&debug_lock);
- /* find debug log and view */
- debug_info = debug_area_first;
- while(debug_info != NULL){
- for (i = 0; i < DEBUG_MAX_VIEWS; i++) {
- if (debug_info->views[i] == NULL)
- continue;
- else if (debug_info->proc_entries[i] ==
- PDE(file->f_dentry->d_inode)) {
- goto found; /* found view ! */
- }
- }
- debug_info = debug_info->next;
- }
- /* no entry found */
- rc = -EINVAL;
- goto out;
- found:
- /* make snapshot of current debug areas to get it consistent */
- debug_info_snapshot = debug_info_copy(debug_info);
- if(!debug_info_snapshot){
- #ifdef DEBUG
- printk(KERN_ERR "debug_open: debug_info_copy failed (out of mem)\n");
- #endif
- rc = -ENOMEM;
- goto out;
- }
- if ((file->private_data =
- kmalloc(sizeof(file_private_info_t), GFP_ATOMIC)) == 0) {
- #ifdef DEBUG
- printk(KERN_ERR "debug_open: kmalloc failed\n");
- #endif
- debug_info_free(debug_info_snapshot);
- rc = -ENOMEM;
- goto out;
- }
- p_info = (file_private_info_t *) file->private_data;
- p_info->offset = 0;
- p_info->debug_info_snap = debug_info_snapshot;
- p_info->debug_info_org = debug_info;
- p_info->view = debug_info->views[i];
- p_info->act_area = 0;
- p_info->act_entry = DEBUG_PROLOG_ENTRY;
- p_info->act_entry_offset = 0;
- debug_info_get(debug_info);
- out:
- up(&debug_lock);
- return rc;
- }
- /*
- * debug_close:
- * - called for user close()
- * - deletes private_data area of the file handle
- */
- static int debug_close(struct inode *inode, struct file *file)
- {
- file_private_info_t *p_info;
- #ifdef DEBUG
- printk("debug_close\n");
- #endif
- p_info = (file_private_info_t *) file->private_data;
- debug_info_free(p_info->debug_info_snap);
- debug_info_put(p_info->debug_info_org);
- kfree(file->private_data);
- return 0; /* success */
- }
- /*
- * debug_register:
- * - creates and initializes debug area for the caller
- * - returns handle for debug area
- */
- debug_info_t *debug_register
- (char *name, int page_order, int nr_areas, int buf_size)
- {
- debug_info_t *rc = NULL;
- if (!initialized)
- BUG();
- down(&debug_lock);
- /* create new debug_info */
- rc = debug_info_create(name, page_order, nr_areas, buf_size);
- if(!rc)
- goto out;
- debug_register_view(rc, &debug_level_view);
- debug_register_view(rc, &debug_flush_view);
- #ifdef DEBUG
- printk(KERN_INFO
- "debug: reserved %d areas of %d pages for debugging %s\n",
- nr_areas, 1 << page_order, rc->name);
- #endif
- out:
- if (rc == NULL){
- printk(KERN_ERR "debug: debug_register failed for %s\n",name);
- }
- up(&debug_lock);
- return rc;
- }
- /*
- * debug_unregister:
- * - give back debug area
- */
- void debug_unregister(debug_info_t * id)
- {
- if (!id)
- goto out;
- down(&debug_lock);
- #ifdef DEBUG
- printk(KERN_INFO "debug: unregistering %s\n", id->name);
- #endif
- debug_info_put(id);
- up(&debug_lock);
- out:
- return;
- }
- /*
- * debug_set_level:
- * - set actual debug level
- */
- void debug_set_level(debug_info_t* id, int new_level)
- {
- unsigned long flags;
- if(!id)
- return;
- spin_lock_irqsave(&id->lock,flags);
- if(new_level == DEBUG_OFF_LEVEL){
- id->level = DEBUG_OFF_LEVEL;
- printk(KERN_INFO "debug: %s: switched off\n",id->name);
- } else if ((new_level > DEBUG_MAX_LEVEL) || (new_level < 0)) {
- printk(KERN_INFO
- "debug: %s: level %i is out of range (%i - %i)\n",
- id->name, new_level, 0, DEBUG_MAX_LEVEL);
- } else {
- id->level = new_level;
- #ifdef DEBUG
- printk(KERN_INFO
- "debug: %s: new level %i\n",id->name,id->level);
- #endif
- }
- spin_unlock_irqrestore(&id->lock,flags);
- }
- /*
- * proceed_active_entry:
- * - set active entry to next in the ring buffer
- */
- extern inline void proceed_active_entry(debug_info_t * id)
- {
- if ((id->active_entry[id->active_area] += id->entry_size)
- > ((PAGE_SIZE << (id->page_order)) - id->entry_size))
- id->active_entry[id->active_area] = 0;
- }
- /*
- * proceed_active_area:
- * - set active area to next in the ring buffer
- */
- extern inline void proceed_active_area(debug_info_t * id)
- {
- id->active_area++;
- id->active_area = id->active_area % id->nr_areas;
- }
- /*
- * get_active_entry:
- */
- extern inline debug_entry_t *get_active_entry(debug_info_t * id)
- {
- return (debug_entry_t *) ((char *) id->areas[id->active_area] +
- id->active_entry[id->active_area]);
- }
- /*
- * debug_finish_entry:
- * - set timestamp, caller address, cpu number etc.
- */
- extern inline void debug_finish_entry(debug_info_t * id, debug_entry_t* active,
- int level, int exception)
- {
- STCK(active->id.stck);
- active->id.fields.cpuid = smp_processor_id();
- active->caller = __builtin_return_address(0);
- active->id.fields.exception = exception;
- active->id.fields.level = level;
- proceed_active_entry(id);
- if(exception)
- proceed_active_area(id);
- }
- static int debug_stoppable=1;
- static int debug_active=1;
- #define CTL_S390DBF 5677
- #define CTL_S390DBF_STOPPABLE 5678
- #define CTL_S390DBF_ACTIVE 5679
- /*
- * proc handler for the running debug_active sysctl
- * always allow read, allow write only if debug_stoppable is set or
- * if debug_active is already off
- */
- static int s390dbf_procactive(ctl_table *table, int write, struct file *filp,
- void __user *buffer, size_t *lenp, loff_t *ppos)
- {
- if (!write || debug_stoppable || !debug_active)
- return proc_dointvec(table, write, filp, buffer, lenp, ppos);
- else
- return 0;
- }
- static struct ctl_table s390dbf_table[] = {
- {
- .ctl_name = CTL_S390DBF_STOPPABLE,
- .procname = "debug_stoppable",
- .data = &debug_stoppable,
- .maxlen = sizeof(int),
- .mode = S_IRUGO | S_IWUSR,
- .proc_handler = &proc_dointvec,
- .strategy = &sysctl_intvec,
- },
- {
- .ctl_name = CTL_S390DBF_ACTIVE,
- .procname = "debug_active",
- .data = &debug_active,
- .maxlen = sizeof(int),
- .mode = S_IRUGO | S_IWUSR,
- .proc_handler = &s390dbf_procactive,
- .strategy = &sysctl_intvec,
- },
- { .ctl_name = 0 }
- };
- static struct ctl_table s390dbf_dir_table[] = {
- {
- .ctl_name = CTL_S390DBF,
- .procname = "s390dbf",
- .maxlen = 0,
- .mode = S_IRUGO | S_IXUGO,
- .child = s390dbf_table,
- },
- { .ctl_name = 0 }
- };
- struct ctl_table_header *s390dbf_sysctl_header;
- void debug_stop_all(void)
- {
- if (debug_stoppable)
- debug_active = 0;
- }
- /*
- * debug_event_common:
- * - write debug entry with given size
- */
- debug_entry_t *debug_event_common(debug_info_t * id, int level, const void *buf,
- int len)
- {
- unsigned long flags;
- debug_entry_t *active;
- if (!debug_active)
- return NULL;
- spin_lock_irqsave(&id->lock, flags);
- active = get_active_entry(id);
- memset(DEBUG_DATA(active), 0, id->buf_size);
- memcpy(DEBUG_DATA(active), buf, min(len, id->buf_size));
- debug_finish_entry(id, active, level, 0);
- spin_unlock_irqrestore(&id->lock, flags);
- return active;
- }
- /*
- * debug_exception_common:
- * - write debug entry with given size and switch to next debug area
- */
- debug_entry_t *debug_exception_common(debug_info_t * id, int level,
- const void *buf, int len)
- {
- unsigned long flags;
- debug_entry_t *active;
- if (!debug_active)
- return NULL;
- spin_lock_irqsave(&id->lock, flags);
- active = get_active_entry(id);
- memset(DEBUG_DATA(active), 0, id->buf_size);
- memcpy(DEBUG_DATA(active), buf, min(len, id->buf_size));
- debug_finish_entry(id, active, level, 1);
- spin_unlock_irqrestore(&id->lock, flags);
- return active;
- }
- /*
- * counts arguments in format string for sprintf view
- */
- extern inline int debug_count_numargs(char *string)
- {
- int numargs=0;
- while(*string) {
- if(*string++=='%')
- numargs++;
- }
- return(numargs);
- }
- /*
- * debug_sprintf_event:
- */
- debug_entry_t *debug_sprintf_event(debug_info_t* id,
- int level,char *string,...)
- {
- va_list ap;
- int numargs,idx;
- unsigned long flags;
- debug_sprintf_entry_t *curr_event;
- debug_entry_t *active;
- if((!id) || (level > id->level))
- return NULL;
- if (!debug_active)
- return NULL;
- numargs=debug_count_numargs(string);
- spin_lock_irqsave(&id->lock, flags);
- active = get_active_entry(id);
- curr_event=(debug_sprintf_entry_t *) DEBUG_DATA(active);
- va_start(ap,string);
- curr_event->string=string;
- for(idx=0;idx<min(numargs,(int)(id->buf_size / sizeof(long))-1);idx++)
- curr_event->args[idx]=va_arg(ap,long);
- va_end(ap);
- debug_finish_entry(id, active, level, 0);
- spin_unlock_irqrestore(&id->lock, flags);
- return active;
- }
- /*
- * debug_sprintf_exception:
- */
- debug_entry_t *debug_sprintf_exception(debug_info_t* id,
- int level,char *string,...)
- {
- va_list ap;
- int numargs,idx;
- unsigned long flags;
- debug_sprintf_entry_t *curr_event;
- debug_entry_t *active;
- if((!id) || (level > id->level))
- return NULL;
- if (!debug_active)
- return NULL;
- numargs=debug_count_numargs(string);
- spin_lock_irqsave(&id->lock, flags);
- active = get_active_entry(id);
- curr_event=(debug_sprintf_entry_t *)DEBUG_DATA(active);
- va_start(ap,string);
- curr_event->string=string;
- for(idx=0;idx<min(numargs,(int)(id->buf_size / sizeof(long))-1);idx++)
- curr_event->args[idx]=va_arg(ap,long);
- va_end(ap);
- debug_finish_entry(id, active, level, 1);
- spin_unlock_irqrestore(&id->lock, flags);
- return active;
- }
- /*
- * debug_init:
- * - is called exactly once to initialize the debug feature
- */
- static int __init debug_init(void)
- {
- int rc = 0;
- s390dbf_sysctl_header = register_sysctl_table(s390dbf_dir_table, 1);
- down(&debug_lock);
- #ifdef CONFIG_PROC_FS
- debug_proc_root_entry = proc_mkdir(DEBUG_DIR_ROOT, NULL);
- #endif /* CONFIG_PROC_FS */
- printk(KERN_INFO "debug: Initialization complete\n");
- initialized = 1;
- up(&debug_lock);
- return rc;
- }
- /*
- * debug_register_view:
- */
- int debug_register_view(debug_info_t * id, struct debug_view *view)
- {
- int rc = 0;
- int i;
- unsigned long flags;
- mode_t mode = S_IFREG;
- struct proc_dir_entry *pde;
- if (!id)
- goto out;
- if (view->prolog_proc || view->format_proc || view->header_proc)
- mode |= S_IRUSR;
- if (view->input_proc)
- mode |= S_IWUSR;
- pde = create_proc_entry(view->name, mode, id->proc_root_entry);
- if (!pde){
- printk(KERN_WARNING "debug: create_proc_entry() failed! Cannot register view %s/%s\n", id->name,view->name);
- rc = -1;
- goto out;
- }
- spin_lock_irqsave(&id->lock, flags);
- for (i = 0; i < DEBUG_MAX_VIEWS; i++) {
- if (id->views[i] == NULL)
- break;
- }
- if (i == DEBUG_MAX_VIEWS) {
- printk(KERN_WARNING "debug: cannot register view %s/%s\n",
- id->name,view->name);
- printk(KERN_WARNING
- "debug: maximum number of views reached (%i)!\n", i);
- remove_proc_entry(pde->name, id->proc_root_entry);
- rc = -1;
- }
- else {
- id->views[i] = view;
- pde->proc_fops = &debug_file_ops;
- id->proc_entries[i] = pde;
- }
- spin_unlock_irqrestore(&id->lock, flags);
- out:
- return rc;
- }
- /*
- * debug_unregister_view:
- */
- int debug_unregister_view(debug_info_t * id, struct debug_view *view)
- {
- int rc = 0;
- int i;
- unsigned long flags;
- if (!id)
- goto out;
- spin_lock_irqsave(&id->lock, flags);
- for (i = 0; i < DEBUG_MAX_VIEWS; i++) {
- if (id->views[i] == view)
- break;
- }
- if (i == DEBUG_MAX_VIEWS)
- rc = -1;
- else {
- #ifdef CONFIG_PROC_FS
- remove_proc_entry(id->proc_entries[i]->name,
- id->proc_root_entry);
- #endif
- id->views[i] = NULL;
- rc = 0;
- }
- spin_unlock_irqrestore(&id->lock, flags);
- out:
- return rc;
- }
- /*
- * functions for debug-views
- ***********************************
- */
- /*
- * prints out actual debug level
- */
- static int debug_prolog_level_fn(debug_info_t * id,
- struct debug_view *view, char *out_buf)
- {
- int rc = 0;
- if(id->level == -1) rc = sprintf(out_buf,"-\n");
- else rc = sprintf(out_buf, "%i\n", id->level);
- return rc;
- }
- /*
- * reads new debug level
- */
- static int debug_input_level_fn(debug_info_t * id, struct debug_view *view,
- struct file *file, const char __user *user_buf,
- size_t in_buf_size, loff_t * offset)
- {
- char input_buf[1];
- int rc = in_buf_size;
- if (*offset != 0)
- goto out;
- if (copy_from_user(input_buf, user_buf, 1)){
- rc = -EFAULT;
- goto out;
- }
- if (isdigit(input_buf[0])) {
- int new_level = ((int) input_buf[0] - (int) '0');
- debug_set_level(id, new_level);
- } else if(input_buf[0] == '-') {
- debug_set_level(id, DEBUG_OFF_LEVEL);
- } else {
- printk(KERN_INFO "debug: level `%c` is not valid\n",
- input_buf[0]);
- }
- out:
- *offset += in_buf_size;
- return rc; /* number of input characters */
- }
- /*
- * flushes debug areas
- */
-
- void debug_flush(debug_info_t* id, int area)
- {
- unsigned long flags;
- int i;
- if(!id)
- return;
- spin_lock_irqsave(&id->lock,flags);
- if(area == DEBUG_FLUSH_ALL){
- id->active_area = 0;
- memset(id->active_entry, 0, id->nr_areas * sizeof(int));
- for (i = 0; i < id->nr_areas; i++)
- memset(id->areas[i], 0, PAGE_SIZE << id->page_order);
- printk(KERN_INFO "debug: %s: all areas flushed\n",id->name);
- } else if(area >= 0 && area < id->nr_areas) {
- id->active_entry[area] = 0;
- memset(id->areas[area], 0, PAGE_SIZE << id->page_order);
- printk(KERN_INFO
- "debug: %s: area %i has been flushed\n",
- id->name, area);
- } else {
- printk(KERN_INFO
- "debug: %s: area %i cannot be flushed (range: %i - %i)\n",
- id->name, area, 0, id->nr_areas-1);
- }
- spin_unlock_irqrestore(&id->lock,flags);
- }
- /*
- * view function: flushes debug areas
- */
- static int debug_input_flush_fn(debug_info_t * id, struct debug_view *view,
- struct file *file, const char __user *user_buf,
- size_t in_buf_size, loff_t * offset)
- {
- char input_buf[1];
- int rc = in_buf_size;
-
- if (*offset != 0)
- goto out;
- if (copy_from_user(input_buf, user_buf, 1)){
- rc = -EFAULT;
- goto out;
- }
- if(input_buf[0] == '-') {
- debug_flush(id, DEBUG_FLUSH_ALL);
- goto out;
- }
- if (isdigit(input_buf[0])) {
- int area = ((int) input_buf[0] - (int) '0');
- debug_flush(id, area);
- goto out;
- }
- printk(KERN_INFO "debug: area `%c` is not valid\n", input_buf[0]);
- out:
- *offset += in_buf_size;
- return rc; /* number of input characters */
- }
- /*
- * prints debug header in raw format
- */
- int debug_raw_header_fn(debug_info_t * id, struct debug_view *view,
- int area, debug_entry_t * entry, char *out_buf)
- {
- int rc;
- rc = sizeof(debug_entry_t);
- memcpy(out_buf,entry,sizeof(debug_entry_t));
- return rc;
- }
- /*
- * prints debug data in raw format
- */
- static int debug_raw_format_fn(debug_info_t * id, struct debug_view *view,
- char *out_buf, const char *in_buf)
- {
- int rc;
- rc = id->buf_size;
- memcpy(out_buf, in_buf, id->buf_size);
- return rc;
- }
- /*
- * prints debug data in hex/ascii format
- */
- static int debug_hex_ascii_format_fn(debug_info_t * id, struct debug_view *view,
- char *out_buf, const char *in_buf)
- {
- int i, rc = 0;
- for (i = 0; i < id->buf_size; i++) {
- rc += sprintf(out_buf + rc, "%02x ",
- ((unsigned char *) in_buf)[i]);
- }
- rc += sprintf(out_buf + rc, "| ");
- for (i = 0; i < id->buf_size; i++) {
- unsigned char c = in_buf[i];
- if (!isprint(c))
- rc += sprintf(out_buf + rc, ".");
- else
- rc += sprintf(out_buf + rc, "%c", c);
- }
- rc += sprintf(out_buf + rc, "\n");
- return rc;
- }
- /*
- * prints header for debug entry
- */
- int debug_dflt_header_fn(debug_info_t * id, struct debug_view *view,
- int area, debug_entry_t * entry, char *out_buf)
- {
- struct timeval time_val;
- unsigned long long time;
- char *except_str;
- unsigned long caller;
- int rc = 0;
- unsigned int level;
- level = entry->id.fields.level;
- time = entry->id.stck;
- /* adjust todclock to 1970 */
- time -= 0x8126d60e46000000LL - (0x3c26700LL * 1000000 * 4096);
- tod_to_timeval(time, &time_val);
- if (entry->id.fields.exception)
- except_str = "*";
- else
- except_str = "-";
- caller = ((unsigned long) entry->caller) & PSW_ADDR_INSN;
- rc += sprintf(out_buf, "%02i %011lu:%06lu %1u %1s %02i %p ",
- area, time_val.tv_sec, time_val.tv_usec, level,
- except_str, entry->id.fields.cpuid, (void *) caller);
- return rc;
- }
- /*
- * prints debug data sprintf-formated:
- * debug_sprinf_event/exception calls must be used together with this view
- */
- #define DEBUG_SPRINTF_MAX_ARGS 10
- int debug_sprintf_format_fn(debug_info_t * id, struct debug_view *view,
- char *out_buf, debug_sprintf_entry_t *curr_event)
- {
- int num_longs, num_used_args = 0,i, rc = 0;
- int index[DEBUG_SPRINTF_MAX_ARGS];
- /* count of longs fit into one entry */
- num_longs = id->buf_size / sizeof(long);
- if(num_longs < 1)
- goto out; /* bufsize of entry too small */
- if(num_longs == 1) {
- /* no args, we use only the string */
- strcpy(out_buf, curr_event->string);
- rc = strlen(curr_event->string);
- goto out;
- }
- /* number of arguments used for sprintf (without the format string) */
- num_used_args = min(DEBUG_SPRINTF_MAX_ARGS, (num_longs - 1));
- memset(index,0, DEBUG_SPRINTF_MAX_ARGS * sizeof(int));
- for(i = 0; i < num_used_args; i++)
- index[i] = i;
- rc = sprintf(out_buf, curr_event->string, curr_event->args[index[0]],
- curr_event->args[index[1]], curr_event->args[index[2]],
- curr_event->args[index[3]], curr_event->args[index[4]],
- curr_event->args[index[5]], curr_event->args[index[6]],
- curr_event->args[index[7]], curr_event->args[index[8]],
- curr_event->args[index[9]]);
- out:
- return rc;
- }
- /*
- * clean up module
- */
- void __exit debug_exit(void)
- {
- #ifdef DEBUG
- printk("debug_cleanup_module: \n");
- #endif
- #ifdef CONFIG_PROC_FS
- remove_proc_entry(debug_proc_root_entry->name, NULL);
- #endif /* CONFIG_PROC_FS */
- unregister_sysctl_table(s390dbf_sysctl_header);
- return;
- }
- /*
- * module definitions
- */
- core_initcall(debug_init);
- module_exit(debug_exit);
- MODULE_LICENSE("GPL");
- EXPORT_SYMBOL(debug_register);
- EXPORT_SYMBOL(debug_unregister);
- EXPORT_SYMBOL(debug_set_level);
- EXPORT_SYMBOL(debug_stop_all);
- EXPORT_SYMBOL(debug_register_view);
- EXPORT_SYMBOL(debug_unregister_view);
- EXPORT_SYMBOL(debug_event_common);
- EXPORT_SYMBOL(debug_exception_common);
- EXPORT_SYMBOL(debug_hex_ascii_view);
- EXPORT_SYMBOL(debug_raw_view);
- EXPORT_SYMBOL(debug_dflt_header_fn);
- EXPORT_SYMBOL(debug_sprintf_view);
- EXPORT_SYMBOL(debug_sprintf_exception);
- EXPORT_SYMBOL(debug_sprintf_event);
|