openpilot is an open source driver assistance system. openpilot performs the functions of Automated Lane Centering and Adaptive Cruise Control for over 200 supported car makes and models.

53 lines
1.1 KiB

#define _GNU_SOURCE
#include <stdio.h>
#include <sched.h>
#include <arm_neon.h>
#include "../selfdrive/common/timing.h"
#define CORES 4
double ttime[CORES];
double oout[CORES];
void waste(int pid) {
cpu_set_t my_set;
CPU_ZERO(&my_set);
CPU_SET(pid, &my_set);
int ret = sched_setaffinity(0, sizeof(cpu_set_t), &my_set);
printf("set affinity to %d: %d\n", pid, ret);
float32x4_t *tmp = (float32x4_t *)malloc(0x1000008*sizeof(float32x4_t));
float32x4_t out;
uint64_t i = 0;
double sec = seconds_since_boot();
while(1) {
int j;
for (j = 0; j < 0x1000000; j++) {
out = vmlaq_f32(out, tmp[j], tmp[j+1]);
}
if (i == 0x8) {
double nsec = seconds_since_boot();
ttime[pid] = nsec-sec;
oout[pid] = out[0] + out[1] + out[2] + out[3];
i = 0;
sec = nsec;
}
i++;
}
}
int main() {
pthread_t waster[CORES];
for (int i = 0 ; i < CORES; i++) {
pthread_create(&waster[i], NULL, waste, (void*)i);
}
while (1) {
for (int i = 0 ; i < CORES; i++) {
printf("%.2f ", ttime[i]);
}
printf("\n");
sleep(1);
}
}