94 lines
		
	
	
		
			2.3 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			94 lines
		
	
	
		
			2.3 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /* The kernel call that is implemented in this file:
 | |
|  *   m_type:    SYS_SPROFILE
 | |
|  *
 | |
|  * The parameters for this kernel call are:
 | |
|  *    m7_i1:    PROF_ACTION       (start/stop profiling)
 | |
|  *    m7_i2:    PROF_MEM_SIZE     (available memory for data)
 | |
|  *    m7_i3:    PROF_FREQ         (requested sample frequency)
 | |
|  *    m7_i4:    PROF_ENDPT        (endpoint of caller)
 | |
|  *    m7_p1:    PROF_CTL_PTR      (location of info struct)
 | |
|  *    m7_p2:    PROF_MEM_PTR      (location of memory for data)
 | |
|  *
 | |
|  * Changes:
 | |
|  *   14 Aug, 2006   Created (Rogier Meurs)
 | |
|  */
 | |
| 
 | |
| #include "kernel/system.h"
 | |
| 
 | |
| #if SPROFILE
 | |
| 
 | |
| /* user address to write info struct */
 | |
| PRIVATE vir_bytes sprof_info_addr_vir;
 | |
| 
 | |
| /*===========================================================================*
 | |
|  *				do_sprofile				     *
 | |
|  *===========================================================================*/
 | |
| PUBLIC int do_sprofile(struct proc * caller, message * m_ptr)
 | |
| {
 | |
|   int proc_nr;
 | |
| 
 | |
|   switch(m_ptr->PROF_ACTION) {
 | |
| 
 | |
|   case PROF_START:
 | |
| 	/* Starting profiling.
 | |
| 	 *
 | |
| 	 * Check if profiling is not already running.  Calculate physical
 | |
| 	 * addresses of user pointers.  Reset counters.  Start CMOS timer.
 | |
| 	 * Turn on profiling.
 | |
| 	 */
 | |
| 	if (sprofiling) {
 | |
| 		printf("SYSTEM: start s-profiling: already started\n");
 | |
| 		return EBUSY;
 | |
| 	}
 | |
| 
 | |
| 	/* Test endpoint number. */
 | |
| 	if(!isokendpt(m_ptr->PROF_ENDPT, &proc_nr))
 | |
| 		return EINVAL;
 | |
| 
 | |
| 	/* Set parameters for statistical profiler. */
 | |
| 	sprof_ep = m_ptr->PROF_ENDPT;
 | |
| 	sprof_info_addr_vir = (vir_bytes) m_ptr->PROF_CTL_PTR;
 | |
| 	sprof_data_addr_vir = (vir_bytes) m_ptr->PROF_MEM_PTR;
 | |
| 
 | |
| 	sprof_info.mem_used = 0;
 | |
| 	sprof_info.total_samples = 0;
 | |
| 	sprof_info.idle_samples = 0;
 | |
| 	sprof_info.system_samples = 0;
 | |
| 	sprof_info.user_samples = 0;
 | |
| 
 | |
| 	sprof_mem_size = m_ptr->PROF_MEM_SIZE;
 | |
| 
 | |
| 	init_profile_clock(m_ptr->PROF_FREQ);
 | |
| 	
 | |
| 	sprofiling = 1;
 | |
| 
 | |
|   	return OK;
 | |
| 
 | |
|   case PROF_STOP:
 | |
| 	/* Stopping profiling.
 | |
| 	 *
 | |
| 	 * Check if profiling is indeed running.  Turn off profiling.
 | |
| 	 * Stop CMOS timer.  Copy info struct to user process.
 | |
| 	 */
 | |
| 	if (!sprofiling) {
 | |
| 		printf("SYSTEM: stop s-profiling: not started\n");
 | |
| 		return EBUSY;
 | |
| 	}
 | |
| 
 | |
| 	sprofiling = 0;
 | |
| 
 | |
| 	stop_profile_clock();
 | |
| 
 | |
| 	data_copy(KERNEL, (vir_bytes) &sprof_info,
 | |
| 		sprof_ep, sprof_info_addr_vir, sizeof(sprof_info));
 | |
| 
 | |
|   	return OK;
 | |
| 
 | |
|   default:
 | |
| 	return EINVAL;
 | |
|   }
 | |
| }
 | |
| 
 | |
| #endif /* SPROFILE */
 | |
| 
 | 
