95 lines
2.3 KiB
C
95 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 "../system.h"
|
||
|
|
|
||
|
|
#if SPROFILE
|
||
|
|
|
||
|
|
/*===========================================================================*
|
||
|
|
* do_sprofile *
|
||
|
|
*===========================================================================*/
|
||
|
|
PUBLIC int do_sprofile(m_ptr)
|
||
|
|
register message *m_ptr; /* pointer to request message */
|
||
|
|
{
|
||
|
|
int proc_nr, i;
|
||
|
|
vir_bytes vir_dst;
|
||
|
|
phys_bytes length;
|
||
|
|
|
||
|
|
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) {
|
||
|
|
kprintf("SYSTEM: start s-profiling: already started\n");
|
||
|
|
return EBUSY;
|
||
|
|
}
|
||
|
|
|
||
|
|
isokendpt(m_ptr->PROF_ENDPT, &proc_nr);
|
||
|
|
|
||
|
|
vir_dst = (vir_bytes) m_ptr->PROF_CTL_PTR;
|
||
|
|
length = (phys_bytes) sizeof (int *);
|
||
|
|
sprof_info_addr = numap_local(proc_nr, vir_dst, length);
|
||
|
|
|
||
|
|
vir_dst = (vir_bytes) m_ptr->PROF_MEM_PTR;
|
||
|
|
length = (phys_bytes) sizeof (char *);
|
||
|
|
sprof_data_addr = numap_local(proc_nr, vir_dst, length);
|
||
|
|
|
||
|
|
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_cmos_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) {
|
||
|
|
kprintf("SYSTEM: stop s-profiling: not started\n");
|
||
|
|
return EBUSY;
|
||
|
|
}
|
||
|
|
|
||
|
|
sprofiling = 0;
|
||
|
|
|
||
|
|
stop_cmos_clock();
|
||
|
|
|
||
|
|
phys_copy(vir2phys((vir_bytes) &sprof_info),
|
||
|
|
sprof_info_addr, (phys_bytes) sizeof(sprof_info));
|
||
|
|
|
||
|
|
return OK;
|
||
|
|
|
||
|
|
default:
|
||
|
|
return EINVAL;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
#endif /* SPROFILE */
|
||
|
|
|