simplified and bugfixed Cooja's IP address interface, added two

variables in uip-ds6.c to allow Cooja to extract addresses from memory
This commit is contained in:
Fredrik Osterlind 2012-06-01 15:47:22 +02:00
parent ebd9573574
commit b9f1b9b205
2 changed files with 101 additions and 128 deletions

View file

@ -42,6 +42,7 @@
*/ */
#include <string.h> #include <string.h>
#include <stdlib.h> #include <stdlib.h>
#include <stddef.h>
#include "lib/random.h" #include "lib/random.h"
#include "net/uip-nd6.h" #include "net/uip-nd6.h"
#include "net/uip-ds6.h" #include "net/uip-ds6.h"
@ -78,6 +79,10 @@ uip_ds6_defrt_t uip_ds6_defrt_list[UIP_DS6_DEFRT_NB]; /** \brief Def
uip_ds6_prefix_t uip_ds6_prefix_list[UIP_DS6_PREFIX_NB]; /** \brief Prefix list */ uip_ds6_prefix_t uip_ds6_prefix_list[UIP_DS6_PREFIX_NB]; /** \brief Prefix list */
uip_ds6_route_t uip_ds6_routing_table[UIP_DS6_ROUTE_NB]; /** \brief Routing table */ uip_ds6_route_t uip_ds6_routing_table[UIP_DS6_ROUTE_NB]; /** \brief Routing table */
/* Used by Cooja to enable extraction of addresses from memory.*/
uint8_t uip_ds6_addr_size;
uint8_t uip_ds6_netif_addr_list_offset;
/** @} */ /** @} */
/* "full" (as opposed to pointer) ip address used in this file, */ /* "full" (as opposed to pointer) ip address used in this file, */
@ -106,6 +111,8 @@ uip_ds6_init(void)
memset(uip_ds6_prefix_list, 0, sizeof(uip_ds6_prefix_list)); memset(uip_ds6_prefix_list, 0, sizeof(uip_ds6_prefix_list));
memset(&uip_ds6_if, 0, sizeof(uip_ds6_if)); memset(&uip_ds6_if, 0, sizeof(uip_ds6_if));
memset(uip_ds6_routing_table, 0, sizeof(uip_ds6_routing_table)); memset(uip_ds6_routing_table, 0, sizeof(uip_ds6_routing_table));
uip_ds6_addr_size = sizeof(struct uip_ds6_addr);
uip_ds6_netif_addr_list_offset = offsetof(struct uip_ds6_netif, addr_list);
/* Set interface parameters */ /* Set interface parameters */
uip_ds6_if.link_mtu = UIP_LINK_MTU; uip_ds6_if.link_mtu = UIP_LINK_MTU;

View file

