Skip to content
Permalink
Branch: master
Find file Copy path
Find file Copy path
Fetching contributors…
Cannot retrieve contributors at this time
433 lines (391 sloc) 9.43 KB
/*
* (C) Copyright 2011 Henrik Nordstrom <henrik@henriknordstrom.net>
*
* This program is free software; you can redistribute it and/or
* modify it under the terms of the GNU General Public License as
* published by the Free Software Foundation; either version 2 of
* the License, or (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program; if not, write to the Free Software
* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
* MA 02111-1307 USA
*/
#include <errno.h>
#include <stdio.h>
#include <stdint.h>
#include <string.h>
#include <unistd.h>
#include <stdlib.h>
#include <errno.h>
#ifndef NO_MMAP
#include <sys/mman.h>
#endif
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include "common.h"
#include "portable_endian.h"
#define PIO_REG_SIZE 0x228 /*0x300*/
#define PIO_PORT_SIZE 0x24
struct pio_status {
int mul_sel;
int pull;
int drv_level;
int data;
};
#define PIO_REG_CFG(B, N, I) ((B) + (N)*0x24 + ((I)<<2) + 0x00)
#define PIO_REG_DLEVEL(B, N, I) ((B) + (N)*0x24 + ((I)<<2) + 0x14)
#define PIO_REG_PULL(B, N, I) ((B) + (N)*0x24 + ((I)<<2) + 0x1C)
#define PIO_REG_DATA(B, N) ((B) + (N)*0x24 + 0x10)
#define PIO_NR_PORTS 9 /* A-I */
#define LE32TOH(X) le32toh(*((uint32_t*)(X)))
static int pio_get(const char *buf, uint32_t port, uint32_t port_num, struct pio_status *pio)
{
uint32_t val;
uint32_t port_num_func, port_num_pull;
uint32_t offset_func, offset_pull;
port_num_func = port_num >> 3;
offset_func = ((port_num & 0x07) << 2);
port_num_pull = port_num >> 4;
offset_pull = ((port_num & 0x0f) << 1);
/* func */
val = LE32TOH(PIO_REG_CFG(buf, port, port_num_func));
pio->mul_sel = (val>>offset_func) & 0x07;
/* pull */
val = LE32TOH(PIO_REG_PULL(buf, port, port_num_pull));
pio->pull = (val>>offset_pull) & 0x03;
/* dlevel */
val = LE32TOH(PIO_REG_DLEVEL(buf, port, port_num_pull));
pio->drv_level = (val>>offset_pull) & 0x03;
/* i/o data */
if (pio->mul_sel > 1)
pio->data = -1;
else {
val = LE32TOH(PIO_REG_DATA(buf, port));
pio->data = (val >> port_num) & 0x01;
}
return 1;
}
static int pio_set(char *buf, uint32_t port, uint32_t port_num, struct pio_status *pio)
{
uint32_t *addr, val;
uint32_t port_num_func, port_num_pull;
uint32_t offset_func, offset_pull;
port_num_func = port_num >> 3;
offset_func = ((port_num & 0x07) << 2);
port_num_pull = port_num >> 4;
offset_pull = ((port_num & 0x0f) << 1);
/* func */
if (pio->mul_sel >= 0) {
addr = (uint32_t*)PIO_REG_CFG(buf, port, port_num_func);
val = le32toh(*addr);
val &= ~(0x07 << offset_func);
val |= (pio->mul_sel & 0x07) << offset_func;
*addr = htole32(val);
}
/* pull */
if (pio->pull >= 0) {
addr = (uint32_t*)PIO_REG_PULL(buf, port, port_num_pull);
val = le32toh(*addr);
val &= ~(0x03 << offset_pull);
val |= (pio->pull & 0x03) << offset_pull;
*addr = htole32(val);
}
/* dlevel */
if (pio->drv_level >= 0) {
addr = (uint32_t*)PIO_REG_DLEVEL(buf, port, port_num_pull);
val = le32toh(*addr);
val &= ~(0x03 << offset_pull);
val |= (pio->drv_level & 0x03) << offset_pull;
*addr = htole32(val);
}
/* data */
if (pio->data >= 0) {
addr = (uint32_t*)PIO_REG_DATA(buf, port);
val = le32toh(*addr);
if (pio->data)
val |= (0x01 << port_num);
else
val &= ~(0x01 << port_num);
*addr = htole32(val);
}
return 1;
}
static void pio_print(int port, int port_nr, struct pio_status *pio)
{
printf("P%c%d", 'A'+port, port_nr);
printf("<%x>", pio->mul_sel);
printf("<%x>", pio->pull);
printf("<%x>", pio->drv_level);
if (pio->data >= 0)
printf("<%x>", pio->data);
fputc('\n', stdout);
}
static void print(const char *buf)
{
int port, i;
struct pio_status pio;
for (port=0; port < PIO_NR_PORTS; port++) {
for (i=0; i<32; i++) {
if (pio_get(buf, port, i, &pio)) {
pio_print(port, i, &pio);
}
}
}
}
static const char *argv0;
static __attribute__((noreturn)) void usage(int rc )
{
fputs("sunxi-pio " VERSION "\n\n", stderr);
fprintf(stderr, "usage: %s -m|-i input [-o output] pin..\n", argv0);
fprintf(stderr," -m mmap - read pin state from system\n");
fprintf(stderr," -i read pin state from file\n");
fprintf(stderr," -o save pin state data to file\n");
fprintf(stderr," print Show all pins\n");
fprintf(stderr," Pxx Show pin\n");
fprintf(stderr," Pxx<mode><pull><drive><data> Configure pin\n");
fprintf(stderr," Pxx=data,drive Configure GPIO output\n");
fprintf(stderr," Pxx*count Oscillate GPIO output (mmap mode only)\n");
fprintf(stderr," Pxx?pull Configure GPIO input\n");
fprintf(stderr," clean Clean input pins\n");
fprintf(stderr, "\n mode 0-7, 0=input, 1=output, 2-7 I/O function\n");
fprintf(stderr, " pull 0=none, 1=up, 2=down\n");
fprintf(stderr, " drive 0-3, I/O drive level\n");
exit(rc);
}
static void parse_pin(int *port, int *pin, const char *name)
{
if (*name == 'P') name++;
*port = *name++ - 'A';
*pin = atoi(name);
}
static void cmd_show_pin(char *buf, const char *pin)
{
int port, port_nr;
struct pio_status pio;
parse_pin(&port, &port_nr, pin);
if (!pio_get(buf, port, port_nr, &pio))
usage(1);
pio_print(port, port_nr, &pio);
}
static int parse_int(int *dst, const char *in)
{
int value;
char *next;
errno = 0;
value = strtol(in, &next, 0);
if (!errno && next != in) {
*dst = value;
return 0;
}
return -1;
}
static void cmd_set_pin(char *buf, const char *pin)
{
int port, port_nr;
const char *t = pin;
struct pio_status pio;
parse_pin(&port, &port_nr, pin);
if (!pio_get(buf, port, port_nr, &pio))
usage(1);
if ((t = strchr(pin, '='))) {
pio.mul_sel = 1;
if (t) {
t++;
parse_int(&pio.data, t);
}
if (t)
t = strchr(t, ',');
if (t) {
t++;
parse_int(&pio.drv_level, t);
}
} else if ((t = strchr(pin, '?'))) {
pio.mul_sel = 0;
pio.data = 0;
pio.drv_level = 0;
if (t) {
t++;
parse_int(&pio.pull, t);
}
} else if ((t = strchr(pin, '<'))) {
if (t) {
t++;
parse_int(&pio.mul_sel, t);
}
if (t)
t = strchr(t, '<');
if (t) {
t++;
parse_int(&pio.pull, t);
}
if (t)
t = strchr(t, '<');
if (t) {
t++;
parse_int(&pio.drv_level, t);
}
if (t)
t = strchr(t, '<');
if (t) {
t++;
parse_int(&pio.data, t);
}
}
pio_set(buf, port, port_nr, &pio);
}
static void cmd_oscillate(char *buf, const char *pin)
{
int port, port_nr;
const char *t = pin;
int i, n = 0;
uint32_t *addr, val;
parse_pin(&port, &port_nr, pin);
{
struct pio_status pio;
if (!pio_get(buf, port, port_nr, &pio))
usage(1);
pio.mul_sel = 1;
pio_set(buf, port, port_nr, &pio);
}
addr = (uint32_t*)PIO_REG_DATA(buf, port);
t = strchr(pin, '*');
parse_int(&n, t+1);
val = le32toh(*addr);
for (i = 0; i < n; i++) {
val ^= 1 << port_nr;
*addr = htole32(val);
}
}
static void cmd_clean(char *buf)
{
int port, i;
struct pio_status pio;
for (port=0; port < PIO_NR_PORTS; port++) {
for (i=0; i<32; i++) {
if (pio_get(buf, port, i, &pio)) {
if (pio.mul_sel == 0) {
pio.data = 0;
pio_set(buf, port, i, &pio);
}
}
}
}
}
static int do_command(char *buf, const char **args, int UNUSED(argc))
{
const char *command = args[0];
if (*command == 'P') {
if (strchr(command, '<'))
cmd_set_pin(buf, command);
else if (strchr(command, '='))
cmd_set_pin(buf, command);
else if (strchr(command, '?'))
cmd_set_pin(buf, command);
else if (strchr(command, '*'))
cmd_oscillate(buf, command);
else
cmd_show_pin(buf, command);
}
else if (strcmp(command, "print") == 0)
print(buf);
else if (strcmp(command, "clean") == 0)
cmd_clean(buf);
else usage(1);
return 1;
}
int main(int argc, char **argv)
{
int opt;
FILE *in = NULL;
FILE *out = NULL;
const char *in_name = NULL;
const char *out_name = NULL;
char buf_[PIO_REG_SIZE];
char *buf = buf_;
int do_mmap = 0;
argv0 = argv[0];
while ((opt = getopt(argc, argv, "i:o:m")) != -1) {
switch(opt) {
case '?':
usage(0);
case 'm':
do_mmap = 1;
break;
case 'i':
in_name = optarg;
break;
case 'o':
out_name = optarg;
break;
}
}
if (!in_name && !do_mmap)
usage(1);
if (do_mmap) {
#ifdef NO_MMAP
errno = ENOSYS; /* Function not implemented */
perror("mmap PIO");
#else
int pagesize = sysconf(_SC_PAGESIZE);
int fd = open("/dev/mem",O_RDWR);
int addr = 0x01c20800 & ~(pagesize-1);
int offset = 0x01c20800 & (pagesize-1);
if (fd == -1) {
perror("open /dev/mem");
exit(1);
}
buf = mmap(NULL, (0x800 + pagesize - 1) & ~(pagesize-1), PROT_WRITE|PROT_READ, MAP_SHARED, fd, addr);
if (!buf) {
perror("mmap PIO");
exit(1);
}
close(fd);
buf += offset;
#endif
}
if (in_name) {
if (strcmp(in_name, "-") == 0) {
in = stdin;
} else {
in = fopen(in_name, "rb");
if (!in) {
perror("open input");
exit(1);
}
}
}
if (in) {
if (fread(buf, PIO_REG_SIZE, 1, in) != 1) {
perror("read input");
exit(1);
}
if (in != stdin)
fclose(in);
}
while(optind < argc) {
optind += do_command(buf, (const char **)(argv + optind), argc - optind);
}
if (out_name) {
if (strcmp(out_name, "-") == 0) {
out = stdout;
} else {
out = fopen(out_name, "wb");
if (!out) {
perror("open output");
exit(1);
}
}
if (fwrite(buf, PIO_REG_SIZE, 1, out) != 1) {
perror("write output");
exit(1);
}
}
return 0;
}
You can’t perform that action at this time.