Compare commits
3
Commits
test1
...
0e96eb27ae
| Author | SHA1 | Date | |
|---|---|---|---|
|
|
0e96eb27ae | ||
|
|
218baed2ed | ||
|
|
c44af52ad5 |
@@ -7,6 +7,16 @@
|
|||||||
#define NUM_LEDS 6
|
#define NUM_LEDS 6
|
||||||
#define BRIGHTNESS 40
|
#define BRIGHTNESS 40
|
||||||
|
|
||||||
|
#define COLOR1A 0
|
||||||
|
#define COLOR1B 0
|
||||||
|
#define COLOR1C 255
|
||||||
|
#define COLOR2A 0
|
||||||
|
#define COLOR2B 255
|
||||||
|
#define COLOR2C 0
|
||||||
|
#define COLOR3A 255
|
||||||
|
#define COLOR3B 0
|
||||||
|
#define COLOR3C 0
|
||||||
|
|
||||||
CRGB leds[NUM_LEDS];
|
CRGB leds[NUM_LEDS];
|
||||||
SimData sd;
|
SimData sd;
|
||||||
int maxrpm = 0;
|
int maxrpm = 0;
|
||||||
@@ -75,15 +85,15 @@ void loop()
|
|||||||
|
|
||||||
if (l >= numlights / 2)
|
if (l >= numlights / 2)
|
||||||
{
|
{
|
||||||
leds[l] = CRGB ( 0, 0, 255);
|
leds[l] = CRGB ( COLOR1A, COLOR1B, COLOR1C);
|
||||||
}
|
}
|
||||||
if (l < numlights / 2)
|
if (l < numlights / 2)
|
||||||
{
|
{
|
||||||
leds[l] = CRGB ( 0, 255, 0);
|
leds[l] = CRGB ( COLOR2A, COLOR2B, COLOR2C);
|
||||||
}
|
}
|
||||||
if (l == numlights - 1)
|
if (l == numlights - 1)
|
||||||
{
|
{
|
||||||
leds[l] = CRGB ( 255, 0, 0);
|
leds[l] = CRGB ( COLOR3A, COLOR3B, COLOR3C);
|
||||||
}
|
}
|
||||||
if (lights[l] <= 0)
|
if (lights[l] <= 0)
|
||||||
{
|
{
|
||||||
|
|||||||
@@ -3,7 +3,7 @@
|
|||||||
|
|
||||||
#define BYTE_SIZE sizeof(SimData)
|
#define BYTE_SIZE sizeof(SimData)
|
||||||
#define KPHTOMPH .621317
|
#define KPHTOMPH .621317
|
||||||
|
#define FANPOWER .6
|
||||||
|
|
||||||
Adafruit_MotorShield AFMS = Adafruit_MotorShield();
|
Adafruit_MotorShield AFMS = Adafruit_MotorShield();
|
||||||
|
|
||||||
@@ -46,6 +46,6 @@ void loop() {
|
|||||||
{
|
{
|
||||||
v = 255;
|
v = 255;
|
||||||
}
|
}
|
||||||
myMotor1->setSpeed(v);
|
myMotor1->setSpeed(v*FANPOWER);
|
||||||
myMotor2->setSpeed(v);
|
myMotor2->setSpeed(v*FANPOWER);
|
||||||
}
|
}
|
||||||
|
|||||||
@@ -6,6 +6,7 @@
|
|||||||
#include <sys/stat.h>
|
#include <sys/stat.h>
|
||||||
#include <poll.h>
|
#include <poll.h>
|
||||||
#include <termios.h>
|
#include <termios.h>
|
||||||
|
#include <signal.h>
|
||||||
|
|
||||||
#include "gameloop.h"
|
#include "gameloop.h"
|
||||||
#include "../helper/parameters.h"
|
#include "../helper/parameters.h"
|
||||||
@@ -17,6 +18,19 @@
|
|||||||
|
|
||||||
#define DEFAULT_UPDATE_RATE 240.0
|
#define DEFAULT_UPDATE_RATE 240.0
|
||||||
#define SIM_CHECK_RATE 1.0
|
#define SIM_CHECK_RATE 1.0
|
||||||
|
bool go = false;
|
||||||
|
bool go2 = false;
|
||||||
|
struct sigaction act;
|
||||||
|
|
||||||
|
void sighandler(int signum, siginfo_t* info, void* ptr)
|
||||||
|
{
|
||||||
|
sloge("caught signal");
|
||||||
|
go = false;
|
||||||
|
go2 = false;
|
||||||
|
//gfx_clear(pixels, pixels_len);
|
||||||
|
//gfx_swapbuffers();
|
||||||
|
//gfx_close();
|
||||||
|
}
|
||||||
|
|
||||||
int showstats(SimData* simdata)
|
int showstats(SimData* simdata)
|
||||||
{
|
{
|
||||||
@@ -170,16 +184,13 @@ int showstats(SimData* simdata)
|
|||||||
|
|
||||||
int clilooper(SimDevice* devices, int numdevices, Parameters* p, SimData* simdata, SimMap* simmap)
|
int clilooper(SimDevice* devices, int numdevices, Parameters* p, SimData* simdata, SimMap* simmap)
|
||||||
{
|
{
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
struct pollfd mypoll = { STDIN_FILENO, POLLIN|POLLPRI };
|
struct pollfd mypoll = { STDIN_FILENO, POLLIN|POLLPRI };
|
||||||
double update_rate = DEFAULT_UPDATE_RATE;
|
double update_rate = DEFAULT_UPDATE_RATE;
|
||||||
char ch;
|
char ch;
|
||||||
int t=0;
|
int t=0;
|
||||||
int s=0;
|
int s=0;
|
||||||
bool go = true;
|
go2 = true;
|
||||||
while (go == true && simdata->simstatus > 1)
|
while (go2 == true && simdata->simstatus > 1)
|
||||||
{
|
{
|
||||||
simdatamap(simdata, simmap, p->sim);
|
simdatamap(simdata, simmap, p->sim);
|
||||||
showstats(simdata);
|
showstats(simdata);
|
||||||
@@ -199,7 +210,7 @@ int clilooper(SimDevice* devices, int numdevices, Parameters* p, SimData* simdat
|
|||||||
scanf("%c", &ch);
|
scanf("%c", &ch);
|
||||||
if(ch == 'q')
|
if(ch == 'q')
|
||||||
{
|
{
|
||||||
go = false;
|
go2 = false;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
@@ -218,6 +229,12 @@ int clilooper(SimDevice* devices, int numdevices, Parameters* p, SimData* simdat
|
|||||||
|
|
||||||
int looper(SimDevice* devices, int numdevices, Parameters* p)
|
int looper(SimDevice* devices, int numdevices, Parameters* p)
|
||||||
{
|
{
|
||||||
|
memset(&act, 0, sizeof(act));
|
||||||
|
act.sa_sigaction = sighandler;
|
||||||
|
act.sa_flags = SA_SIGINFO;
|
||||||
|
sigaction(SIGTERM, &act, NULL);
|
||||||
|
sigaction(SIGINT, &act, NULL);
|
||||||
|
sigaction(SIGTSTP, &act, NULL);
|
||||||
|
|
||||||
SimData* simdata = malloc(sizeof(SimData));
|
SimData* simdata = malloc(sizeof(SimData));
|
||||||
SimMap* simmap = malloc(sizeof(SimMap));
|
SimMap* simmap = malloc(sizeof(SimMap));
|
||||||
@@ -233,13 +250,12 @@ int looper(SimDevice* devices, int numdevices, Parameters* p)
|
|||||||
struct pollfd mypoll = { STDIN_FILENO, POLLIN|POLLPRI };
|
struct pollfd mypoll = { STDIN_FILENO, POLLIN|POLLPRI };
|
||||||
|
|
||||||
fprintf(stdout, "Searching for sim data... Press q to quit...\n");
|
fprintf(stdout, "Searching for sim data... Press q to quit...\n");
|
||||||
|
|
||||||
p->simon = false;
|
p->simon = false;
|
||||||
double update_rate = SIM_CHECK_RATE;
|
double update_rate = SIM_CHECK_RATE;
|
||||||
int go = true;
|
go = true;
|
||||||
while (go == true)
|
while (go == true)
|
||||||
{
|
{
|
||||||
|
p->simon = false;
|
||||||
getSim(simdata, simmap, &p->simon, &p->sim);
|
getSim(simdata, simmap, &p->simon, &p->sim);
|
||||||
|
|
||||||
if (p->simon == true && simdata->simstatus > 1)
|
if (p->simon == true && simdata->simstatus > 1)
|
||||||
@@ -266,6 +282,8 @@ int looper(SimDevice* devices, int numdevices, Parameters* p)
|
|||||||
}
|
}
|
||||||
|
|
||||||
if (poll(&mypoll, 1, 1000.0/update_rate) )
|
if (poll(&mypoll, 1, 1000.0/update_rate) )
|
||||||
|
{
|
||||||
|
if (go != false )
|
||||||
{
|
{
|
||||||
scanf("%c", &ch);
|
scanf("%c", &ch);
|
||||||
if(ch == 'q')
|
if(ch == 'q')
|
||||||
@@ -274,6 +292,7 @@ int looper(SimDevice* devices, int numdevices, Parameters* p)
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
}
|
||||||
|
|
||||||
fprintf(stdout, "\n");
|
fprintf(stdout, "\n");
|
||||||
fflush(stdout);
|
fflush(stdout);
|
||||||
|
|||||||
Submodule src/monocoque/simulatorapi/simapi updated: c77e96339c...f8c4a167dd
Reference in New Issue
Block a user