mirror of
https://github.com/brain-hackers/u-boot-brain
synced 2024-08-20 00:48:52 +09:00
75 lines
1.9 KiB
C
75 lines
1.9 KiB
C
/*
|
|
* Control GPIO pins on the fly
|
|
*
|
|
* Copyright (c) 2008 Analog Devices Inc.
|
|
*
|
|
* Licensed under the GPL-2 or later.
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <command.h>
|
|
|
|
#include <asm/blackfin.h>
|
|
|
|
int do_gpio(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
|
|
{
|
|
if (argc != 3) {
|
|
show_usage:
|
|
printf("Usage:\n%s\n", cmdtp->usage);
|
|
return 1;
|
|
}
|
|
|
|
/* parse the behavior */
|
|
ulong port_cmd = 0;
|
|
switch (argv[1][0]) {
|
|
case 'i': break;
|
|
case 's': port_cmd = (PORTFIO_SET - PORTFIO); break;
|
|
case 'c': port_cmd = (PORTFIO_CLEAR - PORTFIO); break;
|
|
case 't': port_cmd = (PORTFIO_TOGGLE - PORTFIO); break;
|
|
default: goto show_usage;
|
|
}
|
|
|
|
/* parse the pin with format: [p]<fgh><#> */
|
|
const char *str_pin = argv[2];
|
|
|
|
/* grab the [p]<fgh> portion */
|
|
ulong port_base;
|
|
if (*str_pin == 'p') ++str_pin;
|
|
switch (*str_pin) {
|
|
case 'f': port_base = PORTFIO; break;
|
|
case 'g': port_base = PORTGIO; break;
|
|
case 'h': port_base = PORTHIO; break;
|
|
default: goto show_usage;
|
|
}
|
|
|
|
/* grab the <#> portion */
|
|
ulong pin = simple_strtoul(str_pin+1, NULL, 10);
|
|
ulong pin_mask = (1 << pin);
|
|
if (pin > 15)
|
|
goto show_usage;
|
|
|
|
/* finally, let's do it: set direction and exec command */
|
|
switch (*str_pin) {
|
|
case 'f': bfin_write_PORTF_FER(bfin_read_PORTF_FER() & ~pin_mask); break;
|
|
case 'g': bfin_write_PORTG_FER(bfin_read_PORTG_FER() & ~pin_mask); break;
|
|
case 'h': bfin_write_PORTH_FER(bfin_read_PORTH_FER() & ~pin_mask); break;
|
|
}
|
|
|
|
ulong port_dir = port_base + (PORTFIO_DIR - PORTFIO);
|
|
if (argv[1][0] == 'i')
|
|
bfin_write16(port_dir, bfin_read16(port_dir) & ~pin_mask);
|
|
else {
|
|
bfin_write16(port_dir, bfin_read16(port_dir) | pin_mask);
|
|
bfin_write16(port_base + port_cmd, pin_mask);
|
|
}
|
|
|
|
printf("gpio: pin %li on port %c has been %c\n", pin, *str_pin, argv[1][0]);
|
|
|
|
return 0;
|
|
}
|
|
|
|
U_BOOT_CMD(gpio, 3, 0, do_gpio,
|
|
"gpio - set/clear/toggle gpio output pins\n",
|
|
"<s|c|t> <port><pin>\n"
|
|
" - set/clear/toggle the specified pin\n");
|