@ -25,8 +25,6 @@
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY * 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 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
* SUCH DAMAGE. * SUCH DAMAGE.
*
* $Id: IPAddress.java,v 1.11 2010/12/07 10:40:08 fros4943 Exp $
*/ */
package se.sics.cooja.interfaces; package se.sics.cooja.interfaces;
@ -41,13 +39,12 @@ import javax.swing.JPanel;
import org.apache.log4j.Logger; import org.apache.log4j.Logger;
import org.jdom.Element; import org.jdom.Element;
import se.sics.cooja.AddressMemory;
import se.sics.cooja.ClassDescription; import se.sics.cooja.ClassDescription;
import se.sics.cooja.Mote; import se.sics.cooja.Mote;
import se.sics.cooja.MoteInterface; import se.sics.cooja.MoteInterface;
import se.sics.cooja.MoteTimeEvent; import se.sics.cooja.MoteMemory;
import se.sics.cooja.Simulation; import se.sics.cooja.MoteMemory.MemoryEventType;
import se.sics.cooja.TimeEvent; import se.sics.cooja.MoteMemory.MemoryMonitor;
/** /**
* Read-only interface to IPv4 or IPv6 address. * Read-only interface to IPv4 or IPv6 address.
@ -57,61 +54,34 @@ import se.sics.cooja.TimeEvent;
@ClassDescription("IP Address") @ClassDescription("IP Address")
public class IPAddress extends MoteInterface { public class IPAddress extends MoteInterface {
private static Logger logger = Logger.getLogger(IPAddress.class); private static Logger logger = Logger.getLogger(IPAddress.class);
private AddressMemory moteMem; private final MoteMemory moteMem;
private static final int IPv6_MAX_ADDRESSES = 4; private static final int IPv6_MAX_ADDRESSES = 4;
private int ipv6NetworkInterfaceAddressOffset; private boolean ipv6IsGlobal = false;
private int ipv6AddressStructSize; private int ipv6AddressIndex = -1;
private boolean ipv6IsGlobal = false;
private int ipv6AddressIndex = -1; private static final int MONITORED_SIZE = 150;
private MemoryMonitor memMonitor;
public IPAddress(final Mote mote) { public IPAddress(final Mote mote) {
moteMem = (AddressMemory) mote.getMemory(); moteMem = mote.getMemory();
/* ipV6: Struct sizes and offsets */ memMonitor = new MemoryMonitor() {
int intLength = moteMem.getIntegerLength(); public void memoryChanged(MoteMemory memory, MemoryEventType type, int address) {
int longLength = 4; if (type != MemoryEventType.WRITE) {
ipv6NetworkInterfaceAddressOffset /* net/uip-ds6.h:uip_ds6_netif_t */ =
4 /* link_mtu */ +
align(1, intLength) /* cur_hop_limit */ +
4 /* base_reachable_time */ +
4 /* reachable_time */ +
4 /* retrans_timer */ +
align(1, intLength) /* maxdadns */;
ipv6AddressStructSize /* net/uip-ds6.h:uip_ds6_addr_t */ =
align(1, 2) /* isused */ +
16 /* ipaddr, aligned on 16 bits */ +
align(3, intLength) /* state + type + isinfinite */ +
2*longLength /* vlifetime */ +
2*longLength /* dadtimer */ +
align(1, intLength) /* dadnscount */;
ipv6AddressStructSize = align(ipv6AddressStructSize, intLength);
/* Detect startup IP (only zeroes) */
TimeEvent updateWhenAddressReady = new MoteTimeEvent(mote, 0) {
public void execute(long t) {
if (!isVersion4() && !isVersion6()) {
return; return;
} }
setChanged();
String ipString = getIPString(); notifyObservers();
ipString = ipString.replace(".", "");
ipString = ipString.replace(":", "");
ipString = ipString.replace("0", "");
if (!ipString.isEmpty()) {
setChanged();
notifyObservers();
return;
}
/* Postpone until IP has been set */
mote.getSimulation().scheduleEvent(
this,
mote.getSimulation().getSimulationTime() + Simulation.MILLISECOND);
return;
} }
}; };
updateWhenAddressReady.execute(0); if (isVersion4()) {
moteMem.addMemoryMonitor(moteMem.getVariableAddress("uip_hostaddr"), 4, memMonitor);
} else if (isVersion6()) {
moteMem.addMemoryMonitor(moteMem.getVariableAddress("uip_ds6_netif_addr_list_offset"), 1, memMonitor);
moteMem.addMemoryMonitor(moteMem.getVariableAddress("uip_ds6_addr_size"), 1, memMonitor);
moteMem.addMemoryMonitor(moteMem.getVariableAddress("uip_ds6_if"), MONITORED_SIZE, memMonitor);
}
} }
/** /**
@ -130,80 +100,77 @@ public class IPAddress extends MoteInterface {
ipString += (0xFF & ip[3]); ipString += (0xFF & ip[3]);
return ipString; return ipString;
} else if (isVersion6()) { } else if (isVersion6()) {
String ipString = getUncompressedIPv6Address(); String ipString = getUncompressedIPv6Address();
if (ipString != null) { return compressIPv6Address(ipString);
ipString = compressIPv6Address(ipString);
}
return ipString;
} }
return null; return null;
} }
public static String compressIPv6Address(String ipString) { public static String compressIPv6Address(String ipString) {
while (ipString.contains(":0000:")) { if (ipString.contains(":0000:0000:0000:0000:")) {
ipString = ipString.replaceAll(":0000:", "::"); ipString = ipString.replace(":0000:0000:0000:0000:", "::");
} } else if (ipString.contains(":0000:0000:0000:")) {
while (ipString.contains("0000")) { ipString = ipString.replace(":0000:0000:0000:", "::");
ipString = ipString.replaceAll("0000", "0"); } else if (ipString.contains(":0000:0000:")) {
} ipString = ipString.replace(":0000:0000:", "::");
while (ipString.contains(":::")) { } else if (ipString.contains(":0000:")) {
ipString = ipString.replaceAll(":::", "::"); ipString = ipString.replace(":0000:", "::");
} }
while (ipString.contains(":0")) { while (ipString.contains(":0")) {
ipString = ipString.replaceAll(":0", ":"); ipString = ipString.replaceAll(":0", ":");
} }
if (ipString.endsWith(":")) {
ipString = ipString + "0";
}
return ipString; return ipString;
} }
public String getUncompressedIPv6Address() { public String getUncompressedIPv6Address() {
byte[] ip = null; byte[] ip = null;
/* TODO No need to copy the entire array! */ /* IpV6: Struct sizes and offsets */
byte[] structData = moteMem.getByteArray("uip_ds6_if", int ipv6NetworkInterfaceAddressOffset = moteMem.getByteValueOf("uip_ds6_netif_addr_list_offset");
ipv6NetworkInterfaceAddressOffset+IPv6_MAX_ADDRESSES*ipv6AddressStructSize); int ipv6AddressStructSize = moteMem.getByteValueOf("uip_ds6_addr_size");
if (ipv6NetworkInterfaceAddressOffset == 0 || ipv6AddressStructSize == 0) {
return "";
}
ipv6AddressIndex = -1; /* TODO No need to copy the entire array! */
for (int addressIndex=0; addressIndex < IPv6_MAX_ADDRESSES; addressIndex++) { byte[] structData = moteMem.getByteArray("uip_ds6_if",
int offset = ipv6NetworkInterfaceAddressOffset+addressIndex*ipv6AddressStructSize; ipv6NetworkInterfaceAddressOffset+IPv6_MAX_ADDRESSES*ipv6AddressStructSize);
byte isUsed = structData[offset];
if (isUsed == 0) { ipv6AddressIndex = -1;
continue; for (int addressIndex=0; addressIndex < IPv6_MAX_ADDRESSES; addressIndex++) {
} int offset = ipv6NetworkInterfaceAddressOffset+addressIndex*ipv6AddressStructSize;
byte isUsed = structData[offset];
if (isUsed == 0) {
continue;
}
byte[] addressData = new byte[16]; byte[] addressData = new byte[16];
System.arraycopy( System.arraycopy(
structData, offset+2/* ipaddr offset */, structData, offset+2/* ipaddr offset */,
addressData, 0, 16); addressData, 0, 16);
if (addressData[0] == (byte)0xFE && addressData[1] == (byte)0x80) {
ipv6IsGlobal = false;
} else {
ipv6IsGlobal = true;
}
ip = addressData;
ipv6AddressIndex = addressIndex;
if (ipv6IsGlobal) {
break;
}
}
if (ip == null) {
ip = new byte[16];
ipv6AddressIndex = -1;
}
String ipString = ""; if (addressData[0] == (byte)0xFE && addressData[1] == (byte)0x80) {
int i=0; ipv6IsGlobal = false;
while (i < 14) { } else {
int val = (0xFF&ip[i+1]) + ((0xFF&ip[i])<<8); ipv6IsGlobal = true;
ipString += hex16ToString(val) + ":"; }
i+=2;
ip = addressData;
ipv6AddressIndex = addressIndex;
if (ipv6IsGlobal) {
break;
}
} }
int val = (0xFF&ip[15]) + ((0xFF&ip[14])<<8); if (ip == null) {
ipString += hex16ToString(val); ip = new byte[16];
return ipString; ipv6AddressIndex = -1;
}
StringBuilder sb = new StringBuilder();
for (int i=0; i < 14; i+=2) {
sb.append(String.format("%02x%02x:", 0xFF&ip[i+0], 0xFF&ip[i+1]));
}
sb.append(String.format("%02x%02x", 0xFF&ip[14], 0xFF&ip[15]));
return sb.toString();
} }
/** /**
@ -217,7 +184,23 @@ public class IPAddress extends MoteInterface {
* @return True if mote has an IPv6 address * @return True if mote has an IPv6 address
*/ */
public boolean isVersion6() { public boolean isVersion6() {
return moteMem.variableExists("uip_ds6_if"); return
moteMem.variableExists("uip_ds6_netif_addr_list_offset") &&
moteMem.variableExists("uip_ds6_addr_size") &&
moteMem.variableExists("uip_ds6_if");
}
public void removed() {
super.removed();
if (memMonitor != null) {
if (isVersion4()) {
moteMem.removeMemoryMonitor(moteMem.getVariableAddress("rimeaddr_node_addr"), 4, memMonitor);
} else if (isVersion6()) {
moteMem.removeMemoryMonitor(moteMem.getVariableAddress("uip_ds6_netif_addr_list_offset"), 1, memMonitor);
moteMem.removeMemoryMonitor(moteMem.getVariableAddress("uip_ds6_addr_size"), 1, memMonitor);
moteMem.removeMemoryMonitor(moteMem.getVariableAddress("uip_ds6_if"), MONITORED_SIZE, memMonitor);
}
}
} }
public JPanel getInterfaceVisualizer() { public JPanel getInterfaceVisualizer() {
@ -230,8 +213,8 @@ public class IPAddress extends MoteInterface {
if (isVersion4()) { if (isVersion4()) {
ipLabel.setText("IPv4 address: " + getIPString()); ipLabel.setText("IPv4 address: " + getIPString());
} else if (isVersion6()) { } else if (isVersion6()) {
ipLabel.setText((ipv6IsGlobal?"Global":"Local") + ipLabel.setText((ipv6IsGlobal?"Global":"Local") +
" IPv6 address(#" + ipv6AddressIndex + "): " + getIPString()); " IPv6 address(#" + ipv6AddressIndex + "): " + getIPString());
} else { } else {
ipLabel.setText("Unknown IP"); ipLabel.setText("Unknown IP");
} }
@ -260,21 +243,4 @@ public class IPAddress extends MoteInterface {
public void setConfigXML(Collection<Element> configXML, boolean visAvailable) { public void setConfigXML(Collection<Element> configXML, boolean visAvailable) {
} }
private static String hex16ToString(int data) {
String s = Integer.toString(data & 0xffff, 16);
if (s.length() < 4) {
s = "0000".substring(0, 4 - s.length()) + s;
}
return s;
}
private static int align(int bytes, int alignment) {
int size = (bytes/alignment)*alignment;
while (size < bytes) {
size += alignment;
}
return size;
}
} }