diff options
author | Gregory Nutt <gnutt@nuttx.org> | 2014-06-27 10:02:52 -0600 |
---|---|---|
committer | Gregory Nutt <gnutt@nuttx.org> | 2014-06-27 10:02:52 -0600 |
commit | e3f5f32248ef8a594a375f1df521b9fb7c1aaeb1 (patch) | |
tree | 8a2fa863140bf96e8450143264c0c6fddf5efe26 /apps/system/mdio | |
parent | 51282717666bc7b3845a23a66fb63ea5057d5fc2 (diff) | |
download | px4-nuttx-e3f5f32248ef8a594a375f1df521b9fb7c1aaeb1.tar.gz px4-nuttx-e3f5f32248ef8a594a375f1df521b9fb7c1aaeb1.tar.bz2 px4-nuttx-e3f5f32248ef8a594a375f1df521b9fb7c1aaeb1.zip |
Add apps/system/mdio from Lazlo
Diffstat (limited to 'apps/system/mdio')
-rw-r--r-- | apps/system/mdio/.gitignore | 11 | ||||
-rw-r--r-- | apps/system/mdio/Kconfig | 14 | ||||
-rw-r--r-- | apps/system/mdio/Makefile | 109 | ||||
-rw-r--r-- | apps/system/mdio/mdio_main.c | 238 |
4 files changed, 372 insertions, 0 deletions
diff --git a/apps/system/mdio/.gitignore b/apps/system/mdio/.gitignore new file mode 100644 index 000000000..fa1ec7579 --- /dev/null +++ b/apps/system/mdio/.gitignore @@ -0,0 +1,11 @@ +/Make.dep +/.depend +/.built +/*.asm +/*.obj +/*.rel +/*.lst +/*.sym +/*.adb +/*.lib +/*.src diff --git a/apps/system/mdio/Kconfig b/apps/system/mdio/Kconfig new file mode 100644 index 000000000..878ac4adc --- /dev/null +++ b/apps/system/mdio/Kconfig @@ -0,0 +1,14 @@ +# +# For a description of the syntax of this configuration file, +# see misc/tools/kconfig-language.txt. +# + +config SYSTEM_MDIO + bool "MDIO tool" + default n + depends on NETDEV_PHY_IOCTL + ---help--- + Enable the MDIO tool + +if SYSTEM_MDIO +endif diff --git a/apps/system/mdio/Makefile b/apps/system/mdio/Makefile new file mode 100644 index 000000000..8a9fea23a --- /dev/null +++ b/apps/system/mdio/Makefile @@ -0,0 +1,109 @@ +############################################################################ +# apps/examples/mdio/Makefile +# +# Copyright (C) 2008, 2010-2013 Gregory Nutt. All rights reserved. +# Author: Gregory Nutt <gnutt@nuttx.org> +# +# Redistribution and use in source and binary forms, with or without +# modification, are permitted provided that the following conditions +# are met: +# +# 1. Redistributions of source code must retain the above copyright +# notice, this list of conditions and the following disclaimer. +# 2. Redistributions in binary form must reproduce the above copyright +# notice, this list of conditions and the following disclaimer in +# the documentation and/or other materials provided with the +# distribution. +# 3. Neither the name NuttX nor the names of its contributors may be +# used to endorse or promote products derived from this software +# without specific prior written permission. +# +# THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS +# "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT +# LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS +# FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE +# COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, +# INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, +# BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS +# OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED +# AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT +# LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN +# ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE +# POSSIBILITY OF SUCH DAMAGE. +# +############################################################################ + +-include $(TOPDIR)/.config +-include $(TOPDIR)/Make.defs +include $(APPDIR)/Make.defs + +# MDIO tool built-in application info + +APPNAME = mdio +PRIORITY = SCHED_PRIORITY_DEFAULT +STACKSIZE = 2048 + +# MDIO tool + +ASRCS = +CSRCS = mdio_main.c + +AOBJS = $(ASRCS:.S=$(OBJEXT)) +COBJS = $(CSRCS:.c=$(OBJEXT)) + +SRCS = $(ASRCS) $(CSRCS) +OBJS = $(AOBJS) $(COBJS) + +ifeq ($(CONFIG_WINDOWS_NATIVE),y) + BIN = ..\..\libapps$(LIBEXT) +else +ifeq ($(WINTOOL),y) + BIN = ..\\..\\libapps$(LIBEXT) +else + BIN = ../../libapps$(LIBEXT) +endif +endif + +ROOTDEPPATH = --dep-path . + +# Common build + +VPATH = + +all: .built +.PHONY: clean depend distclean + +$(AOBJS): %$(OBJEXT): %.S + $(call ASSEMBLE, $<, $@) + +$(COBJS): %$(OBJEXT): %.c + $(call COMPILE, $<, $@) + +.built: $(OBJS) + $(call ARCHIVE, $(BIN), $(OBJS)) + @touch .built + +ifeq ($(CONFIG_NSH_BUILTIN_APPS),y) +$(BUILTIN_REGISTRY)$(DELIM)$(APPNAME)_main.bdat: $(DEPCONFIG) Makefile + $(call REGISTER,$(APPNAME),$(PRIORITY),$(STACKSIZE),$(APPNAME)_main) + +context: $(BUILTIN_REGISTRY)$(DELIM)$(APPNAME)_main.bdat +else +context: +endif + +.depend: Makefile $(SRCS) + @$(MKDEP) $(ROOTDEPPATH) "$(CC)" -- $(CFLAGS) -- $(SRCS) >Make.dep + @touch $@ + +depend: .depend + +clean: + $(call DELFILE, .built) + $(call CLEAN) + +distclean: clean + $(call DELFILE, Make.dep) + $(call DELFILE, .depend) + +-include Make.dep diff --git a/apps/system/mdio/mdio_main.c b/apps/system/mdio/mdio_main.c new file mode 100644 index 000000000..3b5f3fa94 --- /dev/null +++ b/apps/system/mdio/mdio_main.c @@ -0,0 +1,238 @@ +/**************************************************************************** + * examples/mdio/mdio_main.c + * + * Copyright (C) 2008, 2011-2012 Gregory Nutt. All rights reserved. + * Author: Gregory Nutt <gnutt@nuttx.org> + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in + * the documentation and/or other materials provided with the + * distribution. + * 3. Neither the name NuttX nor the names of its contributors may be + * used to endorse or promote products derived from this software + * without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS + * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT + * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS + * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE + * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, + * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, + * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS + * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED + * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN + * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE + * POSSIBILITY OF SUCH DAMAGE. + * + ****************************************************************************/ + +/**************************************************************************** + * Included Files + ****************************************************************************/ + +#include <nuttx/config.h> +#include <stdio.h> +#include <stdlib.h> + +#include <unistd.h> +#include <string.h> +#include <errno.h> +#include <sys/socket.h> +#include <sys/ioctl.h> +#include <netinet/in.h> + +#include <net/if.h> + +/**************************************************************************** + * Definitions + ****************************************************************************/ + +#define CONFIG_HELLO_IPADDR 0xc0a8eacd +#define CONFIG_HELLO_PORT 81 + +/**************************************************************************** + * Private Data + ****************************************************************************/ + +/* Socket related variables */ + +static int g_listen_fd; + +static struct sockaddr_in g_sa; + +int initialize_socket(void) +{ + /* Prepare listen address */ + + g_sa.sin_family = AF_INET; + g_sa.sin_port = HTONS(CONFIG_HELLO_PORT); + g_sa.sin_addr.s_addr = HTONL(CONFIG_HELLO_IPADDR); + + /* Open listening socket */ + + g_listen_fd = socket(g_sa.sin_family, SOCK_DGRAM, 0); + + /* Verify socket creation */ + + if (!(g_listen_fd > 0)) + { +// printf("call to %s() failed (fd = %d)!\n", "socket", g_listen_fd); + return -1; + } else { +// printf("got socket with fd %d\n", g_listen_fd); + } + + return 0; +} + +int get_phy_id(void) +{ + int ret; + uint16_t phy_id; + struct ifreq ifr; + + /* Prepare ifreq */ + + strncpy(ifr.ifr_name, "eth0", IFNAMSIZ); + + ret = ioctl(g_listen_fd, SIOCGMIIPHY, (unsigned long) &ifr); + + printf("call to %s() ", "ioctl"); + + if (ret != 0) + { + printf("failed! (value %d, errno %d)\n", ret, errno); + return -1; + } + + phy_id = ifr.ifr_mii_phy_id; + + return phy_id; +} + +int get_phy_reg(uint16_t phy_id, uint16_t reg_num, uint16_t *val) +{ + int ret; + struct ifreq ifr; + + strncpy(ifr.ifr_name, "eth0", IFNAMSIZ); + + ifr.ifr_mii_phy_id = phy_id; + ifr.ifr_mii_reg_num = reg_num; + + ret = ioctl(g_listen_fd, SIOCGMIIREG, (unsigned long) &ifr); + + if(ret == OK) + { + *val = ifr.ifr_mii_val_out; + } + + return ret; +} + +int set_phy_reg(uint16_t phy_id, uint16_t reg_num, uint16_t val) +{ + int ret; + struct ifreq ifr; + + strncpy(ifr.ifr_name, "eth0", IFNAMSIZ); + + ifr.ifr_mii_phy_id = phy_id; + ifr.ifr_mii_reg_num = reg_num; + ifr.ifr_mii_val_in = val; + + ret = ioctl(g_listen_fd, SIOCSMIIREG, (unsigned long) &ifr); + + return ret; +} + +/**************************************************************************** + * Public Functions + ****************************************************************************/ + +/**************************************************************************** + * mdio_main + ****************************************************************************/ + +int mdio_main(int argc, char *argv[]) +{ + int ret; + int i; + + /* test related */ + + uint16_t phy_id; + uint16_t reg_num; + uint16_t val_in; + uint16_t val_out; + + /*--- SETUP --------------------------------------------------------------*/ + + if (argc == 1) { + printf("usage:\n"); + printf("\n"); + printf(" %s phy_id reg_no -- read register\n", argv[0]); + printf(" %s phy_id reg_no value -- write register\n", argv[0]); + printf("\n"); + return -1; + } + + initialize_socket(); + + if (argc == 4) /* Write to register */ + { + phy_id = strtol(argv[1], NULL, 16); + reg_num = strtol(argv[2], NULL, 16); + val_in = strtol(argv[3], NULL, 16); + + ret = set_phy_reg(phy_id, reg_num, val_in); + if (ret != 0) + printf("%s() returned %d\n", "set_phy_reg", ret); + } + else if (argc == 3) /* Read from register */ + { + phy_id = strtol(argv[1], NULL, 16); + reg_num = strtol(argv[2], NULL, 16); + + ret = get_phy_reg(phy_id, reg_num, &val_out); + if (ret != 0) + printf("%s() returned %d\n", "get_phy_reg", ret); + else + printf("0x%4x\n", val_out); + } + else if (argc == 2) + { + phy_id = strtol(argv[1], NULL, 16); + + for(i = 0; i < 32; i++) + { + ret = get_phy_reg(phy_id, i, &val_out); + + printf("phy[%d][%d] = 0x%4x\n", phy_id, i, val_out); + } + } + else + { + /* Read the PHY address */ + + phy_id = get_phy_id(); + + if(phy_id < 1) + { + /* failed (can not be negative) */ + printf("getting phy id failed\n"); + } else { + printf("phy_id = %d\n", phy_id); + } + } + + return 0; +} + |