59 lines
1.6 KiB
C
Executable File
59 lines
1.6 KiB
C
Executable File
/*
|
|
* Copyright (c) 2022 rockchip
|
|
*
|
|
*/
|
|
|
|
/*
|
|
* Test in sweeperrobort board,
|
|
* switch left-moto-lift button,
|
|
* the left moto should be started when we push the button
|
|
*/
|
|
#include <stdio.h>
|
|
#include <unistd.h>
|
|
#include "rk_gpio.h"
|
|
#include "rk_pwm.h"
|
|
|
|
#define PWM_USE 2
|
|
|
|
int main(int argc, char *argv[])
|
|
{
|
|
int ret, store;
|
|
bool is_quit = true;
|
|
uint32_t in_pin = GPIO(RK_GPIO4, RK_PB6);
|
|
uint32_t out_pin = GPIO(RK_GPIO1, RK_PA6);
|
|
|
|
rk_gpio_export_direction(in_pin, GPIO_DIRECTION_INPUT);
|
|
rk_gpio_export_direction(out_pin, GPIO_DIRECTION_OUTPUT);
|
|
|
|
rk_gpio_set_value(out_pin, 0);
|
|
rk_pwm_init(PWM_USE, 62500, 31250, PWM_POLARITY_NORMAL);
|
|
|
|
char cmd[64];
|
|
printf("\n#Usage: input 'quit' to exit programe!\n");
|
|
|
|
while (is_quit) {
|
|
fgets(cmd, sizeof(cmd), stdin);
|
|
usleep(20000);
|
|
ret = rk_gpio_get_value(in_pin);
|
|
if (ret != store) {
|
|
store = ret;
|
|
rk_gpio_set_value(out_pin, ret);
|
|
rk_pwm_set_enable(PWM_USE, (bool)ret);
|
|
|
|
printf( "[TEST_INFO]\n"
|
|
"-- in_gpio: in %d, value %d\n"
|
|
"-- out_gpio: in %d, value %d\n"
|
|
"-- pwm: period %d, duty %d, polartiy %d, enable %d\n",
|
|
rk_gpio_get_direction(in_pin), rk_gpio_get_value(in_pin),
|
|
rk_gpio_get_direction(out_pin), rk_gpio_get_value(out_pin),
|
|
rk_pwm_get_period(PWM_USE), rk_pwm_get_duty(PWM_USE),
|
|
rk_pwm_get_polarity(PWM_USE), rk_pwm_get_enable(PWM_USE));
|
|
}
|
|
}
|
|
rk_gpio_unexport(in_pin);
|
|
rk_gpio_unexport(out_pin);
|
|
rk_pwm_deinit(PWM_USE);
|
|
return 0;
|
|
}
|
|
|