blob: d1cba22f91fae7a8a2b49a0be202728194ea716b [file] [log] [blame]
/*
* Copyright (c) 2003, Intel Corporation. All rights reserved.
* Created by: crystal.xiong REMOVE-THIS AT intel DOT com
* This file is licensed under the GPL license. For the full content
* of this license, see the COPYING file at the top level of this
* source tree.
*/
/* There are n TF threads, n is equal to the processors in the system minus
* one. TFs are used to keep busy these CPUs, which have priority 3. A
* TL thread with lower priority 1 is created, which locks 2 mutex and
* does workload. A TB1 thread with high priority 4 is created and try
* to lock mutex1 of TL. A TB2 thread with high priority 6 is created and
* try to lock mutex2 of TL. TL's priority should boost to TB2's priority.
* There are another 2 threads TP1 and TP2, which are used to check the
* priority change of TL, P(TP1)<P(TB1)<P(TP2)<P(TB2), P(TH) stands for
* the priority of TH thread. Main thread has the highest priority 8,
* which will control the running steps of those threads, including
* creating threads, stopping threads. There is another thread to collect
* the sample data with priority 7.
*
* Steps:
* 1. Create n TF threads, n is equal to processors number minus one. TF
* will do workload.
* 2. Create 2 TP threads: TP1 and TP2 and do workload. The 2 threads
* will keep running when TL is created.
* 3. Create 1 TL thread to lock 2 mutex: mutex1 and mutex2. TL will get
* a chance to run when TP sleep a wee bit in between.
* 4. Create 1 TB1 thread to lock mutex1. TL's priority will boost to
* TB1's priority, which will cause TP1 having no chance to run.
* 5. Create 1 TB2 thread to lock mutex2. TL's priority will boost to
* TB2's priority, which will cause TP1, TP2 having no chance to run.
* 6. Stop these threads.
*
*/
#warning "Contains Linux-isms that need fixing."
#include <pthread.h>
#include <stdio.h>
#include <unistd.h>
#include <string.h>
#include <stdlib.h>
#include <time.h>
#include <sched.h>
#include <errno.h>
#include "test.h"
#include "pitest.h"
int cpus;
pthread_mutex_t mutex1;
pthread_mutex_t mutex2;
volatile int ts_stop = 0;
volatile double base_time;
struct thread_param {
int index;
volatile int stop;
int sleep_ms;
int priority;
int policy;
const char *name;
int cpu;
volatile unsigned futex;
volatile unsigned should_stall;
volatile unsigned progress;
} tp[] = {
{
0, 0, 0, 1, SCHED_FIFO, "TL", 0, 0, 0, 0}, {
1, 0, 500, 2, SCHED_FIFO, "TP1", 0, 0, 0, 0}, {
1, 0, 500, 5, SCHED_FIFO, "TP2", 0, 0, 0, 0}, {
2, 0, 0, 3, SCHED_FIFO, "TF", 1, 0, 0, 0}, {
3, 0, 0, 3, SCHED_FIFO, "TF", 2, 0, 0, 0}, {
4, 0, 0, 3, SCHED_FIFO, "TF", 3, 0, 0, 0}, {
5, 0, 0, 3, SCHED_FIFO, "TF", 4, 0, 0, 0}, {
6, 0, 0, 3, SCHED_FIFO, "TF", 5, 0, 0, 0}, {
7, 0, 0, 3, SCHED_FIFO, "TF", 6, 0, 0, 0}
};
volatile unsigned do_work_dummy;
void do_work(unsigned granularity_top, volatile unsigned *progress)
{
unsigned granularity_cnt, i;
unsigned top = 5 * 1000 * 1000;
unsigned dummy = do_work_dummy;
for (granularity_cnt = 0; granularity_cnt < granularity_top;
granularity_cnt++) {
for (i = 0; i < top; i++)
dummy = i | dummy;
(*progress)++;
}
return;
}
void *thread_fn(void *param)
{
struct thread_param *tp = param;
struct timespec ts;
int rc;
unsigned long mask = 1 << tp->cpu;
#if __linux__
rc = sched_setaffinity(0, sizeof(mask), &mask);
if (rc < 0) {
EPRINTF("UNRESOLVED: Thread %s index %d: Can't set affinity: "
"%d %s", tp->name, tp->index, rc, strerror(rc));
exit(UNRESOLVED);
}
#endif
test_set_priority(pthread_self(), SCHED_FIFO, tp->priority);
DPRINTF(stdout, "#EVENT %f Thread %s Started\n",
seconds_read() - base_time, tp->name);
DPRINTF(stderr, "Thread %s index %d: started\n", tp->name, tp->index);
tp->progress = 0;
ts.tv_sec = 0;
ts.tv_nsec = tp->sleep_ms * 1000 * 1000;
while (!tp->stop) {
do_work(5, &tp->progress);
if (tp->sleep_ms == 0)
continue;
rc = nanosleep(&ts, NULL);
if (rc < 0) {
EPRINTF("UNRESOLVED: Thread %s %d: nanosleep returned "
"%d %s", tp->name, tp->index, rc, strerror(rc));
exit(UNRESOLVED);
}
}
DPRINTF(stdout, "#EVENT %f Thread %s Stopped\n",
seconds_read() - base_time, tp->name);
return NULL;
}
void *thread_tl(void *param)
{
struct thread_param *tp = param;
unsigned long mask = 1 << tp->cpu;
int rc;
#if __linux__
rc = sched_setaffinity((pid_t) 0, sizeof(mask), &mask);
if (rc < 0) {
EPRINTF
("UNRESOLVED: Thread %s index %d: Can't set affinity: %d %s",
tp->name, tp->index, rc, strerror(rc));
exit(UNRESOLVED);
}
#endif
test_set_priority(pthread_self(), SCHED_FIFO, tp->priority);
DPRINTF(stdout, "#EVENT %f Thread TL Started\n",
seconds_read() - base_time);
DPRINTF(stderr, "Thread %s index %d: started\n", tp->name, tp->index);
tp->progress = 0;
pthread_mutex_lock(&mutex1);
pthread_mutex_lock(&mutex2);
while (!tp->stop) {
do_work(5, &tp->progress);
}
pthread_mutex_unlock(&mutex1);
pthread_mutex_unlock(&mutex2);
DPRINTF(stdout, "#EVENT %f Thread TL Stopped\n",
seconds_read() - base_time);
return NULL;
}
void *thread_sample(void *arg)
{
char buffer[1024];
struct timespec ts;
double period = 300;
double newtime;
size_t size;
int i;
int rc;
test_set_priority(pthread_self(), SCHED_FIFO, 7);
DPRINTF(stderr, "Thread Sampler: started\n");
DPRINTF(stdout, "# COLUMNS %d Time TL TP1 TP2 ", 3 + cpus);
for (i = 0; i < (cpus - 1); i++)
DPRINTF(stdout, "TF%d ", i);
DPRINTF(stdout, "\n");
ts.tv_sec = 0;
ts.tv_nsec = period * 1000 * 1000;
while (!ts_stop) {
newtime = seconds_read();
size = snprintf(buffer, 1023, "%f ", newtime - base_time);
for (i = 0; i < cpus + 2; i++)
size +=
snprintf(buffer + size, 1023 - size, "%u ",
tp[i].progress);
DPRINTF(stdout, "%s\n", buffer);
rc = nanosleep(&ts, NULL);
if (rc < 0)
EPRINTF("UNRESOLVED: Thread %s %d: nanosleep returned "
"%d %s", tp->name, tp->index, rc, strerror(rc));
}
return NULL;
}
void *thread_tb1(void *arg)
{
struct timespec boost_time;
double t0, t1;
int rc;
test_set_priority(pthread_self(), SCHED_FIFO, 4);
DPRINTF(stderr, "Thread TB1: started\n");
DPRINTF(stdout, "#EVENT %f Thread TB1 Started\n",
seconds_read() - base_time);
boost_time.tv_sec = time(NULL) + *(time_t *) arg;
boost_time.tv_nsec = 0;
t0 = seconds_read();
rc = pthread_mutex_timedlock(&mutex1, &boost_time);
t1 = seconds_read();
DPRINTF(stdout, "#EVENT %f Thread TB1 Waited for %.2f s\n",
t1 - base_time, t1 - t0);
if (rc != ETIMEDOUT) {
EPRINTF("FAIL: Thread TB1: lock returned %d %s, "
"slept %f", rc, strerror(rc), t1 - t0);
exit(FAIL);
}
return NULL;
}
void *thread_tb2(void *arg)
{
struct timespec boost_time;
double t0, t1;
int rc;
test_set_priority(pthread_self(), SCHED_FIFO, 6);
DPRINTF(stderr, "Thread TB2: started\n");
DPRINTF(stdout, "#EVENT %f Thread TB2 Started\n",
seconds_read() - base_time);
boost_time.tv_sec = time(NULL) + *(time_t *) arg;
boost_time.tv_nsec = 0;
t0 = seconds_read();
rc = pthread_mutex_timedlock(&mutex2, &boost_time);
t1 = seconds_read();
DPRINTF(stdout, "#EVENT %f Thread TB2 waited %.2f s\n",
t1 - base_time, t1 - t0);
if (rc != ETIMEDOUT) {
EPRINTF("FAIL: Thread TB2: lock returned %d %s, "
"slept %f", rc, strerror(rc), t1 - t0);
exit(FAIL);
}
return NULL;
}
int main(int argc, char **argv)
{
cpus = sysconf(_SC_NPROCESSORS_ONLN);
pthread_mutexattr_t mutex_attr;
pthread_attr_t threadattr;
pthread_t threads[cpus - 1];
pthread_t threadsample, threadtp, threadtl, threadtb1, threadtb2;
time_t multiplier = 1;
int i;
int rc;
test_set_priority(pthread_self(), SCHED_FIFO, 8);
base_time = seconds_read();
/* Initialize mutex1, mutex2 with PTHREAD_PRIO_INHERIT protocol */
mutex_attr_init(&mutex_attr);
mutex_init(&mutex1, &mutex_attr);
mutex_init(&mutex2, &mutex_attr);
/* Initialize thread attr */
threadattr_init(&threadattr);
/* Start the sample thread */
DPRINTF(stderr, "Main Thread: Creating sample thread\n");
rc = pthread_create(&threadsample, &threadattr, thread_sample, NULL);
if (rc != 0) {
EPRINTF("UNRESOLVED: pthread_create: %d %s", rc, strerror(rc));
exit(UNRESOLVED);
}
/* Start the TF threads */
DPRINTF(stderr, "Main Thread: Creating %d TF threads\n", cpus - 1);
for (i = 0; i < cpus - 1; i++) {
rc = pthread_create(&threads[i], &threadattr, thread_fn,
&tp[i + 3]);
if (rc != 0) {
EPRINTF("UNRESOLVED: pthread_create: %d %s",
rc, strerror(rc));
exit(UNRESOLVED);
}
}
sleep(base_time + multiplier * 10 - seconds_read());
/* Start TP1, TP2 thread */
DPRINTF(stderr, "Main Thread: Creating TP1, TP2 thread\n");
for (i = 1; i <= 2; i++) {
rc = pthread_create(&threadtp, &threadattr, thread_fn, &tp[i]);
if (rc != 0) {
EPRINTF("UNRESOLVED: pthread_create: %d %s",
rc, strerror(rc));
exit(UNRESOLVED);
}
}
sleep(base_time + multiplier * 20 - seconds_read());
/* Start TL thread */
DPRINTF(stderr, "Main Thread: Creating TL thread\n");
rc = pthread_create(&threadtl, &threadattr, thread_tl, &tp[0]);
if (rc != 0) {
EPRINTF("UNRESOLVED: pthread_create: %d %s", rc, strerror(rc));
exit(UNRESOLVED);
}
sleep(base_time + multiplier * 30 - seconds_read());
/* Start TB1 thread (boosting thread) */
time_t timeout = multiplier * 20;
rc = pthread_create(&threadtb1, &threadattr, thread_tb1, &timeout);
if (rc != 0) {
EPRINTF("UNRESOLVED: pthread_create: %d %s", rc, strerror(rc));
exit(UNRESOLVED);
}
sleep(base_time + multiplier * 60 - seconds_read());
/* Start TB2 thread (boosting thread) */
rc = pthread_create(&threadtb2, &threadattr, thread_tb2, &timeout);
if (rc != 0) {
EPRINTF("UNRESOLVED: pthread_create: %d %s", rc, strerror(rc));
exit(UNRESOLVED);
}
sleep(base_time + multiplier * 90 - seconds_read());
/* Stop TL thread */
tp[0].stop = 1;
sleep(base_time + multiplier * 100 - seconds_read());
/* Stop TP thread */
tp[1].stop = 1;
sleep(base_time + multiplier * 110 - seconds_read());
tp[2].stop = 1;
sleep(base_time + multiplier * 120 - seconds_read());
/* Stop TF threads */
for (i = 2; i < cpus - 1; i++) {
tp[i].stop = 1;
}
/* Stop sampler */
ts_stop = 1;
DPRINTF(stderr, "Main Thread: stop sampler thread\n");
return 0;
}