bernhard/CanRtDriver
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Alles wieder hinzufügen???

Browse Source
This commit is contained in:
Bernhard
2025-12-17 19:35:30 +01:00
parent 555aa89479
commit c16ac482bd
1 changed files with 6 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files

10
io/io.c
View File

@@ -9,6 +9,8 @@ struct GPIO_KEY_DATA gpioKeyPwrDown;
char nInitialized = 0;
/// @brief Initialize the io pins
/// @return
int IO_Init()
{
if (wiringPiSetupPinType(WPI_PIN_BCM))
@@ -193,13 +195,13 @@ void IO_DoCyclic()
// plus key is pressed -> increase power
if (motctrl[0].iMotorGear == MOTOR_GEAR_NEUTRAL)
{
mylog(LOG_INFO, "KEY-Plus: Start motor.");
mylog(LOG_INFO, "IO: KEY-Plus: Start motor.");
Can_SetMotorGear(0, 1);
Can_SetMotorPower(0, MOTOR_PWR_MIN_PCT);
}
else
{
mylog(LOG_INFO, "KEY-Plus: Increase power.");
mylog(LOG_INFO, "IO: KEY-Plus: Increase power.");
Can_SetMotorPower(0, motctrl[0].iMotorPowerPct + MOTOR_PWR_STEP);
}
}
@@ -209,12 +211,12 @@ void IO_DoCyclic()
// minus key is pressed -> decrease power
if (motctrl[0].iMotorPowerPct > MOTOR_PWR_MIN_PCT)
{
mylog(LOG_INFO, "KEY-Minus: Decrease power.");
mylog(LOG_INFO, "IO: KEY-Minus: Decrease power.");
Can_SetMotorPower(0, motctrl[0].iMotorPowerPct - MOTOR_PWR_STEP);
}
else
{
mylog(LOG_INFO, "KEY-Minus: Stop motor.");
mylog(LOG_INFO, "IO: KEY-Minus: Stop motor.");
Can_SetMotorGear(0, 0);
}
}