/* 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_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) {
		kprintf("SYSTEM: stop s-profiling: not started\n");
		return EBUSY;
	}

	sprofiling = 0;

	stop_profile_clock();

	phys_copy(vir2phys((vir_bytes) &sprof_info),
		sprof_info_addr, (phys_bytes) sizeof(sprof_info));

  	return OK;

  default:
	return EINVAL;
  }
}

#endif /* SPROFILE */