2023-04-04 20:58:34 +02:00
|
|
|
#include "params.h"
|
2023-04-04 22:05:50 +02:00
|
|
|
#include "can-halal.h"
|
|
|
|
#include "vehicle.h"
|
2023-04-04 20:58:34 +02:00
|
|
|
|
2024-07-22 08:43:42 +02:00
|
|
|
/**
|
|
|
|
* Decrements the given value if it is above the minimum allowed value
|
|
|
|
*/
|
2024-07-23 15:13:22 +02:00
|
|
|
// TODO these functions take into account that the parameters are unsigned, it's definitely better to have them
|
|
|
|
// signed but would need to be tested with the autobox
|
|
|
|
#define DEC_IF_ABOVE(param_val, min_val, decr_amt) ((param_val) = (((int)(param_val) - (int)(decr_amt)) > (int)(min_val)) ? ((param_val) - (decr_amt)) : (min_val))
|
|
|
|
#define INC_IF_BELOW(param_val, max_val, incr_amt) ((param_val) = (((param_val) + (incr_amt)) < (max_val)) ? ((param_val) + (incr_amt)) : (max_val))
|
2024-07-22 08:43:42 +02:00
|
|
|
|
2023-04-04 20:58:34 +02:00
|
|
|
Params params = {0};
|
2023-04-04 22:05:50 +02:00
|
|
|
|
2024-07-22 08:43:42 +02:00
|
|
|
void params_init()
|
|
|
|
{
|
|
|
|
// Default values
|
2023-08-01 19:43:09 +02:00
|
|
|
params.plim = 20;
|
2024-07-22 08:43:42 +02:00
|
|
|
params.tlim = 1400;
|
|
|
|
params.slim = 70;
|
|
|
|
params.tvec = 50;
|
|
|
|
params.pg = 0;
|
|
|
|
params.reku = 0;
|
2023-08-01 19:43:09 +02:00
|
|
|
}
|
2023-04-04 22:05:50 +02:00
|
|
|
|
2024-07-22 08:43:42 +02:00
|
|
|
void params_inc(ParamType param)
|
|
|
|
{
|
|
|
|
switch (param)
|
|
|
|
{
|
|
|
|
case PF_PLIM:
|
|
|
|
INC_IF_BELOW(params.plim, 80, 1);
|
2023-04-04 22:05:50 +02:00
|
|
|
break;
|
2024-07-22 08:43:42 +02:00
|
|
|
case PF_TLIM:
|
|
|
|
INC_IF_BELOW(params.tlim, 1500, 100);
|
2023-04-12 13:48:02 +02:00
|
|
|
break;
|
2024-07-22 08:43:42 +02:00
|
|
|
case PF_SLIM:
|
|
|
|
INC_IF_BELOW(params.slim, 100, 1);
|
2023-04-04 22:05:50 +02:00
|
|
|
break;
|
2024-07-22 08:43:42 +02:00
|
|
|
case PF_TVEC:
|
|
|
|
INC_IF_BELOW(params.tvec, 100, 1);
|
2023-06-26 17:18:51 +02:00
|
|
|
break;
|
2024-07-22 08:43:42 +02:00
|
|
|
case PF_PG:
|
|
|
|
INC_IF_BELOW(params.pg, 100, 1);
|
2023-04-04 22:05:50 +02:00
|
|
|
break;
|
2024-07-22 08:43:42 +02:00
|
|
|
case PF_REKU:
|
|
|
|
INC_IF_BELOW(params.reku, 100, 1);
|
2023-08-01 19:43:09 +02:00
|
|
|
break;
|
2023-04-04 22:05:50 +02:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2024-07-22 08:43:42 +02:00
|
|
|
void params_dec(ParamType param)
|
|
|
|
{
|
|
|
|
switch (param)
|
|
|
|
{
|
2023-08-01 19:43:09 +02:00
|
|
|
case PF_PLIM:
|
2024-07-22 08:43:42 +02:00
|
|
|
DEC_IF_ABOVE(params.plim, 0, 1);
|
|
|
|
break;
|
|
|
|
case PF_TLIM:
|
|
|
|
DEC_IF_ABOVE(params.tlim, 0, 100);
|
|
|
|
break;
|
|
|
|
case PF_SLIM:
|
|
|
|
DEC_IF_ABOVE(params.slim, 0, 1);
|
|
|
|
break;
|
|
|
|
case PF_TVEC:
|
|
|
|
DEC_IF_ABOVE(params.tvec, 0, 1);
|
|
|
|
break;
|
|
|
|
case PF_PG:
|
|
|
|
DEC_IF_ABOVE(params.pg, 0, 1);
|
|
|
|
break;
|
|
|
|
case PF_REKU:
|
|
|
|
DEC_IF_ABOVE(params.reku, 0, 1);
|
2023-08-01 19:43:09 +02:00
|
|
|
break;
|
2023-04-04 22:05:50 +02:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2024-07-22 08:43:42 +02:00
|
|
|
void params_broadcast(ParamType param)
|
|
|
|
{
|
2023-04-04 22:05:50 +02:00
|
|
|
int32_t value;
|
2024-07-22 08:43:42 +02:00
|
|
|
switch (param)
|
|
|
|
{
|
|
|
|
case PF_PLIM:
|
|
|
|
value = params.plim;
|
2023-04-04 22:05:50 +02:00
|
|
|
break;
|
2024-07-22 08:43:42 +02:00
|
|
|
case PF_TLIM:
|
|
|
|
value = params.tlim;
|
2023-04-12 13:48:02 +02:00
|
|
|
break;
|
2024-07-22 08:43:42 +02:00
|
|
|
case PF_SLIM:
|
|
|
|
value = params.slim;
|
2023-04-04 22:05:50 +02:00
|
|
|
break;
|
2024-07-22 08:43:42 +02:00
|
|
|
case PF_TVEC:
|
|
|
|
value = params.tvec;
|
2023-06-26 17:18:51 +02:00
|
|
|
break;
|
2024-07-22 08:43:42 +02:00
|
|
|
case PF_PG:
|
|
|
|
value = params.pg;
|
2023-04-04 22:05:50 +02:00
|
|
|
break;
|
2024-07-22 08:43:42 +02:00
|
|
|
case PF_REKU:
|
|
|
|
value = params.reku;
|
2023-08-02 00:10:17 +02:00
|
|
|
break;
|
2023-04-04 22:05:50 +02:00
|
|
|
default:
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
vehicle_broadcast_param(param, value);
|
|
|
|
}
|