danog/fast-gpio
1
0
Fork 0
mirror of https://github.com/danog/fast-gpio.git synced 2024-11-26 20:04:37 +01:00
Code Issues Projects Releases Wiki Activity

modularized the main function

Browse Source
This commit is contained in:
greenbreakfast 2015-09-12 17:25:27 +08:00
parent 9d3d06ced7
commit 15dde3957f
1 changed files with 89 additions and 42 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

131
src/main.cpp
View File

@ -5,32 +5,41 @@
#include <fastgpio.h>
#include <fastpwm.h>
#define VERBOSE 1
#define DEBUG 0
typedef enum e_GpioCmd {
GPIO_CMD_SET = 0,
GPIO_CMD_READ,
GPIO_CMD_PWM,
NUM_GPIO_CMD
} gpioCmd;
int main(int argc, char* argv[])
struct gpioSetup {
gpioCmd cmd;
int pinNumber;
int pinValue;
// pwm options
int bPwm;
int pwmFreq;
int pwmDuty;
};
void initGpioSetup (gpioSetup* obj)
{
int status = 0;
int cmd = -1;
obj->pinNumber = -1;
obj->pinValue = 0;
int pinNum;
int value;
int freq, duty;
FastGpio gpioObj;
FastPwm pwmObj;
int verbosity = 1;
int debugLevel = 0;
// object setup
gpioObj.SetVerbosity(verbosity);
gpioObj.SetDebugMode(debugLevel);
pwmObj.SetVerbosity(verbosity);
pwmObj.SetDebugMode(debugLevel);
obj->bPwm = 0;
obj->pwmFreq = 0;
obj->pwmDuty = 0;
}
int parseArguments(int argc, char* argv[], gpioSetup *setup)
{
// check for the correct number of arguments
if ( argc != 3 &&
argc != 4 &&
argc != 5
@ -41,57 +50,95 @@ int main(int argc, char* argv[])
printf("\t%s set <gpio> <value>\n", argv[0]);
printf("\t%s pwm <gpio> <freq> <duty>\n", argv[0]);
return EXIT_SUCCESS;
return EXIT_FAILURE;
}
// parse the command line arguments
// arg1 - command: read, set
// arg2 - gpio pin number
// arg3 - value to write in case of set
if (verbosity > 0) printf("Parsing arguments:\n");
if (strcmp(argv[1], "set") == 0 ) {
cmd = 0;
setup->cmd = GPIO_CMD_SET;
// get the write value
value = atoi(argv[3]);
setup->pinValue = atoi(argv[3]);
}
else if (strcmp(argv[1], "read") == 0 ) {
cmd = 1;
setup->cmd = GPIO_CMD_READ;
}
else if (strcmp(argv[1], "pwm") == 0 ) {
cmd = 2;
setup->cmd = GPIO_CMD_PWM;
// get the freq and duty values
freq = atoi(argv[3]);
duty = atoi(argv[4]);
setup->pwmFreq = atoi(argv[3]);
setup->pwmDuty = atoi(argv[4]);
}
else {
return EXIT_FAILURE;
}
// get the pin number
pinNum = atoi(argv[2]);
setup->pinNumber = atoi(argv[2]);
return EXIT_SUCCESS;
}
// function to accept gpio and pwm commands
int gpioRun(gpioSetup* setup)
{
int status = 0;
FastGpio gpioObj;
FastPwm pwmObj;
int verbosity = 1;
int debugLevel = 0;
// object setup
gpioObj.SetVerbosity(VERBOSE);
gpioObj.SetDebugMode(DEBUG);
pwmObj.SetVerbosity(VERBOSE);
pwmObj.SetDebugMode(DEBUG);
// object operations
switch (cmd) {
case 0:
if (verbosity > 0) printf("Setting GPIO%d to %d\n", pinNum, value);
switch (setup->cmd) {
case GPIO_CMD_SET:
if (verbosity > 0) printf("Setting GPIO%d to %d\n", setup->pinNumber, setup->pinValue);
gpioObj.SetDirection(pinNum, 1); // set to output
gpioObj.Set(pinNum, value);
gpioObj.SetDirection(setup->pinNumber, 1); // set to output
gpioObj.Set(setup->pinNumber, setup->pinValue);
break;
case 1:
gpioObj.Read(pinNum, value);
if (verbosity > 0) printf("Read GPIO%d: %d\n", pinNum, value);
case GPIO_CMD_READ:
gpioObj.Read(setup->pinNumber, setup->pinValue);
if (verbosity > 0) printf("Read GPIO%d: %d\n", setup->pinNumber, setup->pinValue);
break;
case 2:
pwmObj.Pwm(pinNum, freq, duty);
case GPIO_CMD_PWM:
pwmObj.Pwm(setup->pinNumber, setup->pwmFreq, setup->pwmDuty);
default:
break;
}
return EXIT_SUCCESS;
}
int main(int argc, char* argv[])
{
gpioSetup* setup = new gpioSetup;
// parse the arguments
if (parseArguments(argc, argv, setup) == EXIT_FAILURE) {
return EXIT_FAILURE;
}
// run the command
gpioRun(setup);
return 0;
}