111 lines
2.3 KiB
C
111 lines
2.3 KiB
C
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <sys/mman.h>
|
|
#include <fcntl.h>
|
|
#include <unistd.h>
|
|
#include <string.h>
|
|
#include <termios.h>
|
|
|
|
#include "../src/monocoque/simulatorapi/simdata.h"
|
|
#include "../src/monocoque/simulatorapi/test.h"
|
|
|
|
#define DATA "Hello, World! From PID %d"
|
|
|
|
int main(int argc, char* argv[])
|
|
{
|
|
int res;
|
|
int fd;
|
|
int len;
|
|
pid_t pid;
|
|
void* addr;
|
|
|
|
pid = getpid();
|
|
|
|
fd = shm_open(TEST_MEM_FILE_LOCATION, O_RDWR | O_CREAT, S_IRUSR | S_IWUSR);
|
|
if (fd == -1)
|
|
{
|
|
perror("open");
|
|
return 10;
|
|
}
|
|
|
|
SimData* data = malloc(sizeof(SimData));
|
|
|
|
data->gear=0;
|
|
data->rpms=0;
|
|
data->maxrpm=0;
|
|
data->velocity=0;
|
|
//SimData.pulses=0;
|
|
|
|
res = ftruncate(fd, sizeof(SimData));
|
|
if (res == -1)
|
|
{
|
|
perror("ftruncate");
|
|
return 20;
|
|
}
|
|
|
|
data->gear=1;
|
|
data->rpms=500;
|
|
data->maxrpm=6500;
|
|
data->velocity=25;
|
|
//SimData.pulses=38792;
|
|
|
|
// map .shared memory to process address space
|
|
addr = mmap(NULL, sizeof(SimData), PROT_WRITE, MAP_SHARED, fd, 0);
|
|
if (addr == MAP_FAILED)
|
|
{
|
|
perror("mmap");
|
|
return 30;
|
|
}
|
|
|
|
printf("size of int %i\n", sizeof(int));
|
|
printf("size of struct %i\n", sizeof(SimData));
|
|
memcpy(addr, data, sizeof(SimData));
|
|
//memcpy(addr, &SimData, sizeof(int)*3);
|
|
|
|
printf("PID %d: velocity: %i\n", pid, data->velocity);
|
|
printf("PID %d: rpms: %i\n", pid, data->rpms);
|
|
printf("PID %d: gear: %i\n", pid, data->gear);
|
|
sleep(4);
|
|
|
|
|
|
struct termios newsettings, canonicalmode;
|
|
tcgetattr(0, &canonicalmode);
|
|
newsettings = canonicalmode;
|
|
newsettings.c_lflag &= (~ICANON & ~ECHO);
|
|
newsettings.c_cc[VMIN] = 1;
|
|
newsettings.c_cc[VTIME] = 0;
|
|
tcsetattr(0, TCSANOW, &newsettings);
|
|
char ch;
|
|
|
|
int go=1;
|
|
while (go>0)
|
|
{
|
|
|
|
struct termios info;
|
|
tcgetattr(0, &info);
|
|
info.c_lflag &= (~ICANON & ~ECHO);
|
|
info.c_cc[VMIN] = 1;
|
|
info.c_cc[VTIME] = 0;
|
|
tcsetattr(0, TCSANOW, &info);
|
|
char ch;
|
|
scanf("%c", &ch);
|
|
|
|
|
|
if (ch == 'q')
|
|
{
|
|
go=0;
|
|
}
|
|
|
|
}
|
|
tcsetattr(0, TCSANOW, &canonicalmode);
|
|
|
|
fd = shm_unlink(TEST_MEM_FILE_LOCATION);
|
|
if (fd == -1)
|
|
{
|
|
perror("unlink");
|
|
return 100;
|
|
}
|
|
|
|
return 0;
|
|
}
|