uti: Add/Modify test programs

Change-Id: I27a39d6b11af5243f93d07c31c2ef80f6727dd53

test/uti/CT25.c

@@ -0,0 +1,163 @@
+#define _GNU_SOURCE
+#include <stdlib.h>
+#include <stdio.h>
+#include <string.h>
+#include <pthread.h>
+#include <errno.h>
+#include <unistd.h>
+#include <sys/syscall.h>
+#include <sys/mman.h>
+#include <unistd.h>
+#include <sys/syscall.h>   /* For SYS_xxx definitions */
+#include <linux/futex.h>
+#include <sys/time.h>
+#include <string.h>
+#include <semaphore.h>
+
+pthread_t thr;
+
+unsigned long mem; /* delay functions issue ld/st instructions on this address */
+double nspw; /* nsec per work */
+
+sem_t sem_kick, sem_report;
+int nentry, szentry;
+char **sendv, **recvv;
+
+
+
+/* Timer related macros */
+#define TS2NS(sec, nsec) ((unsigned long)(sec) * 1000000000ULL + (unsigned long)(nsec))
+#define N_INIT 10000000
+
+static inline void fixed_size_work(unsigned long *ptr) {
+    asm volatile("movq %0, %%rax\n\t"
+                 "addq $1, %%rax\n\t"           \
+                 "movq %%rax, %0\n\t"           \
+                 : "+rm" (*ptr)                     \
+                 :                                  \
+                 : "rax", "cc", "memory");          \
+}
+
+static inline void delay_loop(unsigned long n, unsigned long *ptr) {
+    int j;
+    for (j = 0; j < (n); j++) {
+        fixed_size_work(ptr);
+    }
+}
+
+void delay_init(unsigned long *mem) {
+	struct timespec start, end;
+	unsigned long nsec;
+	int i;
+	clock_gettime(CLOCK_THREAD_CPUTIME_ID, &start);
+	delay_loop(N_INIT, mem);
+	clock_gettime(CLOCK_THREAD_CPUTIME_ID, &end);
+	nsec = (TS2NS(end.tv_sec, end.tv_nsec) - TS2NS(start.tv_sec, start.tv_nsec));
+	nspw = nsec / (double)N_INIT;
+	printf("nsec=%ld, nspw=%f\n", nsec, nspw);
+}
+
+void delay_nsec(unsigned long delay_nsec, unsigned long* mem) {
+	//printf("delay_nsec=%ld,count=%f\n", delay_nsec, delay_nsec / nspw);
+	delay_loop(delay_nsec / nspw, mem);
+}
+
+void *util_thread(void *arg) {
+	int rc;
+	int i;
+
+	rc = syscall(732);
+	if (rc == -1)
+		fprintf(stderr, "CT25101 running on Linux CPU OK\n");
+	else {
+		fprintf(stderr, "CT25101 running on Linux CPU NG (%d)\n", rc);
+	}
+
+	sem_wait(&sem_kick);
+
+	/* Cause remote page fault */
+	for (i = 0; i < nentry; i++) {
+		memset(recvv[i], 0, szentry);
+	}
+
+	sem_post(&sem_report);
+
+	return NULL;
+}
+
+pid_t gettid(void)
+{
+    return syscall(SYS_gettid);
+}
+
+int
+main(int argc, char **argv)
+{
+	int ret = 0;
+	int rc;
+	int i;
+	pthread_attr_t attr;
+
+    if(argc == 3) {
+        szentry = (1ULL << atoi(argv[1]));
+        nentry = atoi(argv[2]);
+    }
+
+	if (argc != 3 || szentry == 0) {
+		fprintf(stderr, "usage: CT25 <log-size of one buffer entry> <# of entries>\n");
+		ret = 1;
+		goto fn_fail;
+	}
+
+    sem_init(&sem_kick, 0, 0);
+    sem_init(&sem_report, 0, 0);
+
+	fprintf(stderr, "CT25001 START\n");
+	fprintf(stderr, "CT25001 INFO (pid=%d,tid=%d)\n", getpid(), gettid());
+
+	sendv = malloc(sizeof(char *) * nentry);
+	if(!sendv) { printf("malloc failed"); goto fn_fail; }
+	for (i = 0; i < nentry; i++) {
+		sendv[i] = (char*)mmap(0, szentry, PROT_READ | PROT_WRITE, MAP_ANONYMOUS | MAP_PRIVATE, -1, 0);
+		if(sendv[i] == MAP_FAILED) { printf("mmap failed"); goto fn_fail; }
+		memset(sendv[i], 0xaa, szentry);
+	}
+
+	recvv = malloc(sizeof(char *) * nentry);
+	if(!recvv) { printf("malloc failed"); goto fn_fail; }
+	for (i = 0; i < nentry; i++) {
+		recvv[i] = (char*)mmap(0, szentry, PROT_READ|PROT_WRITE, MAP_ANONYMOUS|MAP_PRIVATE, -1, 0);
+		if(recvv[i] == MAP_FAILED) { printf("mmap failed"); goto fn_fail; }
+		memset(recvv[i], 0, szentry);
+	}
+
+	rc = syscall(731, 1, NULL);
+	if (rc) {
+		fprintf(stderr, "CT25002 util_indicate_clone INFO (rc=%d, errno=%d)\n", rc, errno);
+	} else {
+		fprintf(stderr, "CT25002 util_indicate_clone OK\n", rc, errno);
+	}
+
+	pthread_attr_init(&attr);
+	//pthread_attr_setdetachstate(&attr, PTHREAD_CREATE_DETACHED);
+	rc = pthread_create(&thr, &attr, util_thread, NULL);
+	if (rc){
+		fprintf(stderr, "pthread_create: %d\n", rc);
+		exit(1);
+	}
+	fprintf(stderr, "CT25002 pthread_create OK\n");
+
+	sem_post(&sem_kick);
+	sem_wait(&sem_report);
+
+	pthread_join(thr, NULL);
+
+	fprintf(stderr, "CT25003 END\n");
+	ret = 0;
+
+ fn_exit:
+	exit(ret);
+
+ fn_fail:
+	goto fn_exit;
+}