aboutsummaryrefslogtreecommitdiff
diff options
context:
space:
mode:
-rw-r--r--AT91SAM7S256/armdebug/Debugger/debug_comm.S11
-rw-r--r--AT91SAM7S256/armdebug/Debugger/debug_stub.S48
-rw-r--r--AT91SAM7S256/armdebug/Debugger/debug_stub.h19
-rwxr-xr-xAT91SAM7S256/armdebug/Host/nxt-gdb-server.py7
-rwxr-xr-xAT91SAM7S256/armdebug/Host/pyenv-nxt-gdb-server3
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-2.1.0.tar.gzbin49769 -> 0 bytes
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/.project11
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/LICENSE674
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/MANIFEST.in4
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/PKG-INFO168
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/README169
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/examples/alpharex.py151
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/examples/cnc.py53
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/examples/latency.py23
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/examples/mary.py45
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/examples/message_test.py15
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/examples/spin.py14
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/examples/test_sensors.py11
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/install.bat11
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/nxt/__init__.py17
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/nxt/bluesock.py82
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/nxt/brick.py226
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/nxt/direct.py216
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/nxt/error.py87
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/nxt/fantomglue.py211
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/nxt/lightblueglue.py53
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/nxt/locator.py57
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/nxt/motor.py431
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/nxt/pyusbglue.py82
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/nxt/sensor/__init__.py50
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/nxt/sensor/analog.py41
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/nxt/sensor/common.py67
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/nxt/sensor/digital.py227
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/nxt/sensor/generic.py154
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/nxt/sensor/hitechnic.py611
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/nxt/sensor/mindsensors.py815
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/nxt/system.py297
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/nxt/telegram.py118
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/nxt/usbsock.py133
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/nxt/utils.py33
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/scripts/nxt_filer142
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/scripts/nxt_push47
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/scripts/nxt_test33
-rwxr-xr-xAT91SAM7S256/armdebug/nxt-python-fantom/scripts/pyenv-nxt_test3
-rwxr-xr-xAT91SAM7S256/armdebug/nxt-python-fantom/scripts/pyenv-syspython3
-rw-r--r--AT91SAM7S256/armdebug/nxt-python-fantom/setup.py23
46 files changed, 79 insertions, 5617 deletions
diff --git a/AT91SAM7S256/armdebug/Debugger/debug_comm.S b/AT91SAM7S256/armdebug/Debugger/debug_comm.S
index b743f72..821d0c8 100644
--- a/AT91SAM7S256/armdebug/Debugger/debug_comm.S
+++ b/AT91SAM7S256/armdebug/Debugger/debug_comm.S
@@ -46,7 +46,7 @@ debug_msgTxBuf_AppendPtr:
debug_segmentRxNum: /* Current Rx Segment Number */
.word 0x0
-#ifndef __NXOS__
+/* Incoming Message Length and Comm Channel is now common to both NxOS and NXT Firmware */
debug_nxtMsgLength: /* NXT Firmware Received Message Length */
.word 0x0
@@ -55,8 +55,6 @@ debug_nxtCommChannel:
.equ NXTCOMMCHANNEL_OFFSET, (debug_nxtCommChannel - debug_nxtMsgLength)
-#endif
-
.data
.align 4
@@ -574,11 +572,9 @@ dbg__comm_init:
stmia r2!, {r0, r1} /* debug_msgRxBufPtr and debug_msgTxBufPtr */
stmia r2!, {r0, r1} /* debug_msgRxBuf_AppendPtr and debug_msgTxBuf_AppendPtr */
bl _dbg__comm_readbuf_reset
-#ifndef __NXOS__
ldr r1, =debug_nxtMsgLength
mov r0, #0
str r0, [r1, #NXTCOMMCHANNEL_OFFSET] /* Clear NXT Channel on INIT */
-#endif
ldmfd sp!, {pc}
_dbg__comm_readbuf_reset:
@@ -589,12 +585,16 @@ _dbg__comm_readbuf_reset:
ldr r2, =nx_usb_read
mov lr, pc
bx r2
+ ldr r1, =debug_nxtMsgLength
+ mov r0, #0
+ str r0, [r1] /* Clear NxOS Received Message Length */
ldmfd sp!, {pc}
#else
ldr r1, =debug_nxtMsgLength
mov r0, #0
str r0, [r1] /* Clear NXT Received Message Length */
bx lr
+#endif
.global dbg__copyNxtDebugMsg
/* dbg__copyNxtDebugMsg
@@ -616,7 +616,6 @@ dbg__copyNxtDebugMsg:
*/
_dbg_memcpy r1, r0, r2, r3 /* r3: scratch register */
bx lr
-#endif
/* _dbg_reset_msgTxBuf_AppendPtr
* Internal variable to reset pointers.
diff --git a/AT91SAM7S256/armdebug/Debugger/debug_stub.S b/AT91SAM7S256/armdebug/Debugger/debug_stub.S
index a58fa8f..4e26da3 100644
--- a/AT91SAM7S256/armdebug/Debugger/debug_stub.S
+++ b/AT91SAM7S256/armdebug/Debugger/debug_stub.S
@@ -469,6 +469,54 @@ debug_armComplexCCTable:
/* FIXME: The Debugger Stack Frame is probably not 100% consistent with the order that
GDB expects in the g/G messages. CSPR is probably located above R15 */
+#ifdef __NXOS__
+/****************************************************************************
+ *
+ * GDB Debugger Invocation Routine for NxOS
+ *
+ ****************************************************************************/
+ .code 32
+ .align 4
+ .global nxos__handleDebug
+/* nxos__handleDebug
+ * Prepare to switch to Debug Mode
+ * int nxos__handleDebug(unsigned char *msg, comm_chan_t channel, long len, void *isrRetAddr);
+ *
+ * This routine is called from NxOS Fantom library to setup
+ * Single Step Breakpoint and copy Incoming Message to
+ * Debugger Message Buffers in preparation for Debugger invocation.
+ *
+ * If we're operating in normal NxOS mode, return True (!0)
+ * If we're already in Debugger Mode, return False (0)
+ */
+nxos__handleDebug:
+ push {r4, lr}
+ /* When called, NxOS is in ISR servicing mode (MODE_IRQ) */
+ /* R0-R3 has received message related parameters */
+ mov r4, r3 /* Keep isrRetAddr in R4 */
+ mrs r3, spsr /* Copy SPSR to r3 */
+ and r3, r3, #CPSR_MODE /* Get previous mode */
+ teq r3, #MODE_ABT /* Are we in Abort (Debug) mode? */
+ moveq r0, #FALSE
+ beq exit_nxos__handleDebug /* Yes, return False */
+
+_nxos_switch2debug:
+ bl dbg__copyNxtDebugMsg /* setup Debugger Message Buffers, validate input, CPSR returned in R0 */
+
+ /* Retrieve ISR Return Address */
+ mrs r3, spsr /* Copy SPSR to r3 */
+ tst r3, #CPSR_THUMB /* Check for Thumb Mode */
+ sub r1, r4, #4 /* R3 (isrRetAddr) has PC + 4, need to setup Single Step Breakpoint at PC */
+ orrne r1, r1, #1 /* Configure for Thumb Single Step Breakpoint */
+ bl _dbg__install_singlestep /* Setup Single Step, next instruction address returned in r1 */
+ bl _dbg__activate_singlestep
+ mov r0, #TRUE /* We're going to switch to Debug Mode */
+exit_nxos__handleDebug:
+ pop {r4, lr}
+ mov r1, lr /* Safe code: Thumb mode can't access lr */
+ bx r1 /* In case we have Interworking from different caller mode */
+#endif
+
#ifndef __NXOS__
/****************************************************************************
*
diff --git a/AT91SAM7S256/armdebug/Debugger/debug_stub.h b/AT91SAM7S256/armdebug/Debugger/debug_stub.h
index 931aa68..c5cbeee 100644
--- a/AT91SAM7S256/armdebug/Debugger/debug_stub.h
+++ b/AT91SAM7S256/armdebug/Debugger/debug_stub.h
@@ -55,6 +55,25 @@
*/
FUNCDEF void dbg__bkpt_init(void);
+#ifdef __NXOS__
+
+/** Communication Channel Enums
+ *
+ * Communication Channel Enums.
+ */
+ENUM_BEGIN
+ENUM_VALASSIGN(COMM_USB, 1) /**< USB Communications */
+ENUM_VAL(COMM_BT) /**< Bluetooth Communications */
+ENUM_END(comm_chan_t)
+
+/** Enable switch to Debugger Mode from NxOS operational mode
+ * Returns 0 if no mode switch needed (already in Debug mode)
+ * !0 if mode switch will happen
+ * Used by NxOS only
+ */
+FUNCDEF int nxos__handleDebug(unsigned char *msg, comm_chan_t channel, long len, void *isrRetAddr);
+#endif
+
#ifndef __NXOS__
/** Switch Mode to Debugger.
* Used by NXT Firmware only
diff --git a/AT91SAM7S256/armdebug/Host/nxt-gdb-server.py b/AT91SAM7S256/armdebug/Host/nxt-gdb-server.py
index 47a552d..a4ea2ad 100755
--- a/AT91SAM7S256/armdebug/Host/nxt-gdb-server.py
+++ b/AT91SAM7S256/armdebug/Host/nxt-gdb-server.py
@@ -19,7 +19,8 @@ import nxt.locator
import socket
import optparse
import select
-import usb
+#import usb
+import nxt.pyfantom
import struct
CTRLC = chr(3)
@@ -159,9 +160,9 @@ class NXTGDBServer:
print "[GDB->NXT] %s" % data
segments = self.segment (data)
data = ''
- for s in segments:
+ for seg in segments:
try:
- brick.sock.send (s)
+ brick.sock.send (seg)
except usb.USBError as e:
# Some pyusb are buggy, ignore some "errors".
if e.args != ('No error', ):
diff --git a/AT91SAM7S256/armdebug/Host/pyenv-nxt-gdb-server b/AT91SAM7S256/armdebug/Host/pyenv-nxt-gdb-server
new file mode 100755
index 0000000..12dac80
--- /dev/null
+++ b/AT91SAM7S256/armdebug/Host/pyenv-nxt-gdb-server
@@ -0,0 +1,3 @@
+#!/bin/sh
+export PYTHONPATH=~/gitrepo/armdebug/nxt-python-fantom
+arch -i386 /usr/bin/python2.6 ~/gitrepo/armdebug/Host/nxt-gdb-server.py
diff --git a/AT91SAM7S256/armdebug/nxt-python-2.1.0.tar.gz b/AT91SAM7S256/armdebug/nxt-python-2.1.0.tar.gz
deleted file mode 100644
index 014132b..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-2.1.0.tar.gz
+++ /dev/null
Binary files differ
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/.project b/AT91SAM7S256/armdebug/nxt-python-fantom/.project
deleted file mode 100644
index 1b06536..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/.project
+++ /dev/null
@@ -1,11 +0,0 @@
-<?xml version="1.0" encoding="UTF-8"?>
-<projectDescription>
- <name>nxt-python-fantom</name>
- <comment></comment>
- <projects>
- </projects>
- <buildSpec>
- </buildSpec>
- <natures>
- </natures>
-</projectDescription>
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/LICENSE b/AT91SAM7S256/armdebug/nxt-python-fantom/LICENSE
deleted file mode 100644
index 818433e..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/LICENSE
+++ /dev/null
@@ -1,674 +0,0 @@
- GNU GENERAL PUBLIC LICENSE
- Version 3, 29 June 2007
-
- Copyright (C) 2007 Free Software Foundation, Inc. <http://fsf.org/>
- Everyone is permitted to copy and distribute verbatim copies
- of this license document, but changing it is not allowed.
-
- Preamble
-
- The GNU General Public License is a free, copyleft license for
-software and other kinds of works.
-
- The licenses for most software and other practical works are designed
-to take away your freedom to share and change the works. By contrast,
-the GNU General Public License is intended to guarantee your freedom to
-share and change all versions of a program--to make sure it remains free
-software for all its users. We, the Free Software Foundation, use the
-GNU General Public License for most of our software; it applies also to
-any other work released this way by its authors. You can apply it to
-your programs, too.
-
- When we speak of free software, we are referring to freedom, not
-price. Our General Public Licenses are designed to make sure that you
-have the freedom to distribute copies of free software (and charge for
-them if you wish), that you receive source code or can get it if you
-want it, that you can change the software or use pieces of it in new
-free programs, and that you know you can do these things.
-
- To protect your rights, we need to prevent others from denying you
-these rights or asking you to surrender the rights. Therefore, you have
-certain responsibilities if you distribute copies of the software, or if
-you modify it: responsibilities to respect the freedom of others.
-
- For example, if you distribute copies of such a program, whether
-gratis or for a fee, you must pass on to the recipients the same
-freedoms that you received. You must make sure that they, too, receive
-or can get the source code. And you must show them these terms so they
-know their rights.
-
- Developers that use the GNU GPL protect your rights with two steps:
-(1) assert copyright on the software, and (2) offer you this License
-giving you legal permission to copy, distribute and/or modify it.
-
- For the developers' and authors' protection, the GPL clearly explains
-that there is no warranty for this free software. For both users' and
-authors' sake, the GPL requires that modified versions be marked as
-changed, so that their problems will not be attributed erroneously to
-authors of previous versions.
-
- Some devices are designed to deny users access to install or run
-modified versions of the software inside them, although the manufacturer
-can do so. This is fundamentally incompatible with the aim of
-protecting users' freedom to change the software. The systematic
-pattern of such abuse occurs in the area of products for individuals to
-use, which is precisely where it is most unacceptable. Therefore, we
-have designed this version of the GPL to prohibit the practice for those
-products. If such problems arise substantially in other domains, we
-stand ready to extend this provision to those domains in future versions
-of the GPL, as needed to protect the freedom of users.
-
- Finally, every program is threatened constantly by software patents.
-States should not allow patents to restrict development and use of
-software on general-purpose computers, but in those that do, we wish to
-avoid the special danger that patents applied to a free program could
-make it effectively proprietary. To prevent this, the GPL assures that
-patents cannot be used to render the program non-free.
-
- The precise terms and conditions for copying, distribution and
-modification follow.
-
- TERMS AND CONDITIONS
-
- 0. Definitions.
-
- "This License" refers to version 3 of the GNU General Public License.
-
- "Copyright" also means copyright-like laws that apply to other kinds of
-works, such as semiconductor masks.
-
- "The Program" refers to any copyrightable work licensed under this
-License. Each licensee is addressed as "you". "Licensees" and
-"recipients" may be individuals or organizations.
-
- To "modify" a work means to copy from or adapt all or part of the work
-in a fashion requiring copyright permission, other than the making of an
-exact copy. The resulting work is called a "modified version" of the
-earlier work or a work "based on" the earlier work.
-
- A "covered work" means either the unmodified Program or a work based
-on the Program.
-
- To "propagate" a work means to do anything with it that, without
-permission, would make you directly or secondarily liable for
-infringement under applicable copyright law, except executing it on a
-computer or modifying a private copy. Propagation includes copying,
-distribution (with or without modification), making available to the
-public, and in some countries other activities as well.
-
- To "convey" a work means any kind of propagation that enables other
-parties to make or receive copies. Mere interaction with a user through
-a computer network, with no transfer of a copy, is not conveying.
-
- An interactive user interface displays "Appropriate Legal Notices"
-to the extent that it includes a convenient and prominently visible
-feature that (1) displays an appropriate copyright notice, and (2)
-tells the user that there is no warranty for the work (except to the
-extent that warranties are provided), that licensees may convey the
-work under this License, and how to view a copy of this License. If
-the interface presents a list of user commands or options, such as a
-menu, a prominent item in the list meets this criterion.
-
- 1. Source Code.
-
- The "source code" for a work means the preferred form of the work
-for making modifications to it. "Object code" means any non-source
-form of a work.
-
- A "Standard Interface" means an interface that either is an official
-standard defined by a recognized standards body, or, in the case of
-interfaces specified for a particular programming language, one that
-is widely used among developers working in that language.
-
- The "System Libraries" of an executable work include anything, other
-than the work as a whole, that (a) is included in the normal form of
-packaging a Major Component, but which is not part of that Major
-Component, and (b) serves only to enable use of the work with that
-Major Component, or to implement a Standard Interface for which an
-implementation is available to the public in source code form. A
-"Major Component", in this context, means a major essential component
-(kernel, window system, and so on) of the specific operating system
-(if any) on which the executable work runs, or a compiler used to
-produce the work, or an object code interpreter used to run it.
-
- The "Corresponding Source" for a work in object code form means all
-the source code needed to generate, install, and (for an executable
-work) run the object code and to modify the work, including scripts to
-control those activities. However, it does not include the work's
-System Libraries, or general-purpose tools or generally available free
-programs which are used unmodified in performing those activities but
-which are not part of the work. For example, Corresponding Source
-includes interface definition files associated with source files for
-the work, and the source code for shared libraries and dynamically
-linked subprograms that the work is specifically designed to require,
-such as by intimate data communication or control flow between those
-subprograms and other parts of the work.
-
- The Corresponding Source need not include anything that users
-can regenerate automatically from other parts of the Corresponding
-Source.
-
- The Corresponding Source for a work in source code form is that
-same work.
-
- 2. Basic Permissions.
-
- All rights granted under this License are granted for the term of
-copyright on the Program, and are irrevocable provided the stated
-conditions are met. This License explicitly affirms your unlimited
-permission to run the unmodified Program. The output from running a
-covered work is covered by this License only if the output, given its
-content, constitutes a covered work. This License acknowledges your
-rights of fair use or other equivalent, as provided by copyright law.
-
- You may make, run and propagate covered works that you do not
-convey, without conditions so long as your license otherwise remains
-in force. You may convey covered works to others for the sole purpose
-of having them make modifications exclusively for you, or provide you
-with facilities for running those works, provided that you comply with
-the terms of this License in conveying all material for which you do
-not control copyright. Those thus making or running the covered works
-for you must do so exclusively on your behalf, under your direction
-and control, on terms that prohibit them from making any copies of
-your copyrighted material outside their relationship with you.
-
- Conveying under any other circumstances is permitted solely under
-the conditions stated below. Sublicensing is not allowed; section 10
-makes it unnecessary.
-
- 3. Protecting Users' Legal Rights From Anti-Circumvention Law.
-
- No covered work shall be deemed part of an effective technological
-measure under any applicable law fulfilling obligations under article
-11 of the WIPO copyright treaty adopted on 20 December 1996, or
-similar laws prohibiting or restricting circumvention of such
-measures.
-
- When you convey a covered work, you waive any legal power to forbid
-circumvention of technological measures to the extent such circumvention
-is effected by exercising rights under this License with respect to
-the covered work, and you disclaim any intention to limit operation or
-modification of the work as a means of enforcing, against the work's
-users, your or third parties' legal rights to forbid circumvention of
-technological measures.
-
- 4. Conveying Verbatim Copies.
-
- You may convey verbatim copies of the Program's source code as you
-receive it, in any medium, provided that you conspicuously and
-appropriately publish on each copy an appropriate copyright notice;
-keep intact all notices stating that this License and any
-non-permissive terms added in accord with section 7 apply to the code;
-keep intact all notices of the absence of any warranty; and give all
-recipients a copy of this License along with the Program.
-
- You may charge any price or no price for each copy that you convey,
-and you may offer support or warranty protection for a fee.
-
- 5. Conveying Modified Source Versions.
-
- You may convey a work based on the Program, or the modifications to
-produce it from the Program, in the form of source code under the
-terms of section 4, provided that you also meet all of these conditions:
-
- a) The work must carry prominent notices stating that you modified
- it, and giving a relevant date.
-
- b) The work must carry prominent notices stating that it is
- released under this License and any conditions added under section
- 7. This requirement modifies the requirement in section 4 to
- "keep intact all notices".
-
- c) You must license the entire work, as a whole, under this
- License to anyone who comes into possession of a copy. This
- License will therefore apply, along with any applicable section 7
- additional terms, to the whole of the work, and all its parts,
- regardless of how they are packaged. This License gives no
- permission to license the work in any other way, but it does not
- invalidate such permission if you have separately received it.
-
- d) If the work has interactive user interfaces, each must display
- Appropriate Legal Notices; however, if the Program has interactive
- interfaces that do not display Appropriate Legal Notices, your
- work need not make them do so.
-
- A compilation of a covered work with other separate and independent
-works, which are not by their nature extensions of the covered work,
-and which are not combined with it such as to form a larger program,
-in or on a volume of a storage or distribution medium, is called an
-"aggregate" if the compilation and its resulting copyright are not
-used to limit the access or legal rights of the compilation's users
-beyond what the individual works permit. Inclusion of a covered work
-in an aggregate does not cause this License to apply to the other
-parts of the aggregate.
-
- 6. Conveying Non-Source Forms.
-
- You may convey a covered work in object code form under the terms
-of sections 4 and 5, provided that you also convey the
-machine-readable Corresponding Source under the terms of this License,
-in one of these ways:
-
- a) Convey the object code in, or embodied in, a physical product
- (including a physical distribution medium), accompanied by the
- Corresponding Source fixed on a durable physical medium
- customarily used for software interchange.
-
- b) Convey the object code in, or embodied in, a physical product
- (including a physical distribution medium), accompanied by a
- written offer, valid for at least three years and valid for as
- long as you offer spare parts or customer support for that product
- model, to give anyone who possesses the object code either (1) a
- copy of the Corresponding Source for all the software in the
- product that is covered by this License, on a durable physical
- medium customarily used for software interchange, for a price no
- more than your reasonable cost of physically performing this
- conveying of source, or (2) access to copy the
- Corresponding Source from a network server at no charge.
-
- c) Convey individual copies of the object code with a copy of the
- written offer to provide the Corresponding Source. This
- alternative is allowed only occasionally and noncommercially, and
- only if you received the object code with such an offer, in accord
- with subsection 6b.
-
- d) Convey the object code by offering access from a designated
- place (gratis or for a charge), and offer equivalent access to the
- Corresponding Source in the same way through the same place at no
- further charge. You need not require recipients to copy the
- Corresponding Source along with the object code. If the place to
- copy the object code is a network server, the Corresponding Source
- may be on a different server (operated by you or a third party)
- that supports equivalent copying facilities, provided you maintain
- clear directions next to the object code saying where to find the
- Corresponding Source. Regardless of what server hosts the
- Corresponding Source, you remain obligated to ensure that it is
- available for as long as needed to satisfy these requirements.
-
- e) Convey the object code using peer-to-peer transmission, provided
- you inform other peers where the object code and Corresponding
- Source of the work are being offered to the general public at no
- charge under subsection 6d.
-
- A separable portion of the object code, whose source code is excluded
-from the Corresponding Source as a System Library, need not be
-included in conveying the object code work.
-
- A "User Product" is either (1) a "consumer product", which means any
-tangible personal property which is normally used for personal, family,
-or household purposes, or (2) anything designed or sold for incorporation
-into a dwelling. In determining whether a product is a consumer product,
-doubtful cases shall be resolved in favor of coverage. For a particular
-product received by a particular user, "normally used" refers to a
-typical or common use of that class of product, regardless of the status
-of the particular user or of the way in which the particular user
-actually uses, or expects or is expected to use, the product. A product
-is a consumer product regardless of whether the product has substantial
-commercial, industrial or non-consumer uses, unless such uses represent
-the only significant mode of use of the product.
-
- "Installation Information" for a User Product means any methods,
-procedures, authorization keys, or other information required to install
-and execute modified versions of a covered work in that User Product from
-a modified version of its Corresponding Source. The information must
-suffice to ensure that the continued functioning of the modified object
-code is in no case prevented or interfered with solely because
-modification has been made.
-
- If you convey an object code work under this section in, or with, or
-specifically for use in, a User Product, and the conveying occurs as
-part of a transaction in which the right of possession and use of the
-User Product is transferred to the recipient in perpetuity or for a
-fixed term (regardless of how the transaction is characterized), the
-Corresponding Source conveyed under this section must be accompanied
-by the Installation Information. But this requirement does not apply
-if neither you nor any third party retains the ability to install
-modified object code on the User Product (for example, the work has
-been installed in ROM).
-
- The requirement to provide Installation Information does not include a
-requirement to continue to provide support service, warranty, or updates
-for a work that has been modified or installed by the recipient, or for
-the User Product in which it has been modified or installed. Access to a
-network may be denied when the modification itself materially and
-adversely affects the operation of the network or violates the rules and
-protocols for communication across the network.
-
- Corresponding Source conveyed, and Installation Information provided,
-in accord with this section must be in a format that is publicly
-documented (and with an implementation available to the public in
-source code form), and must require no special password or key for
-unpacking, reading or copying.
-
- 7. Additional Terms.
-
- "Additional permissions" are terms that supplement the terms of this
-License by making exceptions from one or more of its conditions.
-Additional permissions that are applicable to the entire Program shall
-be treated as though they were included in this License, to the extent
-that they are valid under applicable law. If additional permissions
-apply only to part of the Program, that part may be used separately
-under those permissions, but the entire Program remains governed by
-this License without regard to the additional permissions.
-
- When you convey a copy of a covered work, you may at your option
-remove any additional permissions from that copy, or from any part of
-it. (Additional permissions may be written to require their own
-removal in certain cases when you modify the work.) You may place
-additional permissions on material, added by you to a covered work,
-for which you have or can give appropriate copyright permission.
-
- Notwithstanding any other provision of this License, for material you
-add to a covered work, you may (if authorized by the copyright holders of
-that material) supplement the terms of this License with terms:
-
- a) Disclaiming warranty or limiting liability differently from the
- terms of sections 15 and 16 of this License; or
-
- b) Requiring preservation of specified reasonable legal notices or
- author attributions in that material or in the Appropriate Legal
- Notices displayed by works containing it; or
-
- c) Prohibiting misrepresentation of the origin of that material, or
- requiring that modified versions of such material be marked in
- reasonable ways as different from the original version; or
-
- d) Limiting the use for publicity purposes of names of licensors or
- authors of the material; or
-
- e) Declining to grant rights under trademark law for use of some
- trade names, trademarks, or service marks; or
-
- f) Requiring indemnification of licensors and authors of that
- material by anyone who conveys the material (or modified versions of
- it) with contractual assumptions of liability to the recipient, for
- any liability that these contractual assumptions directly impose on
- those licensors and authors.
-
- All other non-permissive additional terms are considered "further
-restrictions" within the meaning of section 10. If the Program as you
-received it, or any part of it, contains a notice stating that it is
-governed by this License along with a term that is a further
-restriction, you may remove that term. If a license document contains
-a further restriction but permits relicensing or conveying under this
-License, you may add to a covered work material governed by the terms
-of that license document, provided that the further restriction does
-not survive such relicensing or conveying.
-
- If you add terms to a covered work in accord with this section, you
-must place, in the relevant source files, a statement of the
-additional terms that apply to those files, or a notice indicating
-where to find the applicable terms.
-
- Additional terms, permissive or non-permissive, may be stated in the
-form of a separately written license, or stated as exceptions;
-the above requirements apply either way.
-
- 8. Termination.
-
- You may not propagate or modify a covered work except as expressly
-provided under this License. Any attempt otherwise to propagate or
-modify it is void, and will automatically terminate your rights under
-this License (including any patent licenses granted under the third
-paragraph of section 11).
-
- However, if you cease all violation of this License, then your
-license from a particular copyright holder is reinstated (a)
-provisionally, unless and until the copyright holder explicitly and
-finally terminates your license, and (b) permanently, if the copyright
-holder fails to notify you of the violation by some reasonable means
-prior to 60 days after the cessation.
-
- Moreover, your license from a particular copyright holder is
-reinstated permanently if the copyright holder notifies you of the
-violation by some reasonable means, this is the first time you have
-received notice of violation of this License (for any work) from that
-copyright holder, and you cure the violation prior to 30 days after
-your receipt of the notice.
-
- Termination of your rights under this section does not terminate the
-licenses of parties who have received copies or rights from you under
-this License. If your rights have been terminated and not permanently
-reinstated, you do not qualify to receive new licenses for the same
-material under section 10.
-
- 9. Acceptance Not Required for Having Copies.
-
- You are not required to accept this License in order to receive or
-run a copy of the Program. Ancillary propagation of a covered work
-occurring solely as a consequence of using peer-to-peer transmission
-to receive a copy likewise does not require acceptance. However,
-nothing other than this License grants you permission to propagate or
-modify any covered work. These actions infringe copyright if you do
-not accept this License. Therefore, by modifying or propagating a
-covered work, you indicate your acceptance of this License to do so.
-
- 10. Automatic Licensing of Downstream Recipients.
-
- Each time you convey a covered work, the recipient automatically
-receives a license from the original licensors, to run, modify and
-propagate that work, subject to this License. You are not responsible
-for enforcing compliance by third parties with this License.
-
- An "entity transaction" is a transaction transferring control of an
-organization, or substantially all assets of one, or subdividing an
-organization, or merging organizations. If propagation of a covered
-work results from an entity transaction, each party to that
-transaction who receives a copy of the work also receives whatever
-licenses to the work the party's predecessor in interest had or could
-give under the previous paragraph, plus a right to possession of the
-Corresponding Source of the work from the predecessor in interest, if
-the predecessor has it or can get it with reasonable efforts.
-
- You may not impose any further restrictions on the exercise of the
-rights granted or affirmed under this License. For example, you may
-not impose a license fee, royalty, or other charge for exercise of
-rights granted under this License, and you may not initiate litigation
-(including a cross-claim or counterclaim in a lawsuit) alleging that
-any patent claim is infringed by making, using, selling, offering for
-sale, or importing the Program or any portion of it.
-
- 11. Patents.
-
- A "contributor" is a copyright holder who authorizes use under this
-License of the Program or a work on which the Program is based. The
-work thus licensed is called the contributor's "contributor version".
-
- A contributor's "essential patent claims" are all patent claims
-owned or controlled by the contributor, whether already acquired or
-hereafter acquired, that would be infringed by some manner, permitted
-by this License, of making, using, or selling its contributor version,
-but do not include claims that would be infringed only as a
-consequence of further modification of the contributor version. For
-purposes of this definition, "control" includes the right to grant
-patent sublicenses in a manner consistent with the requirements of
-this License.
-
- Each contributor grants you a non-exclusive, worldwide, royalty-free
-patent license under the contributor's essential patent claims, to
-make, use, sell, offer for sale, import and otherwise run, modify and
-propagate the contents of its contributor version.
-
- In the following three paragraphs, a "patent license" is any express
-agreement or commitment, however denominated, not to enforce a patent
-(such as an express permission to practice a patent or covenant not to
-sue for patent infringement). To "grant" such a patent license to a
-party means to make such an agreement or commitment not to enforce a
-patent against the party.
-
- If you convey a covered work, knowingly relying on a patent license,
-and the Corresponding Source of the work is not available for anyone
-to copy, free of charge and under the terms of this License, through a
-publicly available network server or other readily accessible means,
-then you must either (1) cause the Corresponding Source to be so
-available, or (2) arrange to deprive yourself of the benefit of the
-patent license for this particular work, or (3) arrange, in a manner
-consistent with the requirements of this License, to extend the patent
-license to downstream recipients. "Knowingly relying" means you have
-actual knowledge that, but for the patent license, your conveying the
-covered work in a country, or your recipient's use of the covered work
-in a country, would infringe one or more identifiable patents in that
-country that you have reason to believe are valid.
-
- If, pursuant to or in connection with a single transaction or
-arrangement, you convey, or propagate by procuring conveyance of, a
-covered work, and grant a patent license to some of the parties
-receiving the covered work authorizing them to use, propagate, modify
-or convey a specific copy of the covered work, then the patent license
-you grant is automatically extended to all recipients of the covered
-work and works based on it.
-
- A patent license is "discriminatory" if it does not include within
-the scope of its coverage, prohibits the exercise of, or is
-conditioned on the non-exercise of one or more of the rights that are
-specifically granted under this License. You may not convey a covered
-work if you are a party to an arrangement with a third party that is
-in the business of distributing software, under which you make payment
-to the third party based on the extent of your activity of conveying
-the work, and under which the third party grants, to any of the
-parties who would receive the covered work from you, a discriminatory
-patent license (a) in connection with copies of the covered work
-conveyed by you (or copies made from those copies), or (b) primarily
-for and in connection with specific products or compilations that
-contain the covered work, unless you entered into that arrangement,
-or that patent license was granted, prior to 28 March 2007.
-
- Nothing in this License shall be construed as excluding or limiting
-any implied license or other defenses to infringement that may
-otherwise be available to you under applicable patent law.
-
- 12. No Surrender of Others' Freedom.
-
- If conditions are imposed on you (whether by court order, agreement or
-otherwise) that contradict the conditions of this License, they do not
-excuse you from the conditions of this License. If you cannot convey a
-covered work so as to satisfy simultaneously your obligations under this
-License and any other pertinent obligations, then as a consequence you may
-not convey it at all. For example, if you agree to terms that obligate you
-to collect a royalty for further conveying from those to whom you convey
-the Program, the only way you could satisfy both those terms and this
-License would be to refrain entirely from conveying the Program.
-
- 13. Use with the GNU Affero General Public License.
-
- Notwithstanding any other provision of this License, you have
-permission to link or combine any covered work with a work licensed
-under version 3 of the GNU Affero General Public License into a single
-combined work, and to convey the resulting work. The terms of this
-License will continue to apply to the part which is the covered work,
-but the special requirements of the GNU Affero General Public License,
-section 13, concerning interaction through a network will apply to the
-combination as such.
-
- 14. Revised Versions of this License.
-
- The Free Software Foundation may publish revised and/or new versions of
-the GNU General Public License from time to time. Such new versions will
-be similar in spirit to the present version, but may differ in detail to
-address new problems or concerns.
-
- Each version is given a distinguishing version number. If the
-Program specifies that a certain numbered version of the GNU General
-Public License "or any later version" applies to it, you have the
-option of following the terms and conditions either of that numbered
-version or of any later version published by the Free Software
-Foundation. If the Program does not specify a version number of the
-GNU General Public License, you may choose any version ever published
-by the Free Software Foundation.
-
- If the Program specifies that a proxy can decide which future
-versions of the GNU General Public License can be used, that proxy's
-public statement of acceptance of a version permanently authorizes you
-to choose that version for the Program.
-
- Later license versions may give you additional or different
-permissions. However, no additional obligations are imposed on any
-author or copyright holder as a result of your choosing to follow a
-later version.
-
- 15. Disclaimer of Warranty.
-
- THERE IS NO WARRANTY FOR THE PROGRAM, TO THE EXTENT PERMITTED BY
-APPLICABLE LAW. EXCEPT WHEN OTHERWISE STATED IN WRITING THE COPYRIGHT
-HOLDERS AND/OR OTHER PARTIES PROVIDE THE PROGRAM "AS IS" WITHOUT WARRANTY
-OF ANY KIND, EITHER EXPRESSED OR IMPLIED, INCLUDING, BUT NOT LIMITED TO,
-THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
-PURPOSE. THE ENTIRE RISK AS TO THE QUALITY AND PERFORMANCE OF THE PROGRAM
-IS WITH YOU. SHOULD THE PROGRAM PROVE DEFECTIVE, YOU ASSUME THE COST OF
-ALL NECESSARY SERVICING, REPAIR OR CORRECTION.
-
- 16. Limitation of Liability.
-
- IN NO EVENT UNLESS REQUIRED BY APPLICABLE LAW OR AGREED TO IN WRITING
-WILL ANY COPYRIGHT HOLDER, OR ANY OTHER PARTY WHO MODIFIES AND/OR CONVEYS
-THE PROGRAM AS PERMITTED ABOVE, BE LIABLE TO YOU FOR DAMAGES, INCLUDING ANY
-GENERAL, SPECIAL, INCIDENTAL OR CONSEQUENTIAL DAMAGES ARISING OUT OF THE
-USE OR INABILITY TO USE THE PROGRAM (INCLUDING BUT NOT LIMITED TO LOSS OF
-DATA OR DATA BEING RENDERED INACCURATE OR LOSSES SUSTAINED BY YOU OR THIRD
-PARTIES OR A FAILURE OF THE PROGRAM TO OPERATE WITH ANY OTHER PROGRAMS),
-EVEN IF SUCH HOLDER OR OTHER PARTY HAS BEEN ADVISED OF THE POSSIBILITY OF
-SUCH DAMAGES.
-
- 17. Interpretation of Sections 15 and 16.
-
- If the disclaimer of warranty and limitation of liability provided
-above cannot be given local legal effect according to their terms,
-reviewing courts shall apply local law that most closely approximates
-an absolute waiver of all civil liability in connection with the
-Program, unless a warranty or assumption of liability accompanies a
-copy of the Program in return for a fee.
-
- END OF TERMS AND CONDITIONS
-
- How to Apply These Terms to Your New Programs
-
- If you develop a new program, and you want it to be of the greatest
-possible use to the public, the best way to achieve this is to make it
-free software which everyone can redistribute and change under these terms.
-
- To do so, attach the following notices to the program. It is safest
-to attach them to the start of each source file to most effectively
-state the exclusion of warranty; and each file should have at least
-the "copyright" line and a pointer to where the full notice is found.
-
- <one line to give the program's name and a brief idea of what it does.>
- Copyright (C) <year> <name of author>
-
- 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 3 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, see <http://www.gnu.org/licenses/>.
-
-Also add information on how to contact you by electronic and paper mail.
-
- If the program does terminal interaction, make it output a short
-notice like this when it starts in an interactive mode:
-
- <program> Copyright (C) <year> <name of author>
- This program comes with ABSOLUTELY NO WARRANTY; for details type `show w'.
- This is free software, and you are welcome to redistribute it
- under certain conditions; type `show c' for details.
-
-The hypothetical commands `show w' and `show c' should show the appropriate
-parts of the General Public License. Of course, your program's commands
-might be different; for a GUI interface, you would use an "about box".
-
- You should also get your employer (if you work as a programmer) or school,
-if any, to sign a "copyright disclaimer" for the program, if necessary.
-For more information on this, and how to apply and follow the GNU GPL, see
-<http://www.gnu.org/licenses/>.
-
- The GNU General Public License does not permit incorporating your program
-into proprietary programs. If your program is a subroutine library, you
-may consider it more useful to permit linking proprietary applications with
-the library. If this is what you want to do, use the GNU Lesser General
-Public License instead of this License. But first, please read
-<http://www.gnu.org/philosophy/why-not-lgpl.html>.
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/MANIFEST.in b/AT91SAM7S256/armdebug/nxt-python-fantom/MANIFEST.in
deleted file mode 100644
index 9dd36e1..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/MANIFEST.in
+++ /dev/null
@@ -1,4 +0,0 @@
-include docs/*.html *.url *.css *.txt
-include README LICENSE install.bat MANIFEST.in
-include examples/*.py
-exclude arduino/*
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/PKG-INFO b/AT91SAM7S256/armdebug/nxt-python-fantom/PKG-INFO
deleted file mode 100644
index 1e0e361..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/PKG-INFO
+++ /dev/null
@@ -1,168 +0,0 @@
-Metadata-Version: 1.0
-Name: nxt-python
-Version: 2.1.0
-Summary: LEGO Mindstorms NXT Control Package
-Home-page: http://code.google.com/p/nxt-python/
-Author: Marcus Wanner
-Author-email: marcusw@cox.net
-License: Gnu GPL v3
-Description: NXT-Python is a package for controlling a LEGO NXT robot using the Python
- programming language. It can communicate using either USB or Bluetooth. It is
- available under the Gnu GPL license. It is based on NXT_Python, where releases
- halted in May 2007.
-
- Requirements:
-
- * Python 2.6 (http://www.python.org)
- And at least one comm library:
- * Bluetooth communications:
- Linux/Windows: PyBluez (http://code.google.com/p/pybluez/)
- (package python-bluez in deb-based linuxes)
- Mac: LightBlue (http://lightblue.sourceforge.net/)
- * USB communications:
- PyUSB (http://sourceforge.net/projects/pyusb/)
-
- Installation (if using source package):
-
- * Untar/unzip source package
- * In package directory, run "python setup.py install" (as root), or if
- under windows, double-click install.bat.
- * To use USB on Linux as non-superuser, at a root terminal type:
- groupadd lego
- usermod -a -G lego [username]
- echo 'BUS=="usb", SYSFS{idVendor}=="0694", GROUP="lego", MODE="0660"' \
- > /etc/udev/rules.d/70-lego.rules
-
- Getting Started:
-
- Take a look at the examples directory. Feel free to copy that code into your
- scripts and don't be afraid to experiment! If you are having trouble with
- something, you may find the solution in the docstrings (for example,
- help('nxt.sensor.Ultrasonic')) or even in the source code (especially for
- digital sensors).
-
- Notes/FAQ:
- (I have tried to put the most important stuff first, but it would be a good
- idea to read the whole section. In any case, read it all the way through
- before asking for help. Thanks!)
-
- -=-=-About v2-=-=-
- This version is part of the 2.x series of releases. Programs designed for
- NXT_Python or for the 1.x series of nxt-python will not work with this version.
- If you are trying to get an old program to work, it most likely needs a 1.x
- series release, which can be downloaded from the nxt-python downloads page at
- googlecode. New projects should use a 2.x series release (hint: this is one!)
- due to the new features and API improvements. Converting old projects is
- somewhat difficult and not officially supported, though as always you're
- welcome to ask for help.
- -=-=-Problems and Their Solutions-=-=-
- Support for a number of sensors has not been tested at all, due to lack of
- hardware. I have started a project to test this code, but the going is slow
- and I have decided to go ahead and release rather than waiting several more
- months. If you have a problem with a digital sensor, see the troubleshooting
- guide below and don't forget to report your trouble!
- The Synchronized Motor support has not been extensively tested for accuracy.
- It seems to mostly work well but the accuracy of the braking function and the
- closeness of the two motors to each other have not been assesed.
- NXT-Python has not been tested and may not work with custom nxt firmware
- versions (if you don't know what that means, you don't need to worry about it).
- However, if the firmware uses the standard USB/BT communications protocol,
- everything should more or less work. NXT-Python has been tested with bricks
- using LEGO firmware version up to 1.29 and is compatible with protocol version
- 1.124 (used by most if not all of the official firmwares). It has also been
- reported working with LeJOS.
- -=-=-If you co'd the SVN...-=-=-
- The Arduino directory of an svn checkout (not included with release
- packages) contains a digital sensor unit test system called nxtduemu. It is
- intended for developers and advanced users who are looking to experiment with
- sensors and the digital sensor framework and classes. See Arduino/README for
- more info and usage instructions.
-
- Specific Stability Status:
- nxt.brick, nxt.telegram, nxt.direct, and nxt.system:
- Hardly changed since NXT_Python; very, very stable.
- USB Communication System (nxt.usbsock)
- On Linux: Very stable and extensively tested.
- On Windows: Somewhat tested; seems to work pretty well.
- On Mac: Should be working, though I have not heard either way.
- BlueTooth Communication System (nxt.bluesock, nxt.lightblueglue)
- On Linux: Stable; well tested.
- On Windows: Stable; working last I checked.
- On Mac: Reported working.
- nxt.locator:
- Stable, somewhat tested. One developer reported problems.
- nxt.motor:
- Stable except for Synchronized Motor support, which is experimental at
- this stage and has not been extensively tested.
- nxt.sensor:
- Code not specific to a particular sensor is well tested and working
- great. More than half of the sensor classes were last reported working;
- the rest have not to my knowlege been tested and were written blindly
- from the manuacturers' specifications.
- nxt.error:
- If there's a problem with this one, I'm gonna cry.
-
- Contact:
-
- NXT-Python's Head Developer:
- Marcus Wanner (marcusw@cox.net)
- The support and development mailing list:
- http://groups.google.com/group/nxt-python
- Report bugs and suggest new features at:
- http://code.google.com/p/nxt-python/issues/list
-
- Thanks to:
-
- Doug Lau for writing NXT_Python, our starting point.
- rhn for creating what would become v2, making lots of smaller changes, and
- reviewing tons of code.
- mindsensors.com (esp. Ryan Kneip) for helping out with the code for a lot of
- their sensors and expanding the sensors covered by the type checking
- database.
- HiTechnic for providing identification information for their sensors. I note
- that they have now included this information in their website. ;)
- Linus Atorf, Samuel Leeman-Munk, melducky, Simon Levy, Steve Castellotti,
- Paulo Vieira, zonedabone, migpics, and anyone else I forgot for various
- fixes and additions.
- All our users for their interest and support!
-
-
-
- Troubleshooting Digital Sensors (don't read unless you have problems):
- If you are getting errors, strange behavor, or incorrect values from a digital
- sensor, chances are that there is a bug in our code. Follow these instructions
- to try and find out what's wrong:
- 1. Test the sensor with a different access library to make sure it's working
- right.
- 2. Check your code again. There are some weird "features" in the interfaces
- of some of the sensors; make sure you are doing things right.
- 3. Locate the sensor class's source code in nxt-python. It should be
- somewhere in nxt/sensor/<manufacturer>.py, under the heading "class SensorName(
- BaseDigitalSensor):". Read any comments for instructions on certain things.
-
- If you get to here and are still having a problem, you can either go ahead and
- report it now or continue to try and find and fix the problem and then report
- it (or not report it at all, but that wouldn't be very nice...).
- Python experience required beyond this point.
-
- 4. Get the sensor's specifications from the manufacturer's website. Make
- sure it includes a table of I2C registers and instructions for using them.
- 5. Pick one of the following depending on what the problem is:
- ####Errors:
- Cause: We screwed up.
- Solution: Check the line mentioned in the error for incorrect syntax or
- other problem. A bit of python experience and maybe some googling is needed
- here.
- ####Strange Behavior (in sensors with modes/commands):
- Cause: nxt-python's command enumerations are incorrect.
- Solution: Verify them using the sensor's specs, and correct any problems.
- See "Incorrect Values" for more.
- ####Incorrect Values:
- Cause: nxt-python is processing the value wrong.
- Solution: Check what goes on in the sampling method against what the spec
- says should be done. If there is an inconsistency, try to fix it.
- Cause: nxt-python has an incorrect register number or type in I2C_ADDRESS.
- Solution: Verify the address (the number) and the string (the struct format
- string). To verify the address, use the spec. To verify the struct format, you
- wil
-Platform: UNKNOWN
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/README b/AT91SAM7S256/armdebug/nxt-python-fantom/README
deleted file mode 100644
index 5d9a214..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/README
+++ /dev/null
@@ -1,169 +0,0 @@
-NXT-Python is a package for controlling a LEGO NXT robot using the Python
-programming language. It can communicate using either USB or Bluetooth. It is
-available under the Gnu GPL license. It is based on NXT_Python, where releases
-halted in May 2007.
-
-Requirements:
-
- * Python 2.6 (http://www.python.org)
- And at least one comm library:
- * Bluetooth communications:
- Linux/Windows: PyBluez (http://code.google.com/p/pybluez/)
- (package python-bluez in deb-based linuxes)
- Mac: LightBlue (http://lightblue.sourceforge.net/)
- * USB communications:
- PyUSB (http://sourceforge.net/projects/pyusb/)
-
-Installation (if using source package):
-
- * Untar/unzip source package
- * In package directory, run "python setup.py install" (as root), or if
- under windows, double-click install.bat.
- * To use USB on Linux as non-superuser, at a root terminal type:
- groupadd lego
- usermod -a -G lego [username]
- echo 'BUS=="usb", SYSFS{idVendor}=="0694", GROUP="lego", MODE="0660"' \
- > /etc/udev/rules.d/70-lego.rules
-
-Getting Started:
-
- Take a look at the examples directory. Feel free to copy that code into your
-scripts and don't be afraid to experiment! If you are having trouble with
-something, you may find the solution in the docstrings (for example,
-help('nxt.sensor.Ultrasonic')) or even in the source code (especially for
-digital sensors).
-
-Notes/FAQ:
- (I have tried to put the most important stuff first, but it would be a good
- idea to read the whole section. In any case, read it all the way through
- before asking for help. Thanks!)
-
- -=-=-About v2-=-=-
- This version is part of the 2.x series of releases. Programs designed for
-NXT_Python or for the 1.x series of nxt-python will not work with this version.
-If you are trying to get an old program to work, it most likely needs a 1.x
-series release, which can be downloaded from the nxt-python downloads page at
-googlecode. New projects should use a 2.x series release (hint: this is one!)
-due to the new features and API improvements. Converting old projects is
-somewhat difficult and not officially supported, though as always you're
-welcome to ask for help.
- -=-=-Problems and Their Solutions-=-=-
- Support for a number of sensors has not been tested at all, due to lack of
-hardware. I have started a project to test this code, but the going is slow
-and I have decided to go ahead and release rather than waiting several more
-months. If you have a problem with a digital sensor, see the troubleshooting
-guide below and don't forget to report your trouble!
- The Synchronized Motor support has not been extensively tested for accuracy.
-It seems to mostly work well but the accuracy of the braking function and the
-closeness of the two motors to each other have not been assesed.
- NXT-Python has not been tested and may not work with custom nxt firmware
-versions (if you don't know what that means, you don't need to worry about it).
-However, if the firmware uses the standard USB/BT communications protocol,
-everything should more or less work. NXT-Python has been tested with bricks
-using LEGO firmware version up to 1.29 and is compatible with protocol version
-1.124 (used by most if not all of the official firmwares). It has also been
-reported working with LeJOS.
- -=-=-If you co'd the SVN...-=-=-
- The Arduino directory of an svn checkout (not included with release
-packages) contains a digital sensor unit test system called nxtduemu. It is
-intended for developers and advanced users who are looking to experiment with
-sensors and the digital sensor framework and classes. See Arduino/README for
-more info and usage instructions.
-
-Specific Stability Status:
- nxt.brick, nxt.telegram, nxt.direct, and nxt.system:
- Hardly changed since NXT_Python; very, very stable.
- USB Communication System (nxt.usbsock)
- On Linux: Very stable and extensively tested.
- On Windows: Somewhat tested; seems to work pretty well.
- On Mac: Should be working, though I have not heard either way.
- BlueTooth Communication System (nxt.bluesock, nxt.lightblueglue)
- On Linux: Stable; well tested.
- On Windows: Stable; working last I checked.
- On Mac: Reported working.
- nxt.locator:
- Stable, somewhat tested. One developer reported problems.
- nxt.motor:
- Stable except for Synchronized Motor support, which is experimental at
- this stage and has not been extensively tested.
- nxt.sensor:
- Code not specific to a particular sensor is well tested and working
- great. More than half of the sensor classes were last reported working;
- the rest have not to my knowlege been tested and were written blindly
- from the manuacturers' specifications.
- nxt.error:
- If there's a problem with this one, I'm gonna cry.
-
-Contact:
-
- NXT-Python's Head Developer:
- Marcus Wanner (marcusw@cox.net)
- The support and development mailing list:
- http://groups.google.com/group/nxt-python
- Report bugs and suggest new features at:
- http://code.google.com/p/nxt-python/issues/list
-
-Thanks to:
-
- Doug Lau for writing NXT_Python, our starting point.
- rhn for creating what would become v2, making lots of smaller changes, and
- reviewing tons of code.
- mindsensors.com (esp. Ryan Kneip) for helping out with the code for a lot of
- their sensors and expanding the sensors covered by the type checking
- database.
- HiTechnic for providing identification information for their sensors. I note
- that they have now included this information in their website. ;)
- Linus Atorf, Samuel Leeman-Munk, melducky, Simon Levy, Steve Castellotti,
- Paulo Vieira, zonedabone, migpics, and anyone else I forgot for various
- fixes and additions.
- All our users for their interest and support!
-
-
-
-Troubleshooting Digital Sensors (don't read unless you have problems):
-If you are getting errors, strange behavor, or incorrect values from a digital
-sensor, chances are that there is a bug in our code. Follow these instructions
-to try and find out what's wrong:
- 1. Test the sensor with a different access library to make sure it's working
-right.
- 2. Check your code again. There are some weird "features" in the interfaces
-of some of the sensors; make sure you are doing things right.
- 3. Locate the sensor class's source code in nxt-python. It should be
-somewhere in nxt/sensor/<manufacturer>.py, under the heading "class SensorName(
-BaseDigitalSensor):". Read any comments for instructions on certain things.
-
-If you get to here and are still having a problem, you can either go ahead and
-report it now or continue to try and find and fix the problem and then report
-it (or not report it at all, but that wouldn't be very nice...).
-Python experience required beyond this point.
-
- 4. Get the sensor's specifications from the manufacturer's website. Make
-sure it includes a table of I2C registers and instructions for using them.
- 5. Pick one of the following depending on what the problem is:
-####Errors:
- Cause: We screwed up.
- Solution: Check the line mentioned in the error for incorrect syntax or
-other problem. A bit of python experience and maybe some googling is needed
-here.
-####Strange Behavior (in sensors with modes/commands):
- Cause: nxt-python's command enumerations are incorrect.
- Solution: Verify them using the sensor's specs, and correct any problems.
- See "Incorrect Values" for more.
-####Incorrect Values:
- Cause: nxt-python is processing the value wrong.
- Solution: Check what goes on in the sampling method against what the spec
-says should be done. If there is an inconsistency, try to fix it.
- Cause: nxt-python has an incorrect register number or type in I2C_ADDRESS.
- Solution: Verify the address (the number) and the string (the struct format
-string). To verify the address, use the spec. To verify the struct format, you
-will need to read this: <http://docs.python.org/library/struct.html#format-
-strings> or have experience with struct.
-Read the spec for the sensor to determine how the given value should be read,
-then start at the sample method and read through it, checking for problems as
-you go. If it seems right, go back to the I2C_ADDRESS chunk (near the top of the
-class) and make sure that the correct struct format string is being used. The
-most common problem here is values that are off by plus or minus 128 or 32768
-because of an incorrect signed/unsigned setting. This can be fixed by switching
-the case (as in upper or lower) of the letter in the string. Other problems
-could include the wrong size (B, H, or L) being used, or, in the two latter
-ones, the wrong byte order (< or >). As always, common sense required.
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/examples/alpharex.py b/AT91SAM7S256/armdebug/nxt-python-fantom/examples/alpharex.py
deleted file mode 100644
index 13c5979..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/examples/alpharex.py
+++ /dev/null
@@ -1,151 +0,0 @@
-r'''Alpha Rex API
-
- A high-level, object-oriented programming interface to Lego MINDSTORMS
- NXT's "Alpha Rex" model (see [1] for assembling instructions), along with a
- small collection of functions demonstrating obvious usage scenarios.
-
- 1. http://www.active-robots.com/products/mindstorms4schools/building-instructions.shtml
-'''
-
-from time import sleep
-
-from nxt.brick import Brick
-from nxt.locator import find_one_brick
-from nxt.motor import Motor, PORT_A, PORT_B, PORT_C
-from nxt.sensor import Light, Sound, Touch, Ultrasonic
-from nxt.sensor import PORT_1, PORT_2, PORT_3, PORT_4
-
-
-FORTH = 100
-BACK = -100
-
-
-class AlphaRex(object):
- r'''A high-level controller for the Alpha Rex model.
-
- This class implements methods for the most obvious actions performable
- by Alpha Rex, such as walk, wave its arms, and retrieve sensor samples.
- Additionally, it also allows direct access to the robot's components
- through public attributes.
- '''
- def __init__(self, brick='NXT'):
- r'''Creates a new Alpha Rex controller.
-
- brick
- Either an nxt.brick.Brick object, or an NXT brick's name as a
- string. If omitted, a Brick named 'NXT' is looked up.
- '''
- if isinstance(brick, basestring):
- brick = find_one_brick(name=brick)
-
- self.brick = brick
- self.arms = Motor(brick, PORT_A)
- self.legs = [Motor(brick, PORT_B), Motor(brick, PORT_C)]
-
- self.touch = Touch(brick, PORT_1)
- self.sound = Sound(brick, PORT_2)
- self.light = Light(brick, PORT_3)
- self.ultrasonic = Ultrasonic(brick, PORT_4)
-
- def echolocate(self):
- r'''Reads the Ultrasonic sensor's output.
- '''
- return self.ultrasonic.get_sample()
-
- def feel(self):
- r'''Reads the Touch sensor's output.
- '''
- return self.touch.get_sample()
-
- def hear(self):
- r'''Reads the Sound sensor's output.
- '''
- return self.sound.get_sample()
-
- def say(self, line, times=1):
- r'''Plays a sound file named (line + '.rso'), which is expected to be
- stored in the brick. The file is played (times) times.
-
- line
- The name of a sound file stored in the brick.
-
- times
- How many times the sound file will be played before this method
- returns.
- '''
- for i in range(0, times):
- self.brick.play_sound_file(False, line + '.rso')
- sleep(1)
-
- def see(self):
- r'''Reads the Light sensor's output.
- '''
- return self.light.get_sample()
-
- def walk(self, secs, power=FORTH):
- r'''Simultaneously activates the leg motors, causing Alpha Rex to walk.
-
- secs
- How long the motors will rotate.
-
- power
- The strength effected by the motors. Positive values will cause
- Alpha Rex to walk forward, while negative values will cause it
- to walk backwards. If you are unsure about how much force to
- apply, the special values FORTH and BACK provide reasonable
- defaults. If omitted, FORTH is used.
- '''
- for motor in self.legs:
- motor.run(power=power)
-
- sleep(secs)
-
- for motor in self.legs:
- motor.idle()
-
- def wave(self, secs, power=100):
- r'''Make Alpha Rex move its arms.
-
- secs
- How long the arms' motor will rotate.
-
- power
- The strength effected by the motor. If omitted, (100) is used.
- '''
- self.arms.run(power=power)
- sleep(secs)
- self.arms.idle()
-
-
-def wave_and_talk():
- r'''Connects to a nearby Alpha Rex, then commands it to wave its arms and
- play the sound file 'Object.rso'.
- '''
- robot = AlphaRex()
- robot.wave(1)
- robot.say('Object')
-
-
-def walk_forth_and_back():
- r'''Connects to a nearby Alpha Rex, then commands it to walk forward and
- then backwards.
- '''
- robot = AlphaRex()
- robot.walk(10, FORTH)
- robot.walk(10, BACK)
-
-
-def walk_to_object():
- r'''Connects to a nearby Alpha Rex, then commands it to walk until it
- approaches an obstacle, then stop and say 'Object' three times.
- '''
- robot = AlphaRex()
- while robot.echolocate() > 10:
- robot.walk(1, FORTH)
-
- robot.say('Object', 3)
-
-
-if __name__ == '__main__':
- walk_to_object()
-
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/examples/cnc.py b/AT91SAM7S256/armdebug/nxt-python-fantom/examples/cnc.py
deleted file mode 100644
index 456cf92..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/examples/cnc.py
+++ /dev/null
@@ -1,53 +0,0 @@
-#Script to control a NXT 2-axis CNC "Pancake maker"
-#Illustrates controlling more than one motor at the same time without trying to
-#sync them. Uses the thread module.
-#Written 2/3/11 by Marcus Wanner
-#
-#For more info and warnings see:
-#http://groups.google.com/group/nxt-python/browse_thread/thread/f6ef0865ae768ef
-
-import nxt, thread, time
-b = nxt.find_one_brick(name = 'MyNXT')
-mx = nxt.Motor(b, nxt.PORT_A)
-my = nxt.Motor(b, nxt.PORT_B)
-motors = [mx, my]
-
-def turnmotor(m, power, degrees):
- m.turn(power, degrees)
-
-#here are the instructions...
-#the first value is the time to start the instruction
-#the second is the axis (0 for x, 1 for y)
-#the third is the power
-#the fourth is the degrees
-#it's probably not a good idea to run simultaneous turn
-#functions on a single motor, so be careful with this
-instructions = (
- [0, 0, 80, 180],
- [0, 1, -40, 1080],
- [1, 0, -80, 180],
- [2, 0, 80, 180],
- [3, 1, 100, 360],
- [3, 0, -100, 360],
-)
-#how long from start until the last instruction is ended
-length = 5
-
-def runinstruction(i):
- motorid, speed, degrees = i
- #THIS IS THE IMPORTANT PART!
- thread.start_new_thread(
- turnmotor,
- (motors[motorid], speed, degrees))
-
-#main loop
-seconds = 0
-while 1:
- print "Tick %d" % seconds
- for i in instructions:
- if i[0] == seconds:
- runinstruction(i[1:])
- seconds = seconds + 1
- if seconds >= length:
- break
- time.sleep(1)
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/examples/latency.py b/AT91SAM7S256/armdebug/nxt-python-fantom/examples/latency.py
deleted file mode 100644
index b4b1f26..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/examples/latency.py
+++ /dev/null
@@ -1,23 +0,0 @@
-#!/usr/bin/env python
-
-import time
-import nxt.locator
-from nxt.sensor import *
-
-b = nxt.locator.find_one_brick()
-
-#Touch sensor latency test
-touch = Touch(b, PORT_1)
-start = time.time()
-for i in range(100):
- touch.get_sample()
-stop = time.time()
-print 'touch latency: %s ms' % (1000 * (stop - start) / 100.0)
-
-#Ultrasonic sensor latency test
-ultrasonic = Ultrasonic(b, PORT_4)
-start = time.time()
-for i in range(100):
- ultrasonic.get_sample()
-stop = time.time()
-print 'ultrasonic latency: %s ms' % (1000 * (stop - start) / 100.0)
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/examples/mary.py b/AT91SAM7S256/armdebug/nxt-python-fantom/examples/mary.py
deleted file mode 100644
index 907cc23..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/examples/mary.py
+++ /dev/null
@@ -1,45 +0,0 @@
-#!/usr/bin/env python
-#
-# Converted from mary.rb found in ruby_nxt package
-# Plays "Mary Had A Little Lamb"
-# Author: Christopher Continanza <christopher.continanza@villanova.edu>
-
-from time import sleep
-import nxt.locator
-
-FREQ_C = 523
-FREQ_D = 587
-FREQ_E = 659
-FREQ_G = 784
-
-b = nxt.locator.find_one_brick()
-
-b.play_tone_and_wait(FREQ_E, 500)
-b.play_tone_and_wait(FREQ_D, 500)
-b.play_tone_and_wait(FREQ_C, 500)
-b.play_tone_and_wait(FREQ_D, 500)
-b.play_tone_and_wait(FREQ_E, 500)
-b.play_tone_and_wait(FREQ_E, 500)
-b.play_tone_and_wait(FREQ_E, 500)
-sleep(0.5)
-b.play_tone_and_wait(FREQ_D, 500)
-b.play_tone_and_wait(FREQ_D, 500)
-b.play_tone_and_wait(FREQ_D, 500)
-sleep(0.5)
-b.play_tone_and_wait(FREQ_E, 500)
-b.play_tone_and_wait(FREQ_G, 500)
-b.play_tone_and_wait(FREQ_G, 500)
-sleep(0.5)
-b.play_tone_and_wait(FREQ_E, 500)
-b.play_tone_and_wait(FREQ_D, 500)
-b.play_tone_and_wait(FREQ_C, 500)
-b.play_tone_and_wait(FREQ_D, 500)
-b.play_tone_and_wait(FREQ_E, 500)
-b.play_tone_and_wait(FREQ_E, 500)
-b.play_tone_and_wait(FREQ_E, 500)
-b.play_tone_and_wait(FREQ_E, 500)
-b.play_tone_and_wait(FREQ_D, 500)
-b.play_tone_and_wait(FREQ_D, 500)
-b.play_tone_and_wait(FREQ_E, 500)
-b.play_tone_and_wait(FREQ_D, 500)
-b.play_tone_and_wait(FREQ_C, 750)
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/examples/message_test.py b/AT91SAM7S256/armdebug/nxt-python-fantom/examples/message_test.py
deleted file mode 100644
index c2fbda7..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/examples/message_test.py
+++ /dev/null
@@ -1,15 +0,0 @@
-#!/usr/bin/env python
-
-#During this test you need to run any program on the brick
-#which doesn't use the messaging system. Most programs fit
-#this requirement.
-
-import nxt.locator
-
-b = nxt.locator.find_one_brick()
-for box in range(10):
- b.message_write(box, 'message test %d' % box)
-for box in range(10):
- local_box, message = b.message_read(box, box, True)
- print local_box, message
-print 'Test succeeded!'
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/examples/spin.py b/AT91SAM7S256/armdebug/nxt-python-fantom/examples/spin.py
deleted file mode 100644
index fc7cb2c..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/examples/spin.py
+++ /dev/null
@@ -1,14 +0,0 @@
-#!/usr/bin/env python
-
-import nxt.locator
-from nxt.motor import *
-
-def spin_around(b):
- m_left = Motor(b, PORT_B)
- m_left.turn(100, 360)
- m_right = Motor(b, PORT_C)
- m_right.turn(-100, 360)
-
-b = nxt.locator.find_one_brick()
-spin_around(b)
-
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/examples/test_sensors.py b/AT91SAM7S256/armdebug/nxt-python-fantom/examples/test_sensors.py
deleted file mode 100644
index 4c8d249..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/examples/test_sensors.py
+++ /dev/null
@@ -1,11 +0,0 @@
-#!/usr/bin/env python
-
-import nxt.locator
-from nxt.sensor import *
-
-b = nxt.locator.find_one_brick()
-
-print 'Touch:', Touch(b, PORT_1).get_sample()
-print 'Sound:', Sound(b, PORT_2).get_sample()
-print 'Light:', Light(b, PORT_3).get_sample()
-print 'Ultrasonic:', Ultrasonic(b, PORT_4).get_sample()
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/install.bat b/AT91SAM7S256/armdebug/nxt-python-fantom/install.bat
deleted file mode 100644
index afa7bfc..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/install.bat
+++ /dev/null
@@ -1,11 +0,0 @@
-@echo off
-@call setup.py install
-if errorlevel 1 goto error
-goto end
-:error
-echo -=-=-=-=-=-=-=-=-=-=-
-echo There was an error during the installation.
-echo Please check the above text for more information.
-pause
-:end
-@echo on
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/__init__.py b/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/__init__.py
deleted file mode 100644
index 01be052..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/__init__.py
+++ /dev/null
@@ -1,17 +0,0 @@
-# nxt.__init__ module -- LEGO Mindstorms NXT python package
-# Copyright (C) 2006 Douglas P Lau
-# Copyright (C) 2009 Marcus Wanner
-#
-# 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 3 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.
-
-from .locator import find_one_brick
-from .motor import *
-from .sensor import *
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/bluesock.py b/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/bluesock.py
deleted file mode 100644
index 99917f2..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/bluesock.py
+++ /dev/null
@@ -1,82 +0,0 @@
-# nxt.bluesock module -- Bluetooth socket communication with LEGO Minstorms NXT
-# Copyright (C) 2006, 2007 Douglas P Lau
-# Copyright (C) 2009 Marcus Wanner
-#
-# 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 3 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.
-
-try:
- import fantomglue as bluetooth
-except ImportError:
- try:
- import bluetooth
- except ImportError:
- import lightblueglue as bluetooth
-
-import os
-from .brick import Brick
-
-class BlueSock(object):
-
- bsize = 118 # Bluetooth socket block size
- PORT = 1 # Standard NXT rfcomm port
-
- def __init__(self, host):
- self.host = host
- self.sock = None
- self.debug = False
-
- def __str__(self):
- return 'Bluetooth (%s)' % self.host
-
- def connect(self):
- if self.debug:
- print 'Connecting via Bluetooth...'
- sock = bluetooth.BluetoothSocket(bluetooth.RFCOMM)
- sock.connect((self.host, BlueSock.PORT))
- self.sock = sock
- if self.debug:
- print 'Connected.'
- return Brick(self)
-
- def close(self):
- if self.debug:
- print 'Closing Bluetooth connection...'
- self.sock.close()
- if self.debug:
- print 'Bluetooth connection closed.'
-
- def send(self, data):
- if self.debug:
- print 'Send:',
- print ':'.join('%02x' % ord(c) for c in data)
- l0 = len(data) & 0xFF
- l1 = (len(data) >> 8) & 0xFF
- d = chr(l0) + chr(l1) + data
- self.sock.send(d)
-
- def recv(self):
- data = self.sock.recv(2)
- l0 = ord(data[0])
- l1 = ord(data[1])
- plen = l0 + (l1 << 8)
- data = self.sock.recv(plen)
- if self.debug:
- print 'Recv:',
- print ':'.join('%02x' % ord(c) for c in data)
- return data
-
-def _check_brick(arg, value):
- return arg is None or arg == value
-
-def find_bricks(host=None, name=None):
- for h, n in bluetooth.discover_devices(lookup_names=True):
- if _check_brick(host, h) and _check_brick(name, n):
- yield BlueSock(h)
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/brick.py b/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/brick.py
deleted file mode 100644
index 240ba27..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/brick.py
+++ /dev/null
@@ -1,226 +0,0 @@
-# nxt.brick module -- Classes to represent LEGO Mindstorms NXT bricks
-# Copyright (C) 2006 Douglas P Lau
-# Copyright (C) 2009 Marcus Wanner, rhn
-# Copyright (C) 2010 rhn, Marcus Wanner, zonedabone
-#
-# 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 3 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.
-
-from time import sleep
-from threading import Lock
-from .error import FileNotFound, ModuleNotFound
-from .telegram import OPCODES, Telegram
-from .sensor import get_sensor
-
-def _make_poller(opcode, poll_func, parse_func):
- def poll(self, *args, **kwargs):
- ogram = poll_func(opcode, *args, **kwargs)
- with self.lock:
- self.sock.send(str(ogram))
- igram = Telegram(opcode=opcode, pkt=self.sock.recv())
- return parse_func(igram)
- return poll
-
-class _Meta(type):
- 'Metaclass which adds one method for each telegram opcode'
-
- def __init__(cls, name, bases, dict):
- super(_Meta, cls).__init__(name, bases, dict)
- for opcode in OPCODES:
- poll_func, parse_func = OPCODES[opcode]
- m = _make_poller(opcode, poll_func, parse_func)
- setattr(cls, poll_func.__name__, m)
-
-
-class FileFinder(object):
- 'A generator to find files on a NXT brick.'
-
- def __init__(self, brick, pattern):
- self.brick = brick
- self.pattern = pattern
- self.handle = None
-
- def _close(self):
- if self.handle is not None:
- self.brick.close(self.handle)
- self.handle = None
-
- def __del__(self):
- self._close()
-
- def __iter__(self):
- results = []
- self.handle, fname, size = self.brick.find_first(self.pattern)
- results.append((fname, size))
- while True:
- try:
- handle, fname, size = self.brick.find_next(self.handle)
- results.append((fname, size))
- except FileNotFound:
- self._close()
- break
- for result in results:
- yield result
-
-
-def File(brick, name, mode='r', size=None):
- """Opens a file for reading/writing. Mode is 'r' or 'w'. If mode is 'w',
- size must be provided.
- """
- if mode == 'w':
- if size is not None:
- return FileWriter(brick, name, size)
- else:
- return ValueError('Size not specified')
- elif mode == 'r':
- return FileReader(brick, name)
- else:
- return ValueError('Mode ' + str(mode) + ' not supported')
-
-
-class FileReader(object):
- """Context manager to read a file on a NXT brick. Do use the iterator or
- the read() method, but not both at the same time!
- The iterator returns strings of an arbitrary (short) length.
- """
-
- def __init__(self, brick, fname):
- self.brick = brick
- self.handle, self.size = brick.open_read(fname)
-
- def read(self, bytes=None):
- if bytes is not None:
- remaining = bytes
- else:
- remaining = self.size
- bsize = self.brick.sock.bsize
- data = []
- while remaining > 0:
- handle, bsize, buffer_ = self.brick.read(self.handle,
- min(bsize, remaining))
- remaining -= len(buffer_)
- data.append(buffer_)
- return ''.join(data)
-
- def close(self):
- if self.handle is not None:
- self.brick.close(self.handle)
- self.handle = None
-
- def __del__(self):
- self.close()
-
- def __enter__(self):
- return self
-
- def __exit__(self, etp, value, tb):
- self.close()
-
- def __iter__(self):
- rem = self.size
- bsize = self.brick.sock.bsize
- while rem > 0:
- handle, bsize, data = self.brick.read(self.handle,
- min(bsize, rem))
- yield data
- rem -= len(data)
-
-
-class FileWriter(object):
- "Object to write to a file on a NXT brick"
-
- def __init__(self, brick, fname, size):
- self.brick = brick
- self.handle = self.brick.open_write(fname, size)
- self._position = 0
- self.size = size
-
- def __del__(self):
- self.close()
-
- def close(self):
- if self.handle is not None:
- self.brick.close(self.handle)
- self.handle = None
-
- def tell(self):
- return self._position
-
- def write(self, data):
- remaining = len(data)
- if remaining > self.size - self._position:
- raise ValueError('Data will not fit into remaining space')
- bsize = self.brick.sock.bsize
- data_position = 0
-
- while remaining > 0:
- batch_size = min(bsize, remaining)
- next_data_position = data_position + batch_size
- buffer_ = data[data_position:next_data_position]
-
- handle, size = self.brick.write(self.handle, buffer_)
-
- self._position += batch_size
- data_position = next_data_position
- remaining -= batch_size
-
-
-class ModuleFinder(object):
- 'Iterator to lookup modules on a NXT brick'
-
- def __init__(self, brick, pattern):
- self.brick = brick
- self.pattern = pattern
- self.handle = None
-
- def _close(self):
- if self.handle:
- self.brick.close(self.handle)
- self.handle = None
-
- def __del__(self):
- self._close()
-
- def __iter__(self):
- self.handle, mname, mid, msize, miomap_size = \
- self.brick.request_first_module(self.pattern)
- yield (mname, mid, msize, miomap_size)
- while True:
- try:
- handle, mname, mid, msize, miomap_size = \
- self.brick.request_next_module(
- self.handle)
- yield (mname, mid, msize, miomap_size)
- except ModuleNotFound:
- self._close()
- break
-
-
-class Brick(object): #TODO: this begs to have explicit methods
- 'Main object for NXT Control'
-
- __metaclass__ = _Meta
-
- def __init__(self, sock):
- self.sock = sock
- self.lock = Lock()
-
- def play_tone_and_wait(self, frequency, duration):
- self.play_tone(frequency, duration)
- sleep(duration / 1000.0)
-
- def __del__(self):
- print "Deleting Brick"
- self.sock.close()
-
- find_files = FileFinder
- find_modules = ModuleFinder
- open_file = File
- get_sensor = get_sensor
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/direct.py b/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/direct.py
deleted file mode 100644
index 50b7f2a..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/direct.py
+++ /dev/null
@@ -1,216 +0,0 @@
-# nxt.direct module -- LEGO Mindstorms NXT direct telegrams
-# Copyright (C) 2006, 2007 Douglas P Lau
-# Copyright (C) 2009 Marcus Wanner
-#
-# 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 3 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.
-
-'Use for direct communication with the NXT ***EXTREMELY ADVANCED USERS ONLY***'
-
-def _create(opcode):
- 'Create a simple direct telegram'
- from telegram import Telegram
- return Telegram(True, opcode)
-
-def start_program(opcode, fname):
- tgram = _create(opcode)
- tgram.add_filename(fname)
- return tgram
-
-def _parse_simple(tgram):
- tgram.check_status()
-
-def stop_program(opcode):
- return _create(opcode)
-
-def play_sound_file(opcode, loop, fname):
- tgram = _create(opcode)
- tgram.add_u8(loop)
- tgram.add_filename(fname)
- return tgram
-
-def play_tone(opcode, frequency, duration):
- 'Play a tone at frequency (Hz) for duration (ms)'
- tgram = _create(opcode)
- tgram.add_u16(frequency)
- tgram.add_u16(duration)
- return tgram
-
-def set_output_state(opcode, port, power, mode, regulation, turn_ratio,
- run_state, tacho_limit):
- tgram = _create(opcode)
- tgram.add_u8(port)
- tgram.add_s8(power)
- tgram.add_u8(mode)
- tgram.add_u8(regulation)
- tgram.add_s8(turn_ratio)
- tgram.add_u8(run_state)
- tgram.add_u32(tacho_limit)
- return tgram
-
-def set_input_mode(opcode, port, sensor_type, sensor_mode):
- tgram = _create(opcode)
- tgram.add_u8(port)
- tgram.add_u8(sensor_type)
- tgram.add_u8(sensor_mode)
- return tgram
-
-def get_output_state(opcode, port):
- tgram = _create(opcode)
- tgram.add_u8(port)
- return tgram
-
-def _parse_get_output_state(tgram):
- tgram.check_status()
- port = tgram.parse_u8()
- power = tgram.parse_s8()
- mode = tgram.parse_u8()
- regulation = tgram.parse_u8()
- turn_ratio = tgram.parse_s8()
- run_state = tgram.parse_u8()
- tacho_limit = tgram.parse_u32()
- tacho_count = tgram.parse_s32()
- block_tacho_count = tgram.parse_s32()
- rotation_count = tgram.parse_s32()
- return (port, power, mode, regulation, turn_ratio, run_state,
- tacho_limit, tacho_count, block_tacho_count, rotation_count)
-
-def get_input_values(opcode, port):
- tgram = _create(opcode)
- tgram.add_u8(port)
- return tgram
-
-def _parse_get_input_values(tgram):
- tgram.check_status()
- port = tgram.parse_u8()
- valid = tgram.parse_u8()
- calibrated = tgram.parse_u8()
- sensor_type = tgram.parse_u8()
- sensor_mode = tgram.parse_u8()
- raw_ad_value = tgram.parse_u16()
- normalized_ad_value = tgram.parse_u16()
- scaled_value = tgram.parse_s16()
- calibrated_value = tgram.parse_s16()
- return (port, valid, calibrated, sensor_type, sensor_mode, raw_ad_value,
- normalized_ad_value, scaled_value, calibrated_value)
-
-def reset_input_scaled_value(opcode, port):
- tgram = _create(opcode)
- tgram.add_u8(port)
- return tgram
-
-def message_write(opcode, inbox, message):
- tgram = _create(opcode)
- tgram.add_u8(inbox)
- tgram.add_u8(len(message) + 1)
- tgram.add_string(len(message), message)
- tgram.add_u8(0)
- return tgram
-
-def reset_motor_position(opcode, port, relative):
- tgram = _create(opcode)
- tgram.add_u8(port)
- tgram.add_u8(relative)
- return tgram
-
-def get_battery_level(opcode):
- return _create(opcode)
-
-def _parse_get_battery_level(tgram):
- tgram.check_status()
- millivolts = tgram.parse_u16()
- return millivolts
-
-def stop_sound_playback(opcode):
- return _create(opcode)
-
-def keep_alive(opcode):
- return _create(opcode)
-
-def _parse_keep_alive(tgram):
- tgram.check_status()
- sleep_time = tgram.parse_u32()
- return sleep_time
-
-def ls_get_status(opcode, port):
- 'Get status of low-speed sensor (ultrasonic)'
- tgram = _create(opcode)
- tgram.add_u8(port)
- return tgram
-
-def _parse_ls_get_status(tgram):
- tgram.check_status()
- n_bytes = tgram.parse_u8()
- return n_bytes
-
-def ls_write(opcode, port, tx_data, rx_bytes):
- 'Write a low-speed command to a sensor (ultrasonic)'
- tgram = _create(opcode)
- tgram.add_u8(port)
- tgram.add_u8(len(tx_data))
- tgram.add_u8(rx_bytes)
- tgram.add_string(len(tx_data), tx_data)
- return tgram
-
-def ls_read(opcode, port):
- 'Read a low-speed sensor value (ultrasonic)'
- tgram = _create(opcode)
- tgram.add_u8(port)
- return tgram
-
-def _parse_ls_read(tgram):
- tgram.check_status()
- n_bytes = tgram.parse_u8()
- contents = tgram.parse_string()
- return contents[:n_bytes]
-
-def get_current_program_name(opcode):
- return _create(opcode)
-
-def _parse_get_current_program_name(tgram):
- tgram.check_status()
- fname = tgram.parse_string()
- return fname
-
-def message_read(opcode, remote_inbox, local_inbox, remove):
- tgram = _create(opcode)
- tgram.add_u8(remote_inbox)
- tgram.add_u8(local_inbox)
- tgram.add_u8(remove)
- return tgram
-
-def _parse_message_read(tgram):
- tgram.check_status()
- local_inbox = tgram.parse_u8()
- n_bytes = tgram.parse_u8()
- message = tgram.parse_string()
- return (local_inbox, message[:n_bytes])
-
-OPCODES = {
- 0x00: (start_program, _parse_simple),
- 0x01: (stop_program, _parse_simple),
- 0x02: (play_sound_file, _parse_simple),
- 0x03: (play_tone, _parse_simple),
- 0x04: (set_output_state, _parse_simple),
- 0x05: (set_input_mode, _parse_simple),
- 0x06: (get_output_state, _parse_get_output_state),
- 0x07: (get_input_values, _parse_get_input_values),
- 0x08: (reset_input_scaled_value, _parse_simple),
- 0x09: (message_write, _parse_simple),
- 0x0A: (reset_motor_position, _parse_simple),
- 0x0B: (get_battery_level, _parse_get_battery_level),
- 0x0C: (stop_sound_playback, _parse_simple),
- 0x0D: (keep_alive, _parse_keep_alive),
- 0x0E: (ls_get_status, _parse_ls_get_status),
- 0x0F: (ls_write, _parse_simple),
- 0x10: (ls_read, _parse_ls_read),
- 0x11: (get_current_program_name, _parse_get_current_program_name),
- 0x13: (message_read, _parse_message_read),
-}
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/error.py b/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/error.py
deleted file mode 100644
index 3d14497..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/error.py
+++ /dev/null
@@ -1,87 +0,0 @@
-# nxt.error module -- LEGO Mindstorms NXT error handling
-# Copyright (C) 2006, 2007 Douglas P Lau
-# Copyright (C) 2009 Marcus Wanner
-#
-# 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 3 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.
-
-'Declarations for the errors'
-
-class ProtocolError(Exception):
- pass
-
-class SysProtError(ProtocolError):
- pass
-
-class FileExistsError(SysProtError):
- pass
-
-class FileNotFound(SysProtError):
- pass
-
-class ModuleNotFound(SysProtError):
- pass
-
-class DirProtError(ProtocolError):
- pass
-
-class I2CError(DirProtError):
- pass
-
-class I2CPendingError(I2CError):
- pass
-
-CODES = {
- 0x00: None,
- 0x20: I2CPendingError('Pending communication transaction in progress'),
- 0x40: DirProtError('Specified mailbox queue is empty'),
- 0x81: SysProtError('No more handles'),
- 0x82: SysProtError('No space'),
- 0x83: SysProtError('No more files'),
- 0x84: SysProtError('End of file expected'),
- 0x85: SysProtError('End of file'),
- 0x86: SysProtError('Not a linear file'),
- 0x87: FileNotFound('File not found'),
- 0x88: SysProtError('Handle already closed'),
- 0x89: SysProtError('No linear space'),
- 0x8A: SysProtError('Undefined error'),
- 0x8B: SysProtError('File is busy'),
- 0x8C: SysProtError('No write buffers'),
- 0x8D: SysProtError('Append not possible'),
- 0x8E: SysProtError('File is full'),
- 0x8F: FileExistsError('File exists'),
- 0x90: ModuleNotFound('Module not found'),
- 0x91: SysProtError('Out of bounds'),
- 0x92: SysProtError('Illegal file name'),
- 0x93: SysProtError('Illegal handle'),
- 0xBD: DirProtError('Request failed (i.e. specified file not found)'),
- 0xBE: DirProtError('Unknown command opcode'),
- 0xBF: DirProtError('Insane packet'),
- 0xC0: DirProtError('Data contains out-of-range values'),
- 0xDD: DirProtError('Communication bus error'),
- 0xDE: DirProtError('No free memory in communication buffer'),
- 0xDF: DirProtError('Specified channel/connection is not valid'),
- 0xE0: I2CError('Specified channel/connection not configured or busy'),
- 0xEC: DirProtError('No active program'),
- 0xED: DirProtError('Illegal size specified'),
- 0xEE: DirProtError('Illegal mailbox queue ID specified'),
- 0xEF: DirProtError('Attempted to access invalid field of a structure'),
- 0xF0: DirProtError('Bad input or output specified'),
- 0xFB: DirProtError('Insufficient memory available'),
- 0xFF: DirProtError('Bad arguments'),
-}
-
-def check_status(status):
- if status:
- ex = CODES.get(status)
- if ex:
- raise ex
- else:
- raise ProtocolError, status
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/fantomglue.py b/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/fantomglue.py
deleted file mode 100644
index 697655f..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/fantomglue.py
+++ /dev/null
@@ -1,211 +0,0 @@
-# fantom.py module -- Glue code from NXT_Python to Fantom, allowing
-# NXT_Python to run on Mac without modification. Supports subset of
-# PyBluez/bluetooth.py used by NXT_Python.
-#
-# Copyright (C) 2011 Tat-Chee Wan
-#
-# 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 3 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.
-
-import pyfantom
-
-USB_BUFSIZE = 64
-
-RFCOMM=11 # lightblue const
-FANTOM_BT = RFCOMM # For compatibilty with lightblue
-FANTOM_USB = 0
-
-# Bluetooth Iterator
-def discover_devices(lookup_names=False): # parameter is ignored
- pairs = []
- for d in pyfantom.NXTIterator(True):
- # h: host, n: name
- h = d.get_resource_string()
- nxt = d.get_nxt()
- device_info = nxt.get_device_info()
- n = device_info.name
- del nxt
- pairs.append((h, n))
- return pairs
-
-class BluetoothSocket:
-
- def __init__(self, proto = FANTOM_BT, _sock=None):
- # We instantiate a NXT object only when we connect if none supplied
- self._sock = _sock
- self._proto = proto
- self.debug = True
-
- def __str__(self):
- return 'FantomGlue BT (%s)' % self.device_name()
-
- def device_name(self):
- devinfo = self._sock.get_device_info()
- return devinfo.name
-
- def connect(self, addrport):
- addr, port = addrport
- if self._sock is None:
- # Port is ignored
- paired_addr = pair_bluetooth(addr)
- if self.debug:
- print "BT Paired Addr: ", paired_addr
- self._sock = pyfantom.NXT(paired_addr)
-
- def send(self, data):
- return self._sock.write( data )
-
- def recv(self, numbytes):
- return self._sock.read( numbytes )
-
- def close(self):
- if self._sock is not None:
- self._sock.close()
- self._sock = None
-
- #def __del__(self):
- # """Destroy interface."""
- # if self._sock is not None:
- # del self._sock
- # if self.debug:
- # print "NXT object deleted"
- # else:
- # if self.debug:
- # print "No NXT Object when calling __del__ for BluetoothSocket"
-
-class BluetoothError(IOError):
- pass
-
-def _check_brick(arg, value):
- return arg is None or arg == value
-
-
-def find_devices(lookup_names=False): # parameter is ignored
- devicelist = []
- for d in pyfantom.NXTIterator(False):
- #name = d.get_name()
- #addr = d.get_resource_string()
- #print "NXT addr: ", addr
- nxt = d.get_nxt()
- devicelist.append(nxt)
- return devicelist
-
-# FIXME: The semantics of find_devices is different from discover_devices
-#
-# # h: host, n: name
-# hostmatched = None
-# namematched = None
-# h = d.get_resource_string()
-# nxt = d.get_nxt()
-# device_info = nxt.get_device_info()
-# n = device_info.name
-# if _check_brick(host, h) and _check_brick(name, n):
-# yield nxt
-# else:
-# del nxt # Does not match criteria
-
-class USBSocket:
-
- def __init__(self, device=None):
- # We instantiate a NXT object only when we connect if none supplied
- # FIXME: The addr is not passed in, so we can't actually create a NXT object later
- #self.device = device
- self._sock = device
- self.debug = True
-
- def __str__(self):
- return 'FantomGlue USB (%s)' % self.device_name()
-
- def device_name(self):
- devinfo = self._sock.get_device_info()
- return devinfo.name
-
- def connect(self):
- if self._sock is None:
- # Port is ignored
- if self.debug:
- print "No NXT object assigned"
- self._sock = pyfantom.NXT(addr) # FIXME: No address!
- else:
- if self.debug:
- print "Using existing NXT object"
-
- def send(self, data):
- return self._sock.write( data )
-
- def recv(self, numbytes):
- return self._sock.read( numbytes )
-
- #def poll_command(self, numbytes):
- # I'm not sure if this is specific to Direct Command Processing
- # Or if it refers to any data transmission
- #print "Bytes Available:", self._sock.bytes_available()
- #return self._sock.read_buffer( numbytes, 0 )
-
- def close(self):
- if self._sock is not None:
- self._sock.close()
- self._sock = None
-
- #def __del__(self):
- # """Destroy interface."""
- # if self._sock is not None:
- # del self._sock
- # if self.debug:
- # print "NXT object deleted"
- # else:
- # if self.debug:
- # print "No NXT Object when calling __del__ for USBSocket"
-
-if __name__ == '__main__':
- #get_info = False
- get_info = True
- write_read = True
- for i in find_devices():
- if get_info:
- print " firmware version:", i.get_firmware_version()
- print " get device info:", i.get_device_info()
- rs = i.get_resource_string()
- print " resource string:", rs
- if write_read:
- nxt = USBSocket(i)
- nxt.connect()
- import struct
- # Write VERSION SYS_CMD.
- # Query:
- # SYS_CMD: 0x01
- # VERSION: 0x88
- cmd = struct.pack('2B', 0x01, 0x88)
- r = nxt.send(cmd)
- print "wrote", r
- # Response:
- # REPLY_CMD: 0x02
- # VERSION: 0x88
- # SUCCESS: 0x00
- # PROTOCOL_VERSION minor
- # PROTOCOL_VERSION major
- # FIRMWARE_VERSION minor
- # FIRMWARE_VERSION major
- #rep = nxt.recv(USB_BUFSIZE) # Doesn't work if it exceeds buffer content length (exception)
- #rep = nxt.recv(7) # Works, since reply is 7 bytes
- rep = nxt.recv(5) # Works, read length < remaining buffer content length
- print "read", struct.unpack('%dB' % len(rep), rep)
- rep = nxt.recv(5) # Works, remaining buffer content length is non-zero
- print "read", struct.unpack('%dB' % len(rep), rep)
- rep = nxt.recv(1) # Doesn't work if no bytes are in read buffer
- # Same thing, without response.
- #cmd = struct.pack('2B', 0x81, 0x88)
- #r = nxt.send(cmd)
- #print "wrote", r
- #rep = nxt.recv(USB_BUFSIZE)
- #rep = nxt.recv(7)
- #print "read", struct.unpack('%dB' % len(rep), rep)
- nxt.close()
- del nxt
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/lightblueglue.py b/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/lightblueglue.py
deleted file mode 100644
index f2ab92f..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/lightblueglue.py
+++ /dev/null
@@ -1,53 +0,0 @@
-# bluetooth.py module -- Glue code from NXT_Python to Lightblue, allowing
-# NXT_Python to run on Mac without modification. Supports subset of
-# PyBluez/bluetooth.py used by NXT_Python.
-#
-# Copyright (C) 2007 Simon D. Levy
-#
-# 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 3 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.
-
-import lightblue
-
-RFCOMM=11
-
-def discover_devices(lookup_names=False): # parameter is ignored
- pairs = []
- d = lightblue.finddevices()
- for p in d:
- h = p[0]
- n = p[1]
- pairs.append((h, n))
- return pairs
-
-class BluetoothSocket:
-
- def __init__(self, proto = RFCOMM, _sock=None):
- if _sock is None:
- _sock = lightblue.socket(proto)
- self._sock = _sock
- self._proto = proto
-
- def connect(self, addrport):
- addr, port = addrport
- self._sock.connect( (addr, port ))
-
- def send(self, data):
- return self._sock.send( data )
-
- def recv(self, numbytes):
- return self._sock.recv( numbytes )
-
- def close(self):
- return self._sock.close()
-
-class BluetoothError(IOError):
- pass
-
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/locator.py b/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/locator.py
deleted file mode 100644
index 4adc680..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/locator.py
+++ /dev/null
@@ -1,57 +0,0 @@
-# nxt.locator module -- Locate LEGO Minstorms NXT bricks via USB or Bluetooth
-# Copyright (C) 2006, 2007 Douglas P Lau
-# Copyright (C) 2009 Marcus Wanner
-#
-# 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 3 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.
-
-class BrickNotFoundError(Exception):
- pass
-
-class NoBackendError(Exception):
- pass
-
-def find_bricks(host=None, name=None, silent=False):
- """Used by find_one_brick to look for bricks ***ADVANCED USERS ONLY***"""
-
- try:
- import usbsock
- usb_available = True
- socks = usbsock.find_bricks(host, name)
- for s in socks:
- yield s
- except ImportError:
- usb_available = False
- import sys
- if not silent: print >>sys.stderr, "USB module unavailable, not searching there"
-
- try:
- import bluesock
- try:
- socks = bluesock.find_bricks(host, name)
- for s in socks:
- yield s
- except (bluesock.bluetooth.BluetoothError, IOError): #for cases such as no adapter, bluetooth throws IOError, not BluetoothError
- pass
- except ImportError:
- import sys
- if not silent: print >>sys.stderr, "Bluetooth module unavailable, not searching there"
- if not usb_available:
- raise NoBackendError("Neither USB nor Bluetooth could be used! Did you install PyUSB or PyBluez?")
-
-
-def find_one_brick(host=None, name=None, silent=False):
- """Use to find one brick. After it returns a usbsock object or a bluesock
-object, it automatically connects to it. The host and name args limit
-the search to a given MAC or brick name. Set silent to True to stop
-nxt-python from printing anything during the search."""
- for s in find_bricks(host, name, silent):
- return s.connect()
- raise BrickNotFoundError
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/motor.py b/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/motor.py
deleted file mode 100644
index f29a5a5..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/motor.py
+++ /dev/null
@@ -1,431 +0,0 @@
-# nxt.motor module -- Class to control LEGO Mindstorms NXT motors
-# Copyright (C) 2006 Douglas P Lau
-# Copyright (C) 2009 Marcus Wanner, rhn
-# Copyright (C) 2010 rhn
-#
-# 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 3 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.
-
-"""Use for motor control"""
-
-import time
-import warnings
-
-PORT_A = 0x00
-PORT_B = 0x01
-PORT_C = 0x02
-PORT_ALL = 0xFF
-
-MODE_IDLE = 0x00
-MODE_MOTOR_ON = 0x01
-MODE_BRAKE = 0x02
-MODE_REGULATED = 0x04
-
-REGULATION_IDLE = 0x00
-REGULATION_MOTOR_SPEED = 0x01
-REGULATION_MOTOR_SYNC = 0x02
-
-RUN_STATE_IDLE = 0x00
-RUN_STATE_RAMP_UP = 0x10
-RUN_STATE_RUNNING = 0x20
-RUN_STATE_RAMP_DOWN = 0x40
-
-LIMIT_RUN_FOREVER = 0
-
-class BlockedException(Exception):
- pass
-
-class OutputState(object):
- """An object holding the internal state of a motor, not including rotation
- counters.
- """
- def __init__(self, values):
- (self.power, self.mode, self.regulation,
- self.turn_ratio, self.run_state, self.tacho_limit) = values
-
- def to_list(self):
- """Returns a list of properties that can be used with set_output_state.
- """
- return [self.power, self.mode, self.regulation,
- self.turn_ratio, self.run_state, self.tacho_limit]
-
- def __str__(self):
- modes = []
- if self.mode & MODE_MOTOR_ON:
- modes.append('on')
- if self.mode & MODE_BRAKE:
- modes.append('brake')
- if self.mode & MODE_REGULATED:
- modes.append('regulated')
- if not modes:
- modes.append('idle')
- mode = '&'.join(modes)
- regulation = 'regulation: ' + \
- ['idle', 'speed', 'sync'][self.regulation]
- run_state = 'run state: ' + {0: 'idle', 0x10: 'ramp_up',
- 0x20: 'running', 0x40: 'ramp_down'}[self.run_state]
- return ', '.join([mode, regulation, str(self.turn_ratio), run_state] + [str(self.tacho_limit)])
-
-
-class TachoInfo:
- """An object containing the information about the rotation of a motor"""
- def __init__(self, values):
- self.tacho_count, self.block_tacho_count, self.rotation_count = values
-
- def get_target(self, tacho_limit, direction):
- """Returns a TachoInfo object which corresponds to tacho state after
- moving for tacho_limit ticks. Direction can be 1 (add) or -1 (subtract)
- """
- # TODO: adjust other fields
- if abs(direction) != 1:
- raise ValueError('Invalid direction')
- new_tacho = self.tacho_count + direction * tacho_limit
- return TachoInfo([new_tacho, None, None])
-
- def is_greater(self, target, direction):
- return direction * (self.tacho_count - target.tacho_count) > 0
-
- def is_near(self, target, threshold):
- difference = abs(target.tacho_count - self.tacho_count)
- return difference < threshold
-
- def __str__(self):
- return str((self.tacho_count, self.block_tacho_count,
- self.rotation_count))
-
-
-class SynchronizedTacho(object):
- def __init__(self, leader_tacho, follower_tacho):
- self.leader_tacho = leader_tacho
- self.follower_tacho = follower_tacho
-
- def get_target(self, tacho_limit, direction):
- """This method will leave follower's target as None"""
- leader_tacho = self.leader_tacho.get_target(tacho_limit, direction)
- return SynchronizedTacho(leader_tacho, None)
-
- def is_greater(self, other, direction):
- return self.leader_tacho.is_greater(other.leader_tacho, direction)
-
- def is_near(self, other, threshold):
- return self.leader_tacho.is_near(other.leader_tacho, threshold)
-
- def __str__(self):
- if self.follower_tacho is not None:
- t2 = str(self.follower_tacho.tacho_count)
- else:
- t2 = 'None'
- t1 = str(self.leader_tacho.tacho_count)
- return 'tacho: ' + t1 + ' ' + t2
-
-
-def get_tacho_and_state(values):
- """A convenience function. values is the list of values from
- get_output_state. Returns both OutputState and TachoInfo.
- """
- return OutputState(values[1:7]), TachoInfo(values[7:])
-
-
-class BaseMotor(object):
- """Base class for motors"""
- debug = 0
- def _debug_out(self, message):
- if self.debug:
- print message
-
- def turn(self, power, tacho_units, brake=True, timeout=1, emulate=True):
- """Use this to turn a motor. The motor will not stop until it turns the
- desired distance. Accuracy is much better over a USB connection than
- with bluetooth...
- power is a value between -127 and 128 (an absolute value greater than
- 64 is recommended)
- tacho_units is the number of degrees to turn the motor. values smaller
- than 50 are not recommended and may have strange results.
- brake is whether or not to hold the motor after the function exits
- (either by reaching the distance or throwing an exception).
- timeout is the number of seconds after which a BlockedException is
- raised if the motor doesn't turn
- emulate is a boolean value. If set to False, the motor is aware of the
- tacho limit. If True, a run() function equivalent is used.
- Warning: motors remember their positions and not using emulate
- may lead to strange behavior, especially with synced motors
- """
-
- tacho_limit = tacho_units
-
- if tacho_limit < 0:
- raise ValueError, "tacho_units must be greater than 0!"
-
- if self.method == 'bluetooth':
- threshold = 70
- elif self.method == 'usb':
- threshold = 5
- else:
- threshold = 30 #compromise
-
- tacho = self.get_tacho()
- state = self._get_new_state()
-
- # Update modifiers even if they aren't used, might have been changed
- state.power = power
- if not emulate:
- state.tacho_limit = tacho_limit
-
- self._debug_out('Updating motor information...')
- self._set_state(state)
-
- direction = 1 if power > 0 else -1
- self._debug_out('tachocount: ' + str(tacho))
- current_time = time.time()
- tacho_target = tacho.get_target(tacho_limit, direction)
-
- blocked = False
- try:
- while True:
- time.sleep(self._eta(tacho, tacho_target, power) / 2)
-
- if not blocked: # if still blocked, don't reset the counter
- last_tacho = tacho
- last_time = current_time
-
- tacho = self.get_tacho()
- current_time = time.time()
- blocked = self._is_blocked(tacho, last_tacho, direction)
- if blocked:
- self._debug_out(('not advancing', last_tacho, tacho))
- # the motor can be up to 80+ degrees in either direction from target when using bluetooth
- if current_time - last_time > timeout:
- if tacho.is_near(tacho_target, threshold):
- break
- else:
- raise BlockedException("Blocked!")
- else:
- self._debug_out(('advancing', last_tacho, tacho))
- if tacho.is_near(tacho_target, threshold) or tacho.is_greater(tacho_target, direction):
- break
- finally:
- if brake:
- self.brake()
- else:
- self.idle()
-
-
-class Motor(BaseMotor):
- def __init__(self, brick, port):
- self.brick = brick
- self.port = port
- self._read_state()
- self.sync = 0
- self.turn_ratio = 0
- if str(type(self.brick.sock)) == "<class 'nxt.bluesock.BlueSock'>":
- self.method = 'bluetooth'
- elif str(type(self.brick.sock)) == "<class 'nxt.usbsock.USBSock'>":
- self.method = 'usb'
- else:
- print "Warning: Socket object does not of a known type."
- print "The name is: " + str(type(self.brick.sock))
- print "Please report this problem to the developers!"
- print "For now, turn() accuracy will not be optimal."
- print "Continuing happily..."
- self.method = None
-
- def _set_state(self, state):
- self._debug_out('Setting brick output state...')
- list_state = [self.port] + state.to_list()
- self.brick.set_output_state(*list_state)
- self._debug_out(state)
- self._state = state
- self._debug_out('State set.')
-
- def _read_state(self):
- self._debug_out('Getting brick output state...')
- values = self.brick.get_output_state(self.port)
- self._debug_out('State got.')
- self._state, tacho = get_tacho_and_state(values)
- return self._state, tacho
-
- #def get_tacho_and_state here would allow tacho manipulation
-
- def _get_state(self):
- """Returns a copy of the current motor state for manipulation."""
- return OutputState(self._state.to_list())
-
- def _get_new_state(self):
- state = self._get_state()
- if self.sync:
- state.mode = MODE_MOTOR_ON | MODE_REGULATED
- state.regulation = REGULATION_MOTOR_SYNC
- state.turn_ratio = self.turn_ratio
- else:
- state.mode = MODE_MOTOR_ON | MODE_REGULATED
- state.regulation = REGULATION_MOTOR_SPEED
- state.run_state = RUN_STATE_RUNNING
- state.tacho_limit = LIMIT_RUN_FOREVER
- return state
-
- def get_tacho(self):
- return self._read_state()[1]
-
- def reset_position(self, relative):
- """Resets the counters. Relative can be True or False"""
- self.brick.reset_motor_position(self.port, relative)
-
- def run(self, power=100, regulated=False):
- '''Tells the motor to run continuously. If regulated is True, then the
- synchronization starts working.
- '''
- state = self._get_new_state()
- state.power = power
- if not regulated:
- state.mode = MODE_MOTOR_ON
- self._set_state(state)
-
- def brake(self):
- """Holds the motor in place"""
- state = self._get_new_state()
- state.power = 0
- state.mode = MODE_MOTOR_ON | MODE_BRAKE | MODE_REGULATED
- self._set_state(state)
-
- def idle(self):
- '''Tells the motor to stop whatever it's doing. It also desyncs it'''
- state = self._get_new_state()
- state.power = 0
- state.mode = MODE_IDLE
- state.regulation = REGULATION_IDLE
- state.run_state = RUN_STATE_IDLE
- self._set_state(state)
-
- def weak_turn(self, power, tacho_units):
- """Tries to turn a motor for the specified distance. This function
- returns immediately, and it's not guaranteed that the motor turns that
- distance. This is an interface to use tacho_limit without
- REGULATION_MODE_SPEED
- """
- tacho_limit = tacho_units
- tacho = self.get_tacho()
- state = self._get_new_state()
-
- # Update modifiers even if they aren't used, might have been changed
- state.mode = MODE_MOTOR_ON
- state.regulation = REGULATION_IDLE
- state.power = power
- state.tacho_limit = tacho_limit
-
- self._debug_out('Updating motor information...')
- self._set_state(state)
-
- def _eta(self, current, target, power):
- """Returns time in seconds. Do not trust it too much"""
- tacho = abs(current.tacho_count - target.tacho_count)
- return (float(tacho) / abs(power)) / 5
-
- def _is_blocked(self, tacho, last_tacho, direction):
- """Returns if any of the engines is blocked"""
- return direction * (last_tacho.tacho_count - tacho.tacho_count) >= 0
-
-
-class SynchronizedMotors(BaseMotor):
- """The object used to make two motors run in sync. Many objects may be
- present at the same time but they can't be used at the same time.
- Warning! Movement methods reset tacho counter.
- THIS CODE IS EXPERIMENTAL!!!
- """
- def __init__(self, leader, follower, turn_ratio):
- """Turn ratio can be >= 0 only! If you want to have it reversed,
- change motor order.
- """
- if follower.brick != leader.brick:
- raise ValueError('motors belong to different bricks')
- self.leader = leader
- self.follower = follower
- self.method = self.leader.method #being from the same brick, they both have the same com method.
-
- if turn_ratio < 0:
- raise ValueError('Turn ratio <0. Change motor order instead!')
-
- if self.leader.port == self.follower.port:
- raise ValueError("The same motor passed twice")
- elif self.leader.port > self.follower.port:
- self.turn_ratio = turn_ratio
- else:
- self._debug_out('reversed')
- self.turn_ratio = -turn_ratio
-
- def _get_new_state(self):
- return self.leader._get_new_state()
-
- def _set_state(self, state):
- self.leader._set_state(state)
- self.follower._set_state(state)
-
- def get_tacho(self):
- leadertacho = self.leader.get_tacho()
- followertacho = self.follower.get_tacho()
- return SynchronizedTacho(leadertacho, followertacho)
-
- def reset_position(self, relative):
- """Resets the counters. Relative can be True or False"""
- self.leader.reset_position(relative)
- self.follower.reset_position(relative)
-
- def _enable(self): # This works as expected. I'm not sure why.
- #self._disable()
- self.reset_position(True)
- self.leader.sync = True
- self.follower.sync = True
- self.leader.turn_ratio = self.turn_ratio
- self.follower.turn_ratio = self.turn_ratio
-
- def _disable(self): # This works as expected. (tacho is reset ok)
- self.leader.sync = False
- self.follower.sync = False
- #self.reset_position(True)
- self.leader.idle()
- self.follower.idle()
- #self.reset_position(True)
-
- def run(self, power=100):
- """Warning! After calling this method, make sure to call idle. The
- motors are reported to behave wildly otherwise.
- """
- self._enable()
- self.leader.run(power, True)
- self.follower.run(power, True)
-
- def brake(self):
- self._disable() # reset the counters
- self._enable()
- self.leader.brake() # brake both motors at the same time
- self.follower.brake()
- self._disable() # now brake as usual
- self.leader.brake()
- self.follower.brake()
-
- def idle(self):
- self._disable()
-
- def turn(self, power, tacho_units, brake=True, timeout=1):
- self._enable()
- # non-emulation is a nightmare, tacho is being counted differently
- try:
- if power < 0:
- self.leader, self.follower = self.follower, self.leader
- BaseMotor.turn(self, power, tacho_units, brake, timeout, emulate=True)
- finally:
- if power < 0:
- self.leader, self.follower = self.follower, self.leader
-
- def _eta(self, tacho, target, power):
- return self.leader._eta(tacho.leader_tacho, target.leader_tacho, power)
-
- def _is_blocked(self, tacho, last_tacho, direction):
- # no need to check both, they're synced
- return self.leader._is_blocked(tacho.leader_tacho, last_tacho.leader_tacho, direction)
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/pyusbglue.py b/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/pyusbglue.py
deleted file mode 100644
index b140dfe..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/pyusbglue.py
+++ /dev/null
@@ -1,82 +0,0 @@
-# pyusbglue.py module -- Glue code from NXT_Python to libusb for USB access.
-#
-# Copyright (C) 2011 Tat-Chee Wan
-#
-# 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 3 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.
-
-import usb
-
-USB_BUFSIZE = 64
-
-ID_VENDOR_LEGO = 0x0694
-ID_PRODUCT_NXT = 0x0002
-
-class USBSocket:
- bsize = 60 # USB socket block size
-
- def __init__(self, device):
- self.device = device
- self.handle = None
- self.debug = False
-
- def device_name(self):
- return self.device.filename
-
- def connect(self):
- 'Use to connect to NXT.'
- if self.debug:
- print 'PyUSB Connecting...'
- config = self.device.configurations[0]
- iface = config.interfaces[0][0]
- self.blk_out, self.blk_in = iface.endpoints
- self.handle = self.device.open()
- self.handle.setConfiguration(1)
- self.handle.claimInterface(0)
- self.handle.reset()
- if self.debug:
- print 'Connected.'
-
- def close(self):
- 'Use to close the connection.'
- if self.debug:
- print 'Closing USB connection...'
- self.device = None
- self.handle = None
- self.blk_out = None
- self.blk_in = None
- if self.debug:
- print 'USB connection closed.'
-
- def send(self, data):
- 'Use to send raw data over USB connection ***ADVANCED USERS ONLY***'
- if self.debug:
- print 'Send:',
- print ':'.join('%02x' % ord(c) for c in data)
- self.handle.bulkWrite(self.blk_out.address, data)
-
- def recv(self, numbytes):
- 'Use to recieve raw data over USB connection ***ADVANCED USERS ONLY***'
- data = self.handle.bulkRead(self.blk_in.address, numbytes)
- if self.debug:
- print 'Recv:',
- print ':'.join('%02x' % (c & 0xFF) for c in data)
- # NOTE: bulkRead returns a tuple of ints ... make it sane
- return ''.join(chr(d & 0xFF) for d in data)
-
-def find_devices(lookup_names=False): # parameter is ignored
- devicelist = []
- for bus in usb.busses():
- for device in bus.devices:
- if device.idVendor == ID_VENDOR_LEGO and device.idProduct == ID_PRODUCT_NXT:
- devicelist.append(device)
- return devicelist
-
-
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/sensor/__init__.py b/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/sensor/__init__.py
deleted file mode 100644
index 8f2a337..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/sensor/__init__.py
+++ /dev/null
@@ -1,50 +0,0 @@
-# nxt.sensor module -- Classes to read LEGO Mindstorms NXT sensors
-# Copyright (C) 2006,2007 Douglas P Lau
-# Copyright (C) 2009 Marcus Wanner, Paulo Vieira, rhn
-# Copyright (C) 2010 Marcus Wanner
-#
-# 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 3 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.
-
-from .common import *
-from .analog import BaseAnalogSensor
-from .digital import BaseDigitalSensor, find_class
-from .generic import Touch, Light, Sound, Ultrasonic, Color20
-import mindsensors
-MSSumoEyes = mindsensors.SumoEyes
-MSCompassv2 = mindsensors.Compassv2
-MSDIST = mindsensors.DIST
-MSRTC = mindsensors.RTC
-MSACCL = mindsensors.ACCL
-MSServo = mindsensors.Servo
-MSMTRMUX = mindsensors.MTRMUX
-MSLineLeader = mindsensors.LineLeader
-MSMMX = mindsensors.MMX
-MSPS2 = mindsensors.PS2
-MSHID = mindsensors.HID
-import hitechnic
-HTCompass = hitechnic.Compass
-HTAccelerometer = hitechnic.Accelerometer
-HTGyro = hitechnic.Gyro
-HTColorv2 = hitechnic.Colorv2
-HTEOPD = hitechnic.EOPD
-HTIRReceiver = hitechnic.IRReceiver
-HTIRSeekerv2 = hitechnic.IRSeekerv2
-HTPrototype = hitechnic.Prototype
-
-
-def get_sensor(brick, port):
- """Tries to detect the sensor type and return the correct sensor
-object. Does not work for sensors with no identification information (such as
-all analog sensors or the MindSensors RTC.
- """
- base_sensor = BaseDigitalSensor(brick, port, False)
- info = base_sensor.get_sensor_info()
- return find_class(info)(brick, port, check_compatible=False)
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/sensor/analog.py b/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/sensor/analog.py
deleted file mode 100644
index e8d9b7b..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/sensor/analog.py
+++ /dev/null
@@ -1,41 +0,0 @@
-# nxt.sensor.analog module -- submodule for use with analog sensors
-# Copyright (C) 2006,2007 Douglas P Lau
-# Copyright (C) 2009 Marcus Wanner, Paulo Vieira, rhn
-#
-# 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 3 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.
-
-from common import *
-
-
-class RawReading: # can be converted to the old version
- """A pseudo-structure holding the raw sensor values as returned by the NXT
- brick.
- """
- def __init__(self, values):
- (self.port, self.valid, self.calibrated, self.sensor_type, self.mode,
- self.raw_ad_value, self.normalized_ad_value, self.scaled_value,
- self.calibrated_value) = values
-
- def __repr__(self):
- return str((self.port, self.valid, self.calibrated, self.sensor_type, self.mode,
- self.raw_ad_value, self.normalized_ad_value, self.scaled_value,
- self.calibrated_value))
-
-
-class BaseAnalogSensor(Sensor):
- """Object for analog sensors."""
- def get_input_values(self):
- """Returns the raw sensor values as returned by the NXT brick."""
- return RawReading(self.brick.get_input_values(self.port))
-
- def reset_input_scaled_value(self):
- self.brick.reset_input_scaled_value()
-
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/sensor/common.py b/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/sensor/common.py
deleted file mode 100644
index 5afd6c8..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/sensor/common.py
+++ /dev/null
@@ -1,67 +0,0 @@
-# nxt.sensor.common module -- submodule with stuff useful in all sensors
-# Copyright (C) 2006,2007 Douglas P Lau
-# Copyright (C) 2009 Marcus Wanner, Paulo Vieira, rhn
-#
-# 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 3 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.
-
-PORT_1 = 0x00
-PORT_2 = 0x01
-PORT_3 = 0x02
-PORT_4 = 0x03
-
-class Type(object):
- 'Namespace for enumeration of the type of sensor'
- # NOTE: just a namespace (enumeration)
- NO_SENSOR = 0x00
- SWITCH = 0x01 # Touch sensor
- TEMPERATURE = 0x02
- REFLECTION = 0x03
- ANGLE = 0x04
- LIGHT_ACTIVE = 0x05 # Light sensor (illuminated)
- LIGHT_INACTIVE = 0x06 # Light sensor (ambient)
- SOUND_DB = 0x07 # Sound sensor (unadjusted)
- SOUND_DBA = 0x08 # Sound sensor (adjusted)
- CUSTOM = 0x09
- LOW_SPEED = 0x0A
- LOW_SPEED_9V = 0x0B # Low-speed I2C (Ultrasonic sensor)
- HIGH_SPEED = 0x0C #Possibly other mode for I2C; may be used by future sensors.
- COLORFULL = 0x0D #NXT 2.0 color sensor in full color mode (color sensor mode)
- COLORRED = 0x0E #NXT 2.0 color sensor with red light on (light sensor mode)
- COLORGREEN = 0x0F #NXT 2.0 color sensor with green light on (light sensor mode)
- COLORBLUE = 0x10 #NXT 2.0 color sensor in with blue light on (light sensor mode)
- COLORNONE = 0x11 #NXT 2.0 color sensor in with light off (light sensor mode)
- COLOREXIT = 0x12 #NXT 2.0 color sensor internal state (not sure what this is for yet)
-
-
-class Mode(object):
- 'Namespace for enumeration of the mode of sensor'
- # NOTE: just a namespace (enumeration)
- RAW = 0x00
- BOOLEAN = 0x20
- TRANSITION_CNT = 0x40
- PERIOD_COUNTER = 0x60
- PCT_FULL_SCALE = 0x80
- CELSIUS = 0xA0
- FAHRENHEIT = 0xC0
- ANGLE_STEPS = 0xE0
- MASK = 0xE0
- MASK_SLOPE = 0x1F # Why isn't this slope thing documented?
-
-
-class Sensor(object):
- 'Main sensor object'
-
- def __init__(self, brick, port):
- self.brick = brick
- self.port = port
-
- def set_input_mode(self, type_, mode):
- self.brick.set_input_mode(self.port, type_, mode)
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/sensor/digital.py b/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/sensor/digital.py
deleted file mode 100644
index dbc730f..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/sensor/digital.py
+++ /dev/null
@@ -1,227 +0,0 @@
-# nxt.sensor module -- Classes to read LEGO Mindstorms NXT sensors
-# Copyright (C) 2006,2007 Douglas P Lau
-# Copyright (C) 2009 Marcus Wanner, Paulo Vieira, rhn
-# Copyright (C) 2010,2011 Marcus Wanner
-#
-# 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 3 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.
-
-from nxt.error import I2CError, I2CPendingError, DirProtError
-
-from common import *
-from time import sleep, time
-import struct
-
-
-class SensorInfo:
- def __init__(self, version, product_id, sensor_type):
- self.version = version
- self.product_id = product_id
- self.sensor_type = sensor_type
-
- def clarifybinary(self, instr, label):
- outstr = ''
- outstr += (label + ': `' + instr + '`\n')
- for char in instr:
- outstr += (hex(ord(char))+', ')
- outstr += ('\n')
- return outstr
-
- def __str__(self):
- outstr = ''
- outstr += (self.clarifybinary(str(self.version), 'Version'))
- outstr += (self.clarifybinary(str(self.product_id), 'Product ID'))
- outstr += (self.clarifybinary(str(self.sensor_type), 'Type'))
- return outstr
-
-class BaseDigitalSensor(Sensor):
- """Object for digital sensors. I2C_ADDRESS is the dictionary storing name
- to i2c address mappings. It should be updated in every subclass. When
- subclassing this class, make sure to call add_compatible_sensor to add
- compatible sensor data.
- """
- I2C_DEV = 0x02
- I2C_ADDRESS = {'version': (0x00, '8s'),
- 'product_id': (0x08, '8s'),
- 'sensor_type': (0x10, '8s'),
-# 'factory_zero': (0x11, 1), # is this really correct?
- 'factory_scale_factor': (0x12, 'B'),
- 'factory_scale_divisor': (0x13, 'B'),
- }
-
- def __init__(self, brick, port, check_compatible=True):
- """Creates a BaseDigitalSensor. If check_compatible is True, queries
- the sensor for its name, and if a wrong sensor class was used, prints
- a warning.
- """
- super(BaseDigitalSensor, self).__init__(brick, port)
- self.set_input_mode(Type.LOW_SPEED_9V, Mode.RAW)
- self.last_poll = time()
- self.poll_delay = 0.01
- sleep(0.1) # Give I2C time to initialize
- #Don't do type checking if this class has no compatible sensors listed.
- try: self.compatible_sensors
- except AttributeError: check_compatible = False
- if check_compatible:
- sensor = self.get_sensor_info()
- if not sensor in self.compatible_sensors:
- print ('WARNING: Wrong sensor class chosen for sensor ' +
- str(sensor.product_id) + ' on port ' + str(port) + '. ' + """
-You may be using the wrong type of sensor or may have connected the cable
-incorrectly. If you are sure you're using the correct sensor class for the
-sensor, this message is likely in error and you should disregard it and file a
-bug report, including the output of get_sensor_info(). This message can be
-suppressed by passing "check_compatible=False" when creating the sensor object.""")
-
- def _ls_get_status(self, n_bytes):
- for n in range(10):
- try:
- b = self.brick.ls_get_status(self.port)
- if b >= n_bytes:
- return b
- except I2CPendingError:
- pass
- raise I2CError, 'ls_get_status timeout'
-
- def _i2c_command(self, address, value, format):
- """Writes an i2c value to the given address. value must be a string. value is
- a tuple of values corresponding to the given format.
- """
- value = struct.pack(format, *value)
- msg = chr(self.I2C_DEV) + chr(address) + value
- if self.last_poll+self.poll_delay > time():
- diff = time() - self.last_poll
- sleep(self.poll_delay - diff)
- self.last_poll = time()
- self.brick.ls_write(self.port, msg, 0)
-
- def _i2c_query(self, address, format):
- """Reads an i2c value from given address, and returns a value unpacked
- according to the given format. Format is the same as in the struct
- module. See http://docs.python.org/library/struct.html#format-strings
- """
- n_bytes = struct.calcsize(format)
- msg = chr(self.I2C_DEV) + chr(address)
- if self.last_poll+self.poll_delay > time():
- diff = time() - self.last_poll
- sleep(self.poll_delay - diff)
- self.last_poll = time()
- self.brick.ls_write(self.port, msg, n_bytes)
- try:
- self._ls_get_status(n_bytes)
- finally:
- #we should clear the buffer no matter what happens
- data = self.brick.ls_read(self.port)
- if len(data) < n_bytes:
- raise I2CError, 'Read failure: Not enough bytes'
- data = struct.unpack(format, data[-n_bytes:])
- return data
-
- def read_value(self, name):
- """Reads a value from the sensor. Name must be a string found in
- self.I2C_ADDRESS dictionary. Entries in self.I2C_ADDRESS are in the
- name: (address, format) form, with format as in the struct module.
- Be careful on unpacking single variables - struct module puts them in
- tuples containing only one element.
- """
- address, fmt = self.I2C_ADDRESS[name]
- for n in range(3):
- try:
- return self._i2c_query(address, fmt)
- except DirProtError:
- pass
- raise I2CError, "read_value timeout"
-
- def write_value(self, name, value):
- """Writes value to the sensor. Name must be a string found in
- self.I2C_ADDRESS dictionary. Entries in self.I2C_ADDRESS are in the
- name: (address, format) form, with format as in the struct module.
- value is a tuple of values corresponding to the format from
- self.I2C_ADDRESS dictionary.
- """
- address, fmt = self.I2C_ADDRESS[name]
- self._i2c_command(address, value, fmt)
-
- def get_sensor_info(self):
- version = self.read_value('version')[0].split('\0')[0]
- product_id = self.read_value('product_id')[0].split('\0')[0]
- sensor_type = self.read_value('sensor_type')[0].split('\0')[0]
- return SensorInfo(version, product_id, sensor_type)
-
- @classmethod
- def add_compatible_sensor(cls, version, product_id, sensor_type):
- """Adds an entry in the compatibility table for the sensor. If version
- is None, then it's the default class for this model. If product_id is
- None, then this is the default class for this vendor.
- """
- try:
- cls.compatible_sensors
- except AttributeError:
- cls.compatible_sensors = []
- finally:
- cls.compatible_sensors.append(SCompatibility(version, product_id,
- sensor_type))
- add_mapping(cls, version, product_id, sensor_type)
-
-
-class SCompatibility(SensorInfo):
- """An object that helps manage the sensor mappings"""
- def __eq__(self, other):
- if self.product_id is None:
- return self.product_id == other.product_id
- elif self.version is None:
- return (self.product_id == other.product_id and
- self.sensor_type == other.sensor_type)
- else:
- return (self.version == other.version and
- self.product_id == other.product_id and
- self.sensor_type == other.sensor_type)
-
-sensor_mappings = {}
-
-
-def add_mapping(cls, version, product_id, sensor_type):
- "None means any other value"
- if product_id not in sensor_mappings:
- sensor_mappings[product_id] = {}
- models = sensor_mappings[product_id]
-
- if sensor_type is None:
- if sensor_type in models:
- raise ValueError('Already registered!')
- models[sensor_type] = cls
- return
-
- if sensor_type not in models:
- models[sensor_type] = {}
- versions = models[sensor_type]
-
- if version in versions:
- raise ValueError('Already registered!')
- else:
- versions[version] = cls
-
-
-class SearchError(Exception):
- pass
-
-
-def find_class(info):
- """Returns an appropriate class for the given SensorInfo"""
- dic = sensor_mappings
- for val, msg in zip((info.product_id, info.sensor_type, info.version),
- ('Vendor', 'Model', 'Version')):
- if val in dic:
- dic = dic[val]
- elif None in dic:
- dic = dic[None]
- else:
- raise SearchError(msg + ' not found')
- return dic[info.sensor_type][None]
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/sensor/generic.py b/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/sensor/generic.py
deleted file mode 100644
index b3d792f..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/sensor/generic.py
+++ /dev/null
@@ -1,154 +0,0 @@
-# nxt.sensor.generic module -- Classes to read LEGO Mindstorms NXT sensors
-# Copyright (C) 2006,2007 Douglas P Lau
-# Copyright (C) 2009 Marcus Wanner, Paulo Vieira, rhn
-# Copyright (C) 2010 melducky, Marcus Wanner
-#
-# 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 3 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.
-
-from .common import *
-from .digital import BaseDigitalSensor
-from .analog import BaseAnalogSensor
-
-
-class Touch(BaseAnalogSensor):
- """The LEGO touch sensor"""
-
- def __init__(self, brick, port):
- super(Touch, self).__init__(brick, port)
- self.set_input_mode(Type.SWITCH, Mode.BOOLEAN)
-
- def is_pressed(self):
- return bool(self.get_input_values().scaled_value)
-
- get_sample = is_pressed
-
-
-class Light(BaseAnalogSensor):
- """Object for light sensors. It automatically turns off light when it's not
- used.
- """
- def __init__(self, brick, port, illuminated=True):
- super(Light, self).__init__(brick, port)
-
- def set_illuminated(self, active):
- if active:
- type_ = Type.LIGHT_ACTIVE
- else:
- type_ = Type.LIGHT_INACTIVE
- self.set_input_mode(type_, Mode.RAW)
-
- def get_lightness(self):
- return self.get_input_values().scaled_value
-
- get_sample = get_lightness
-
-
-class Sound(BaseAnalogSensor):
- 'Object for sound sensors'
-
- def __init__(self, brick, port, adjusted=True):
- super(Sound, self).__init__(brick, port)
- self.set_adjusted(adjusted)
-
- def set_adjusted(self, active):
- if active:
- type_ = Type.SOUND_DBA
- else:
- type_ = Type.SOUND_DB
- self.set_input_mode(type_, Mode.RAW)
-
- def get_loudness(self):
- return self.get_input_values().scaled_value
-
- get_sample = get_loudness
-
-
-class Ultrasonic(BaseDigitalSensor):
- """Object for ultrasonic sensors"""
- I2C_ADDRESS = BaseDigitalSensor.I2C_ADDRESS.copy()
- I2C_ADDRESS.update({'measurement_units': (0x14, '7s'),
- 'continuous_measurement_interval': (0x40, 'B'),
- 'command': (0x41, 'B'),
- 'measurement_byte_0': (0x42, 'B'),
- 'measurements': (0x42, '8B'),
- 'actual_scale_factor': (0x51, 'B'),
- 'actual_scale_divisor': (0x52, 'B'),
- })
-
- class Commands:
- 'These are for passing to command()'
- OFF = 0x00
- SINGLE_SHOT = 0x01
- CONTINUOUS_MEASUREMENT = 0x02
- EVENT_CAPTURE = 0x03 #Optimize results when other Ultrasonic sensors running
- REQUEST_WARM_RESET = 0x04
-
- def __init__(self, brick, port, check_compatible=True):
- super(Ultrasonic, self).__init__(brick, port, check_compatible)
- self.set_input_mode(Type.LOW_SPEED_9V, Mode.RAW)
-
- def get_distance(self):
- 'Function to get data from the ultrasonic sensor'
- return self.read_value('measurement_byte_0')[0]
-
- get_sample = get_distance
-
- def get_measurement_units(self):
- return self.read_value('measurement_units')[0].split('\0')[0]
-
- def get_all_measurements(self):
- "Returns all the past readings in measurement_byte_0 through 7"
- return self.read_value('measurements')
-
- def get_measurement_no(self, number):
- "Returns measurement_byte_number"
- if not 0 <= number < 8:
- raise ValueError('Measurements are numbered 0 to 7, not ' + str(number))
- base_address, format = self.I2C_ADDRESS['measurement_byte_0']
- return self._i2c_query(base_address + number, format)[0]
-
- def command(self, command):
- self.write_value('command', (command, ))
-
- def get_interval(self):
- 'Get the sample interval for continuous measurement mode -- Unknown units'
- return self.read_value('continuous_measurement_interval')
-
- def set_interval(self, interval):
- """Set the sample interval for continuous measurement mode.
-Unknown units; default is 1"""
- self.write_value('continuous_measurement_interval', interval)
-
-Ultrasonic.add_compatible_sensor(None, 'LEGO', 'Sonar') #Tested with version 'V1.0'
-
-
-class Color20(BaseAnalogSensor):
- def __init__(self, brick, port):
- super(Color20, self).__init__(brick, port)
- self.set_light_color(Type.COLORFULL)
-
- def set_light_color(self, color):
- """color should be one of the COLOR* Type namespace values, e.g. Type.COLORBLUE"""
- self.set_input_mode(color, Mode.RAW)
-
- def get_light_color(self):
- """Returns one of the COLOR* Type namespace values, e.g. Type.COLORRED"""
- return self.get_input_values().sensor_type
-
- def get_reflected_light(self, color):
- self.set_light_color(color)
- return self.get_input_values().scaled_value
-
- def get_color(self):
- self.get_reflected_light(Type.COLORFULL)
- return self.get_input_values().scaled_value
-
- get_sample = get_color
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/sensor/hitechnic.py b/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/sensor/hitechnic.py
deleted file mode 100644
index 3c152d3..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/sensor/hitechnic.py
+++ /dev/null
@@ -1,611 +0,0 @@
-# nxt.sensor.hitechnic module -- Classes to read HiTechnic sensors
-# Copyright (C) 2006,2007 Douglas P Lau
-# Copyright (C) 2009 Marcus Wanner, Paulo Vieira, rhn
-# Copyright (C) 2010 rhn, Marcus Wanner, melducky, Samuel Leeman-Munk
-# Copyright (C) 2011 jerradgenson, Marcus Wanner
-#
-# 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 3 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.
-
-from .common import *
-from .digital import BaseDigitalSensor
-from .analog import BaseAnalogSensor
-
-
-class Compass(BaseDigitalSensor):
- """Hitechnic compass sensor."""
- I2C_ADDRESS = BaseDigitalSensor.I2C_ADDRESS.copy()
- I2C_ADDRESS.update({'mode': (0x41, 'B'),
- 'heading': (0x42, 'B'),
- 'adder' : (0x43, 'B'),
- })
-
- class Modes:
- MEASUREMENT = 0x00
- CALIBRATION = 0x43
- CALIBRATION_FAILED = 0x02
-
- def get_heading(self):
- """Returns heading from North in degrees."""
-
- two_degree_heading = self.read_value('heading')[0]
- adder = self.read_value('adder')[0]
- heading = two_degree_heading * 2 + adder
-
- return heading
-
- get_sample = get_heading
-
- def get_relative_heading(self,target=0):
- rheading = self.get_sample()-target
- if rheading > 180:
- rheading -= 360
- elif rheading < -180:
- rheading += 360
- return rheading
-
- def is_in_range(self,minval,maxval):
- """This deserves a little explanation:
-if max > min, it's straightforward, but
-if min > max, it switches the values of max and min
-and returns true if heading is NOT between the new max and min
- """
- if minval > maxval:
- (maxval,minval) = (minval,maxval)
- inverted = True
- else:
- inverted = False
- heading = self.get_sample()
- in_range = (heading > minval) and (heading < maxval)
- #an xor handles the reversal
- #a faster, more compact way of saying
- #if !reversed return in_range
- #if reversed return !in_range
- return bool(inverted) ^ bool(in_range)
-
- def get_mode(self):
- return self.read_value('mode')[0]
-
- def set_mode(self, mode):
- if mode != self.Modes.MEASUREMENT and \
- mode != self.Modes.CALIBRATION:
- raise ValueError('Invalid mode specified: ' + str(mode))
- self.write_value('mode', (mode, ))
-
-Compass.add_compatible_sensor(None, 'HiTechnc', 'Compass ') #Tested with version '\xfdV1.23 '
-Compass.add_compatible_sensor(None, 'HITECHNC', 'Compass ') #Tested with version '\xfdV2.1 '
-
-
-class Accelerometer(BaseDigitalSensor):
- 'Object for Accelerometer sensors. Thanks to Paulo Vieira.'
- I2C_ADDRESS = BaseDigitalSensor.I2C_ADDRESS.copy()
- I2C_ADDRESS.update({'x_axis_high': (0x42, 'b'),
- 'y_axis_high': (0x43, 'b'),
- 'z_axis_high': (0x44, 'b'),
- 'xyz_short': (0x42, '3b'),
- 'all_data': (0x42, '3b3B')
- })
-
- class Acceleration:
- def __init__(self, x, y, z):
- self.x, self.y, self.z = x, y, z
-
- def __init__(self, brick, port, check_compatible=True):
- super(Accelerometer, self).__init__(brick, port, check_compatible)
-
- def get_acceleration(self):
- """Returns the acceleration along x, y, z axes. Units are unknown to me.
- """
- xh, yh, zh, xl, yl, zl = self.read_value('all_data')
- x = xh << 2 + xl
- y = yh << 2 + yl
- z = zh << 2 + yl
- return self.Acceleration(x, y, z)
-
- get_sample = get_acceleration
-
-Accelerometer.add_compatible_sensor(None, 'HiTechnc', 'Accel. ')
-Accelerometer.add_compatible_sensor(None, 'HITECHNC', 'Accel. ') #Tested with version '\xfdV1.1 '
-
-
-class IRReceiver(BaseDigitalSensor):
- """Object for HiTechnic IRReceiver sensors for use with LEGO Power Functions IR
-Remotes. Coded to HiTechnic's specs for the sensor but not tested. Please report
-whether this worked for you or not!
- """
- I2C_ADDRESS = BaseDigitalSensor.I2C_ADDRESS.copy()
- I2C_ADDRESS.update({
- 'm1A': (0x42, 'b'),
- 'm1B': (0x43, 'b'),
- 'm2A': (0x44, 'b'),
- 'm2B': (0x45, 'b'),
- 'm3A': (0x46, 'b'),
- 'm3B': (0x47, 'b'),
- 'm4A': (0x48, 'b'),
- 'm4B': (0x49, 'b'),
- 'all_data': (0x42, '8b')
- })
-
- class SpeedReading:
- def __init__(self, m1A, m1B, m2A, m2B, m3A, m3B, m4A, m4B):
- self.m1A, self.m1B, self.m2A, self.m2B, self.m3A, self.m3B, self.m4A, self.m4B = m1A, m1B, m2A, m2B, m3A, m3B, m4A, m4B
- self.channel_1 = (m1A, m1B)
- self.channel_2 = (m2A, m2B)
- self.channel_3 = (m3A, m3B)
- self.channel_4 = (m4A, m4B)
-
- def __init__(self, brick, port, check_compatible=True):
- super(IRReceiver, self).__init__(brick, port, check_compatible)
-
- def get_speeds(self):
- """Returns the motor speeds for motors A and B on channels 1-4.
-Values are -128, -100, -86, -72, -58, -44, -30, -16, 0, 16, 30, 44, 58, 72, 86
-and 100. -128 specifies motor brake mode. Note that no motors are actually
-being controlled here!
- """
- m1A, m1B, m2A, m2B, m3A, m3B, m4A, m4B = self.read_value('all_data')
- return self.SpeedReading(m1A, m1B, m2A, m2B, m3A, m3B, m4A, m4B)
-
- get_sample = get_speeds
-
-IRReceiver.add_compatible_sensor(None, 'HiTechnc', 'IRRecv ')
-IRReceiver.add_compatible_sensor(None, 'HITECHNC', 'IRRecv ')
-
-
-class IRSeekerv2(BaseDigitalSensor):
- """Object for HiTechnic IRSeeker sensors. Coded to HiTechnic's specs for the sensor
-but not tested. Please report whether this worked for you or not!
- """
- I2C_ADDRESS = BaseDigitalSensor.I2C_ADDRESS.copy()
- I2C_ADDRESS.update({
- 'dspmode': (0x41, 'B'),
- 'DC_direction': (0x42, 'B'),
- 'DC_sensor_1': (0x43, 'B'),
- 'DC_sensor_2': (0x44, 'B'),
- 'DC_sensor_3': (0x45, 'B'),
- 'DC_sensor_4': (0x46, 'B'),
- 'DC_sensor_5': (0x47, 'B'),
- 'DC_sensor_mean': (0x48, 'B'),
- 'all_DC': (0x42, '7B'),
- 'AC_direction': (0x49, 'B'),
- 'AC_sensor_1': (0x4A, 'B'),
- 'AC_sensor_2': (0x4B, 'B'),
- 'AC_sensor_3': (0x4C, 'B'),
- 'AC_sensor_4': (0x4D, 'B'),
- 'AC_sensor_5': (0x4E, 'B'),
- 'all_AC': (0x49, '6B')
- })
- I2C_DEV = 0x10 #different from standard 0x02
-
- class DSPModes:
- #Modes for modulated (AC) data.
- AC_DSP_1200Hz = 0x00
- AC_DSP_600Hz = 0x01
-
- class _data:
- def get_dir_brightness(self, direction):
- "Gets the brightness of a given direction (1-9)."
- if direction%2 == 1: #if it's an odd number
- exec("val = self.sensor_%d" % ((direction-1)/2+1))
- else:
- exec("val = (self.sensor_%d+self.sensor_%d)/2" % (direction/2, (direction/2)+1))
- return val
-
- class DCData(_data):
- def __init__(self, direction, sensor_1, sensor_2, sensor_3, sensor_4, sensor_5, sensor_mean):
- self.direction, self.sensor_1, self.sensor_2, self.sensor_3, self.sensor_4, self.sensor_5, self.sensor_mean = direction, sensor_1, sensor_2, sensor_3, sensor_4, sensor_5, sensor_mean
-
- class ACData(_data):
- def __init__(self, direction, sensor_1, sensor_2, sensor_3, sensor_4, sensor_5):
- self.direction, self.sensor_1, self.sensor_2, self.sensor_3, self.sensor_4, self.sensor_5 = direction, sensor_1, sensor_2, sensor_3, sensor_4, sensor_5
-
-
- def __init__(self, brick, port, check_compatible=True):
- super(IRSeekerv2, self).__init__(brick, port, check_compatible)
-
- def get_dc_values(self):
- """Returns the unmodulated (DC) values.
- """
- direction, sensor_1, sensor_2, sensor_3, sensor_4, sensor_5, sensor_mean = self.read_value('all_DC')
- return self.DCData(direction, sensor_1, sensor_2, sensor_3, sensor_4, sensor_5, sensor_mean)
-
- def get_ac_values(self):
- """Returns the modulated (AC) values. 600Hz and 1200Hz modes can be selected
-between by using the set_dsp_mode() function.
- """
- direction, sensor_1, sensor_2, sensor_3, sensor_4, sensor_5 = self.read_value('all_AC')
- return self.ACData(direction, sensor_1, sensor_2, sensor_3, sensor_4, sensor_5)
-
- def get_dsp_mode(self):
- return self.read_value('dspmode')[0]
-
- def set_dsp_mode(self, mode):
- self.write_value('dspmode', (mode, ))
-
- get_sample = get_ac_values
-
-IRSeekerv2.add_compatible_sensor(None, 'HiTechnc', 'NewIRDir')
-IRSeekerv2.add_compatible_sensor(None, 'HITECHNC', 'NewIRDir')
-
-
-class EOPD(BaseAnalogSensor):
- """Object for HiTechnic Electro-Optical Proximity Detection sensors.
- """
-
- # To be divided by processed value.
- _SCALE_CONSTANT = 250
-
- # Maximum distance the sensor can detect.
- _MAX_DISTANCE = 1023
-
- def __init__(self, brick, port):
- super(EOPD, self).__init__(brick, port)
- from math import sqrt
- self.sqrt = sqrt
-
- def set_range_long(self):
- ''' Choose this mode to increase the sensitivity
- of the EOPD sensor by approximately 4x. May
- cause sensor overload.
- '''
-
- self.set_input_mode(Type.LIGHT_ACTIVE, Mode.RAW)
-
- def set_range_short(self):
- ''' Choose this mode to prevent the EOPD sensor from
- being overloaded by white objects.
- '''
-
- self.set_input_mode(Type.LIGHT_INACTIVE, Mode.RAW)
-
- def get_raw_value(self):
- '''Unscaled value read from sensor.'''
-
- return self._MAX_DISTANCE - self.get_input_values().raw_ad_value
-
- def get_processed_value(self):
- '''Derived from the square root of the raw value.'''
-
- return self.sqrt(self.get_raw_value())
-
- def get_scaled_value(self):
- ''' Returns a value that will scale linearly as distance
- from target changes. This is the method that should
- generally be called to get EOPD sensor data.
- '''
-
- try:
- result = self._SCALE_CONSTANT / self.get_processed_value()
- return result
-
- except ZeroDivisionError:
- return self._SCALE_CONSTANT
-
- get_sample = get_scaled_value
-
-
-class Colorv2(BaseDigitalSensor):
- """Object for HiTechnic Color v2 Sensors. Coded to HiTechnic's specs for the sensor
-but not tested. Please report whether this worked for you or not!"""
- I2C_ADDRESS = BaseDigitalSensor.I2C_ADDRESS.copy()
- I2C_ADDRESS.update({
- 'mode': (0x41, 'B'),
- 'number': (0x42, 'B'),
- 'red': (0x43, 'B'),
- 'green': (0x44, 'B'),
- 'blue': (0x45, 'B'),
- 'white': (0x46, 'B'),
- 'index': (0x47, 'B'),
- 'normred': (0x48, 'B'),
- 'normgreen': (0x49, 'B'),
- 'normblue': (0x4A, 'B'),
- 'all_data': (0x42, '9B'),
- 'rawred': (0x42, '<H'),
- 'rawgreen': (0x44, '<H'),
- 'rawblue': (0x46, '<H'),
- 'rawwhite': (0x48, '<H'),
- 'all_raw_data': (0x42, '<4H')
- })
-
- class Modes:
- ACTIVE = 0x00 #get measurements using get_active_color
- PASSIVE = 0x01 #get measurements using get_passive_color
- RAW = 0x03 #get measurements using get_passive_color
- BLACK_CALIBRATION = 0x42 #hold away from objects, results saved in EEPROM
- WHITE_CALIBRATION = 0x43 #hold in front of white surface, results saved in EEPROM
- LED_POWER_LOW = 0x4C #saved in EEPROM, must calibrate after using
- LED_POWER_HIGH = 0x48 #saved in EEPROM, must calibrate after using
- RANGE_NEAR = 0x4E #saved in EEPROM, only affects active mode
- RANGE_FAR = 0x46 #saved in EEPROM, only affects active mode, more susceptable to noise
- FREQ_50 = 0x35 #saved in EEPROM, use when local wall power is 50Hz
- FREQ_60 = 0x36 #saved in EEPROM, use when local wall power is 60Hz
-
- class ActiveData:
- def __init__(self, number, red, green, blue, white, index, normred, normgreen, normblue):
- self.number, self.red, self.green, self.blue, self.white, self.index, self.normred, self.normgreen, self.normblue = number, red, green, blue, white, index, normred, normgreen, normblue
-
- class PassiveData:
- #also holds raw mode data
- def __init__(self, red, green, blue, white):
- self.red, self.green, self.blue, self.white = red, green, blue, white
-
- def __init__(self, brick, port, check_compatible=True):
- super(Colorv2, self).__init__(brick, port, check_compatible)
-
- def get_active_color(self):
- """Returns color values when in active mode.
- """
- number, red, green, blue, white, index, normred, normgreen, normblue = self.read_value('all_data')
- return self.ActiveData(number, red, green, blue, white, index, normred, normgreen, normblue)
-
- get_sample = get_active_color
-
- def get_passive_color(self):
- """Returns color values when in passive or raw mode.
- """
- red, green, blue, white = self.read_value('all_raw_data')
- return self.PassiveData(red, green, blue, white)
-
- def get_mode(self):
- return self.read_value('mode')[0]
-
- def set_mode(self, mode):
- self.write_value('mode', (mode, ))
-
-Colorv2.add_compatible_sensor(None, 'HiTechnc', 'ColorPD')
-Colorv2.add_compatible_sensor(None, 'HITECHNC', 'ColorPD')
-Colorv2.add_compatible_sensor(None, 'HiTechnc', 'ColorPD ')
-Colorv2.add_compatible_sensor(None, 'HITECHNC', 'ColorPD ')
-
-
-class Gyro(BaseAnalogSensor):
- 'Object for gyro sensors'
-#This class is for the hitechnic gryo sensor. When the gryo is not
-#moving there will be a constant offset that will change with
-#temperature and other ambient factors. The calibrate() function
-#takes the currect value and uses it to offset subsequesnt ones.
-
- def __init__(self, brick, port):
- super(Gyro, self).__init__(brick, port)
- self.set_input_mode(Type.ANGLE, Mode.RAW)
- self.offset = 0
-
- def get_rotation_speed(self):
- return self.get_input_values().scaled_value - self.offset
-
- def set_zero(self, value):
- self.offset = value
-
- def calibrate(self):
- self.set_zero(self.get_rotation_speed())
-
- get_sample = get_rotation_speed
-
-
-class Prototype(BaseDigitalSensor):
- """Object for HiTechnic sensor prototype boards. Coded to HiTechnic's specs but not
-tested. Please report whether this worked for you or not!
- """
- I2C_ADDRESS = BaseDigitalSensor.I2C_ADDRESS.copy()
- I2C_ADDRESS.update({
- 'A0': (0x42, '<H'),
- 'A0': (0x44, '<H'),
- 'A0': (0x46, '<H'),
- 'A0': (0x48, '<H'),
- 'A0': (0x4A, '<H'),
- 'all_analog': (0x42, '<5H'),
- 'digital_in': (0x4C, 'B'),
- 'digital_out': (0x4D, 'B'),
- 'digital_cont': (0x4E, 'B'),
- 'sample_time': (0x4F, 'B'),
- })
-
- class Digital_Data():
- """Container for 6 bits of digital data. Takes an integer or a list of six bools
-and can be converted into a list of bools or an integer."""
- def __init__(self, pins):
- if isinstance(pins, int):
- self.dataint = pins
- self.datalst = self.tolist(pins)
- else:
- self.dataint = self.toint(pins)
- self.datalst = pins
- self.d0, self.d1, self.d2, self.d3, self.d4, self.d5 = self.datalst
-
- def tolist(self, val):
- lst = []
- for i in range(6):
- lst.append(bool(val & 2**i))
- return lst
-
- def toint(self, lst):
- val = 0
- for i in range(6):
- val += int(bool(lst[i])) * (2**i)
- return val
-
- def __int__(self):
- return self.dataint
-
- def __iter__(self):
- return iter(self.datalst)
-
- def __getitem__(self, i):
- return self.datalst[i]
-
- class Analog_Data():
- def __init__(self, a0, a1, a2, a3, a4):
- self.a0, self.a1, self.a2, self.a3, self.a4 = a0, a1, a2, a3, a4
-
- def get_analog(self):
- return Analog_Data(self.read_value('all_analog'))
-
- def get_digital(self):
- return Digital_Data(self.read_value('digital_in')[0])
-
- def set_digital(self, pins):
- """Can take a Digital_Data() object"""
- self.write_value('digital_out', (int(pins), ))
-
- def set_digital_modes(self, modes):
- """Sets input/output mode of digital pins. Can take a Digital_Data() object."""
- self.write_value('digital_cont', (int(modes), ))
-
-Prototype.add_compatible_sensor(None, 'HiTechnc', 'Proto ')
-
-
-class ServoCon(BaseDigitalSensor):
- """Object for HiTechnic FIRST Servo Controllers. Coded to HiTechnic's specs for
-the sensor but not tested. Please report whether this worked for you or not!"""
- I2C_ADDRESS = BaseDigitalSensor.I2C_ADDRESS.copy()
- I2C_ADDRESS.update({
- 'status': (0x40, 'B'),
- 'steptime': (0x41, 'B'),
- 's1pos': (0x42, 'B'),
- 's2pos': (0x43, 'B'),
- 's3pos': (0x44, 'B'),
- 'p4pos': (0x45, 'B'),
- 'p5pos': (0x46, 'B'),
- 'p6pos': (0x47, 'B'),
- 'pwm': (0x46, 'B'),
- })
-
- class Status:
- RUNNING = 0x00 #all motors stopped
- STOPPED = 0x01 #motor(s) moving
-
- def __init__(self, brick, port, check_compatible=True):
- super(ServoCon, self).__init__(brick, port, check_compatible)
-
- def get_status(self):
- """Returns the status of the motors. 0 for all stopped, 1 for
-some running.
- """
- return self.read_value('status')[0]
-
- def set_step_time(self, time):
- """Sets the step time (0-15).
- """
- self.write_value('steptime', (time, ))
-
- def set_pos(self, num, pos):
- """Sets the position of a server. num is the servo number (1-6),
-pos is the position (0-255).
- """
- self.write_value('s%dpos' % num, (pos, ))
-
- def get_pwm(self):
- """Gets the "PWM enable" value. The function of this value is
-nontrivial and can be found in the documentation for the sensor.
- """
- return self.read_value('pwm')[0]
-
- def set_pwm(self, pwm):
- """Sets the "PWM enable" value. The function of this value is
-nontrivial and can be found in the documentation for the sensor.
- """
- self.write_value('pwm', (pwm, ))
-
-ServoCon.add_compatible_sensor(None, 'HiTechnc', 'ServoCon')
-
-
-class MotorCon(BaseDigitalSensor):
- """Object for HiTechnic FIRST Motor Controllers. Coded to HiTechnic's specs for
-the sensor but not tested. Please report whether this worked for you or not!"""
- I2C_ADDRESS = BaseDigitalSensor.I2C_ADDRESS.copy()
- I2C_ADDRESS.update({
- 'm1enctarget': (0x40, '>l'),
- 'm1mode': (0x44, 'B'),
- 'm1power': (0x45, 'b'),
- 'm2power': (0x46, 'b'),
- 'm2mode': (0x47, 'B'),
- 'm2enctarget': (0x48, '>l'),
- 'm1enccurrent': (0x4c, '>l'),
- 'm2enccurrent': (0x50, '>l'),
- 'batteryvoltage': (0x54, '2B'),
- 'm1gearratio': (0x56, 'b'),
- 'm1pid': (0x57, '3B'),
- 'm2gearratio': (0x5a, 'b'),
- 'm2pid': (0x5b, '3B'),
- })
-
- class PID_Data():
- def __init__(self, p, i, d):
- self.p, self.i, self.d = p, i, d
-
- def __init__(self, brick, port, check_compatible=True):
- super(MotorCon, self).__init__(brick, port, check_compatible)
-
- def set_enc_target(self, mot, val):
- """Set the encoder target (-2147483648-2147483647) for a motor
- """
- self.write_value('m%denctarget'%mot, (val, ))
-
- def get_enc_target(self, mot):
- """Get the encoder target for a motor
- """
- return self.read_value('m%denctarget'%mot)[0]
-
- def get_enc_current(self, mot):
- """Get the current encoder value for a motor
- """
- return self.read_value('m%denccurrent'%mot)[0]
-
- def set_mode(self, mot, mode):
- """Set the mode for a motor. This value is a bit mask and you can
-find details about it in the sensor's documentation.
- """
- self.write_value('m%dmode'%mot, (mode, ))
-
- def get_mode(self, mot):
- """Get the mode for a motor. This value is a bit mask and you can
-find details about it in the sensor's documentation.
- """
- return self.read_value('m%dmode'%mot)[0]
-
- def set_power(self, mot, power):
- """Set the power (-100-100) for a motor
- """
- self.write_value('m%dpower'%mot, (power, ))
-
- def get_power(self, mot):
- """Get the power for a motor
- """
- return self.read_value('m%dpower'%mot)[0]
-
- def set_gear_ratio(self, mot, ratio):
- """Set the gear ratio for a motor
- """
- self.write_value('m%dgearratio'%mot, (ratio, ))
-
- def get_gear_ratio(self, mot):
- """Get the gear ratio for a motor
- """
- return self.read_value('m%dgearratio'%mot)[0]
-
- def set_pid(self, mot, piddata):
- """Set the PID coefficients for a motor. Takes data in
-MotorCon.PID_Data(p, i, d) format.
- """
- self.write_value('m%dpid'%mot, (piddata.p, piddata.i, piddata.d))
-
- def get_pid(self, mot):
- """Get the PID coefficients for a motor. Returns a PID_Data() object.
- """
- p, i, d = self.read_value('m%dpid'%mot)
- return self.PID_Data(p, i, d)
-
- def get_battery_voltage(self):
- """Gets the battery voltage (in millivolts/20)
- """
- high, low = self.read_value('bateryvoltage')[0]
- return high << 2 + low
-
-MotorCon.add_compatible_sensor(None, 'HiTechnc', 'MotorCon')
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/sensor/mindsensors.py b/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/sensor/mindsensors.py
deleted file mode 100644
index de6c7ee..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/sensor/mindsensors.py
+++ /dev/null
@@ -1,815 +0,0 @@
-# nxt.sensor.mindsensors module -- Classes implementing Mindsensors sensors
-# Copyright (C) 2006,2007 Douglas P Lau
-# Copyright (C) 2009 Marcus Wanner, Paulo Vieira, rhn
-# Copyright (C) 2010 Marcus Wanner, MindSensors
-#
-# 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 3 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.
-
-
-from .common import *
-from .digital import BaseDigitalSensor, SensorInfo
-from .analog import BaseAnalogSensor
-
-
-class SumoEyes(BaseAnalogSensor):
- """The class to control Mindsensors Sumo sensor. Warning: long range not
- working for my sensor.
- """
- #range: 5-10cm
- class Reading:
- """Contains the reading of SumoEyes sensor. left and right can be True or
- False. If True, then there is something there, if False, then it's empty
- there.
- """
- def __init__(self, raw_reading):
- self.raw = raw_reading
- val = raw_reading.normalized_ad_value # FIXME: make it rely on raw_ad_value
- right = 600 < val < 700
- both = 700 <= val < 900
- left = 300 < val < 400
- self.left = left or both
- self.right = right or both
-
- def __str__(self):
- return '(left: ' + str(self.left) + ', right: ' + str(self.right) + ')'
-
- def __init__(self, brick, port, long_range=False):
- super(SumoEyes, self).__init__(brick, port)
- self.set_long_range(long_range)
-
- def set_long_range(self, val):
- """Sets if the sensor should operate in long range mode (12 inches) or
- the short range mode (6 in). val should be True or False.
- """
- if val:
- type_ = Type.LIGHT_INACTIVE
- else:
- type_ = Type.LIGHT_ACTIVE
- self.set_input_mode(type_, Mode.RAW)
-
- def get_sample(self):
- """Returns the processed meaningful values of the sensor"""
- return self.Reading(self.get_input_values())
-
-
-class Compassv2(BaseDigitalSensor):
- """Class for the now-discontinued CMPS-Nx sensor. Also works with v1.1 sensors.
-Note that when using a v1.x sensor, some of the commands are not supported!
-To determine your sensor's version, use get_sensor_info().version"""
- I2C_ADDRESS = BaseDigitalSensor.I2C_ADDRESS.copy()
- I2C_ADDRESS.update({'command': (0x41, '<B'),
- 'heading': (0x42, '<H'),
- 'x_offset': (0x44, '<h'), #unsure about signedness for this one
- 'y_offset': (0x46, '<h'), #and this one
- 'x_range': (0x48, '<H'),
- 'y_range': (0x4A, '<H'),
- 'x_raw': (0x4C, '<H'), #and this one
- 'y_raw': (0x4E, '<H'), #and this one
- })
-
- class Commands:
- AUTO_TRIG_ON = 'A'
- AUTO_TRIG_OFF = 'S'
- MAP_HEADING_BYTE = 'B' # map heading to 0-255 range
- MAP_HEADING_INTEGER = 'I' # map heading to 0-36000 (or 3600) range
- SAMPLING_50_HZ = 'E' # set sampling frequency to 50 Hz
- SAMPLING_60_HZ = 'U' # set sampling frequency to 60 Hz
- SET_ADPA_MODE_ON = 'N' # set ADPA mode on
- SET_ADPA_MODE_OFF = 'O' # set ADPA mode off
- BEGIN_CALIBRATION = 'C' # begin calibration
- DONE_CALIBRATION = 'D' # done with calibration
- LOAD_USER_CALIBRATION = 'L' # load user calibration value
-
- def __init__(self, brick, port, check_compatible=True):
- super(Compassv2, self).__init__(brick, port, check_compatible)
- self.command(self.Commands.MAP_HEADING_INTEGER)
-
- def command(self, command):
- value = ord(command)
- self.write_value('command', (value, ))
-
- def get_heading(self):
- return self.read_value('heading')[0]
-
- get_sample = get_heading
-
-Compassv2.add_compatible_sensor(None, 'mndsnsrs', 'CMPS')
-
-
-class DIST(BaseDigitalSensor):
- """Class for the Distance Infrared Sensor"""
- I2C_ADDRESS = BaseDigitalSensor.I2C_ADDRESS.copy()
- I2C_ADDRESS.update({'command': (0x41, '<B'),
- 'distance': (0x42, '<H'),
- 'voltage': (0x44, '<H'),
- 'type': (0x50, '<B'),
- 'no_of_data_points': (0x51, '<B'),
- 'min_distance': (0x52, '<H'),
- 'max_distance': (0x54, '<H'),
- })
-
- class Commands:
- TYPE_GP2D12 = '1' #GP2D12 sensor Module
- TYPE_GP2D120 = '2' #Short range sensor Module
- TYPE_GP2Y0A21YK = '3' #Medium range sensor Module
- TYPE_GP2Y0A02YK = '4' #Long range sensor Module
- TYPE_CUSTOM = '5' #Custom sensor Module
- POWER_ON = 'E' #Sensor module power on
- POWER_OFF = 'D' #Sensor module power offset
- ADPA_ON = 'N' #ADPA mode on
- ADPA_OFF = 'O' #ADPA mode off (default)
-
- def command(self, command):
- value = ord(command)
- self.write_value('command', (value, ))
-
- def get_distance(self):
- return self.read_value('distance')[0]
-
- get_sample = get_distance
-
- def get_type(self):
- return self.read_value('type')[0]
-
- def get_voltage(self):
- return self.read_value('voltage')[0]
-
- def get_min_distance(self):
- return self.read_value('min_distance')[0]
-
- def get_max_distance(self):
- return self.read_value('max_distance')[0]
-
-DIST.add_compatible_sensor(None, 'mndsnsrs', 'DIST')
-
-
-class RTC(BaseDigitalSensor):
- """Class for the RealTime Clock sensor"""
- #TODO: Create a function to set the clock
- #Has no indentification
- I2C_ADDRESS = BaseDigitalSensor.I2C_ADDRESS.copy()
- I2C_ADDRESS.update({'seconds': (0x00, '<B'),
- 'minutes': (0x01, '<B'),
- 'hours': (0x02, '<B'),
- 'day': (0x03, '<B'),
- 'date': (0x04, '<B'),
- 'month': (0x05, '<B'),
- 'year': (0x06, '<B'),
- })
- I2C_DEV = 0xD0
-
- def __init__(self, brick, port, check_compatible=False): #check_compatible must remain false due to no identification!
- super(RTC, self).__init__(brick, port, check_compatible)
-
- def get_seconds(self):
- gs = self.read_value('seconds')[0]
- gs2 = gs & 0xf # bitmasks
- gs3 = gs & 0x70
- gs3 = gs3 >> 4
- return str(gs3) + str(gs2)
-
- def get_minutes(self):
- gm = self.read_value('minutes')[0]
- gm2 = gm & 0xf
- gm3 = gm & 0x70
- gm3 = gm3 >> 4
- return str(gm3) + str(gm2)
-
- def get_hours(self):
- gh = self.read_value('hours')[0]
- gh2 = gh & 0xf
- gh3 = gh & 0x30
- gh3 = gh3 >> 4
- return str(gh3) + str(gh2)
-
- def get_day(self):
- gwd = self.read_value('day')[0]
- gwd = gwd & 0x07
- return gwd
-
- def get_month(self):
- gmo = self.read_value('month')[0]
- gmo2 = gmo & 0xf
- gmo3 = gmo & 0x10
- gmo3 = gmo3 >> 4
- return str(gmo3) + str(gmo2)
-
- def get_year(self):
- """Last two digits (10 for 2010)"""
- gy = self.read_value('year')[0]
- gy2 = gy & 0xf
- gy3 = gy & 0xF0
- gy3 = gy3 >> 4
- return str(gy3) + str(gy2)
-
- def get_date(self):
- gd = self.read_value('date')[0]
- gd2 = gd & 0xf
- gd3 = gd & 0x60
- gd3 = gd3 >> 4
- return str(gd3) + str(gd2)
-
- def hour_mode(self, mode):
- """Writes mode bit and re-enters hours, which is required"""
- if mode == 12 or 24:
- hm = self.read_value('hours')[0]
- hm2 = hm & 0x40
- hm2 = hm2 >> 6
- if mode == 12 and hm2 == 0: #12_HOUR = 1
- hm3 = hm + 64
- self.write_value('hours', (hm3, ))
- elif mode == 24 and hm2 == 1: #24_HOUR = 0
- hm3 = hm - 64
- self.write_value('hours', (hm3, ))
- else:
- print 'That mode is already selected!'
- else:
- raise ValueError('Must be 12 or 24!')
-
- def get_mer(self):
- mer = self.read_value('hours')[0]
- mer2 = mer & 0x40
- mer2 = mer2 >> 6
- if mer2 == 1:
- mer3 = mer & 0x20
- mer3 = mer3 >> 0x10
- return mer3
- else:
- print 'Cannot get mer! In 24-hour mode!'
-
- def get_sample(self):
- """Returns a struct_time() tuple which can be processed by the time module."""
- import time
- return time.struct_time((
- int(self.get_year())+2000,
- int(self.get_month()),
- int(self.get_date()),
- int(self.get_hours()),
- int(self.get_minutes()),
- int(self.get_seconds()),
- int(self.get_day()),
- 0, #Should be the Julian Day, but computing that is hard.
- 0 #No daylight savings time to worry about here.
- ))
-
-
-class ACCL(BaseDigitalSensor):
- """Class for Accelerometer sensor"""
- I2C_ADDRESS = BaseDigitalSensor.I2C_ADDRESS.copy()
- I2C_ADDRESS.update({'sensitivity': (0x19, 'B'),
- 'command': (0x41, 'B'),
- 'x_tilt': (0x42, 'b'),
- 'y_tilt': (0x43, 'b'),
- 'z_tilt': (0x44, 'b'),
- 'all_tilt': (0x42, '3b'),
-
- 'x_accel': (0x45, '<h'),
- 'y_accel': (0x47, '<h'),
- 'z_accel': (0x49, '<h'),
- 'all_accel': (0x45, '<3h'),
-
- 'x_offset': (0x4B, '<h'),
- 'x_range': (0x4D, '<h'),
-
- 'y_offset': (0x4F, '<h'),
- 'y_range': (0x51, '<h'),
-
- 'z_offset': (0x53, '<h'),
- 'z_range': (0x55, '<h'),
- })
-
- class Commands:
- SENS_15G = '1' #that's 1.5...Alt. 2.5G (sensors older than V3.20)
- SENS_2G = '2' #Alt .3.3G
- SENS_4G = '3' #Alt. 6.7G
- SENS_6G = '4' #Alt. 10G
- X_CALIBRATION = 'X' #Acquire X point calibration
- X_CAL_AND_END = 'x' #X point calibration and end calibration
- Y_CALIBRATION = 'Y' #Acquire Y point calibration
- Y_CAL_AND_END = 'y' #Y point calibration and end calibration
- Z_CALIBRATION = 'Z' #Acquire Z point calibration
- Z_CAL_AND_END = 'z' #Z point calibration and end calibration
- CAL_RESET = 'R' #Reset to factory set calibration
- ADPA_ON = 'N' #Set ADPA mode On
- ADPA_OFF = 'O' #Set ADPA mode Off (default)
-
- def __init__(self, brick, port, check_compatible=True):
- super(ACCL, self).__init__(brick, port, check_compatible)
-
- def command(self, command):
- value = ord(command)
- self.write_value('command', (value, ))
-
- def get_sensitivity(self):
- return chr(self.read_value('sensitivity')[0])
-
- def get_tilt(self, axis):
- xyz = str(axis) + '_tilt'
- return self.read_value(xyz)[0]
-
- def get_all_tilt(self):
- return self.read_value('all_tilt')
-
- def get_accel(self, axis):
- xyz = str(axis) + '_accel'
- return self.read_value(xyz)[0]
-
- def get_all_accel(self):
- return self.read_value('all_accel')
-
- get_sample = get_all_accel
-
- def get_offset(self, axis):
- xyz = str(axis) + '_offset'
- return self.read_value(xyz)[0]
-
- def get_range(self, axis):
- xyz = str(axis) + '_range'
- return self.read_value(xyz)[0]
-
- def set_offset(self, axis, value):
- xyz = str(axis) + '_offset'
- self.write_value(xyz, (value, ))
-
- def set_range(self, axis, value):
- xyz = str(axis) + '_range'
- self.write_value(xyz, (value, ))
-
-ACCL.add_compatible_sensor(None, 'mndsnsrs', 'ACCL-NX') #Tested with version 'V3.20'
-
-
-class MTRMUX(BaseDigitalSensor):
- """Class for RCX Motor Multiplexer sensor"""
- I2C_ADDRESS = BaseDigitalSensor.I2C_ADDRESS.copy()
- I2C_ADDRESS.update({'command' : (0x41, '<B'),
- 'direction_m1': (0x42, '<B'),
- 'speed_m1': (0x43, '<B'),
- 'direction_m2': (0x44, '<B'),
- 'speed_m2': (0x45, '<B'),
- 'direction_m3': (0x46, '<B'),
- 'speed_m3': (0x47, '<B'),
- 'direction_m4': (0x48, '<B'),
- 'speed_m4': (0x49, '<B'),
- })
- I2C_DEV = 0xB4
-
- class Commands:
- FLOAT = 0x00
- FORWARD = 0x01
- REVERSE = 0x02
- BRAKE = 0x03
-
- def __init__(self, brick, port, check_compatible=True):
- super(MTRMUX, self).__init__(brick, port, check_compatible)
-
- def command(self, command):
- self.write_value('command', (command, ))
-
- def set_direction(self, number, value):
- addressname = 'direction_m' + str(number)
- self.write_value(addressname, (value, ))
-
- def set_speed(self, number, value):
- addressname = 'speed_m' + str(number)
- self.write_value(addressname, (value, ))
-
- def get_direction(self, number):
- addressname = 'direction_m' + str(number)
- self.read_value(addressname)
-
- def get_speed(self, number):
- addressname = 'speed_m' + str(number)
- self.read_value(addressname)
-
-MTRMUX.add_compatible_sensor(None, 'mndsnsrs', 'MTRMUX') #Tested with version 'V2.11'
-
-
-class LineLeader(BaseDigitalSensor):
- """Class for Line Sensor Array"""
- I2C_ADDRESS = BaseDigitalSensor.I2C_ADDRESS.copy()
- I2C_ADDRESS.update({'command': (0x41, '<B'),
- 'steering': (0x42, '<b'),
- 'average': (0x43, '<B'),
- 'result': (0x44, '<B'),
- 'set_point': (0x45, '<B'),
-
- 'kp': (0x46, '<B'),
- 'ki': (0x47, '<B'),
- 'kd': (0x48, '<B'),
- 'kp_divisor':(0x61, '<B'),
- 'ki_divisor':(0x62, '<B'),
- 'kd_divisor':(0x63, '<B'),
- #One byte for each sensor, so byte# = sensor#
- 'calibrated_reading_byte1': (0x49, '<B'),
- 'calibrated_reading_byte2': (0x4A, '<B'),
- 'calibrated_reading_byte3': (0x4B, '<B'),
- 'calibrated_reading_byte4': (0x4C, '<B'),
- 'calibrated_reading_byte5': (0x4D, '<B'),
- 'calibrated_reading_byte6': (0x4E, '<B'),
- 'calibrated_reading_byte7': (0x4F, '<B'),
- 'calibrated_reading_byte8': (0x50, '<B'),
- 'all_calibrated_readings': (0x49, '<8B'),
-
- 'w_read_limit':(0x51, '<H'),
- 'b_read_limit':(0x59, '<B'),
- 'w_cal_data1':(0x64, '<B'),
- 'b_cal_data':(0x6C, '<B'),
-
- 'uncal_sensor1_voltage_byte1':(0x74, '<B'),
- 'uncal_sensor2_voltage_byte1':(0x76, '<B'),
- 'uncal_sensor3_voltage_byte1':(0x78, '<B'),
- 'uncal_sensor4_voltage_byte1':(0x7A, '<B'),
- 'uncal_sensor5_voltage_byte1':(0x7C, '<B'),
- 'uncal_sensor6_voltage_byte1':(0x7E, '<B'),
- 'uncal_sensor7_voltage_byte1':(0x80, '<B'),
- 'uncal_sensor8_voltage_byte1':(0x82, '<B'),
- 'all_uncal_readings': (0x74, '<8B'),
- })
-
- class Commands:
- CALIBRATE_WHITE = 'W'
- CALIBRATE_BLACK = 'B'
- SENSOR_SLEEP = 'D'
- US_CONFIG = 'A'
- EU_CONFIG = 'E'
- UNI_CONFIG = 'U'
- SENSOR_WAKE = 'P'
- COLOR_INVERT = 'I'
- COLOR_INVERT_REVERSE = 'R'
- SNAPSHOT = 'S'
-
- def __init__(self, brick, port, check_compatible=True):
- super(LineLeader, self).__init__(brick, port, check_compatible)
-
- def command(self, command):
- value = ord(command)
- self.write_value('command', (value, ))
-
- def get_steering(self):
- 'Value to add to the left and subtract from the right motor\'s power.'
- return self.read_value('steering')[0]
-
- def get_average(self):
- 'Weighted average; greater as line is closer to right edge. 0 for no line.'
- return self.read_value('average')[0]
-
- def get_result(self):
- 'Bitmap, one bit for each sensor'
- return self.read_value('result')[0]
-
- def set_set_point(self, value):
- 'Average value for steering to gravitate to. 10 (left) to 80 (right).'
- self.write_value('set_point', (value, ))
-
- def set_pid(self, pid, value):
- addressname = 'k' + str(pid)
- self.write_value(addressname, (value, ))
-
- def set_pid_divisor(self, pid, value):
- addressname = 'k' + str(pid) + '_divisor'
- self.write_value(addressname, (value, ))
-
- def get_reading(self, number):
- addressname = 'calibrated_reading_byte' + str(number)
- return self.read_value(addressname)[0]
-
- def get_reading_all(self):
- return self.read_value('all_calibrated_readings')
-
- get_sample = get_reading_all
-
- def get_uncal_reading(self, number):
- addressname = 'uncal_sensor' + str(number) + '_voltage_byte1'
- return self.read_value(addressname)[0]
-
- def get_uncal_all(self):
- return self.read_value('all_uncal_readings')
-
-LineLeader.add_compatible_sensor(None, 'mndsnsrs', 'LineLdr') #Tested with version 'V1.16'
-
-
-class Servo(BaseDigitalSensor):
- """Class for Servo sensors"""
- I2C_ADDRESS = BaseDigitalSensor.I2C_ADDRESS.copy()
- I2C_ADDRESS.update({'command' : (0x41, '<B'),
-
- 'servo_1_pos': (0x42, '<H'),
- 'servo_2_pos': (0x44, '<H'),
- 'servo_3_pos': (0x46, '<H'),
- 'servo_4_pos': (0x48, '<H'),
- 'servo_5_pos': (0x4A, '<H'),
- 'servo_6_pos': (0x4C, '<H'),
- 'servo_7_pos': (0x4E, '<H'),
- 'servo_8_pos': (0x50, '<H'),
-
- 'servo_1_speed': (0x52, '<B'),
- 'servo_2_speed': (0x53, '<B'),
- 'servo_3_speed': (0x54, '<B'),
- 'servo_4_speed': (0x55, '<B'),
- 'servo_5_speed': (0x56, '<B'),
- 'servo_6_speed': (0x57, '<B'),
- 'servo_7_speed': (0x58, '<B'),
- 'servo_8_speed': (0x59, '<B'),
-
- 'servo_1_quick': (0x5A, '<B'),
- 'servo_2_quick': (0x5B, '<B'),
- 'servo_3_quick': (0x5C, '<B'),
- 'servo_4_quick': (0x5D, '<B'),
- 'servo_5_quick': (0x5E, '<B'),
- 'servo_6_quick': (0x5F, '<B'),
- 'servo_7_quick': (0x60, '<B'),
- 'servo_8_quick': (0x61, '<B'),
- })
- I2C_DEV = 0xB0
-
- COMMANDVALUES = {'R': (0x52), #Resume macro execution
- 'S': (0x53), #reset initial position and speed
- 'I1': (0x4931), #store initial position motor 1
- 'I2': (0x4932), #store initial position motor 2
- 'I3': (0x4933), #etc...
- 'I4': (0x4934),
- 'I5': (0x4935),
- 'I6': (0x4936),
- 'I7': (0x4937),
- 'I8': (0x4938),
- 'H': (0x48), #Halt macro
- 'Gx': (0x4778), #not going to work yet x = variable
- 'EM': (0x454d), #Edit Macro
- 'P': (0x50), #Pause Macro
- }
-
- class Commands:
- RESUME_MACRO = 'R'
- RESET_POS_SPEED = 'S'
- STORE_MOTOR_POS_1 = 'I1'
- STORE_MOTOR_POS_2 = 'I2'
- STORE_MOTOR_POS_3 = 'I3'
- STORE_MOTOR_POS_4 = 'I4'
- STORE_MOTOR_POS_5 = 'I5'
- STORE_MOTOR_POS_6 = 'I6'
- STORE_MOTOR_POS_7 = 'I7'
- STORE_MOTOR_POS_8 = 'I8'
- HALT_MACRO = 'H'
- X_TO_VAR = 'Gx' #not going to work yet
- EDIT_MACRO = 'EM'
- PAUSE_MACRO = 'P'
-
- def __init__(self, brick, port, check_compatible=True):
- super(Servo, self).__init__(brick, port, check_compatible)
-
- def command(self, command):
- value = self.COMMANDVALUES[command]
- self.write_value('command', (value, ))
-
- def get_bat_level(self):
- return self.read_value('command')[0]
-
- def set_position(self, number, value):
- addressname = 'servo_' + str(number) + '_pos'
- self.write_value(addressname, (value, ))
-
- def get_position(self, number):
- return self.read_value('servo_' + str(number) + '_pos')[0]
-
- def set_speed(self, number, value):
- addressname = 'servo_' + str(number) + '_speed'
- self.write_value(addressname, (value, ))
-
- def get_speed(self, number):
- return self.read_value('servo_' + str(number) + '_speed')[0]
-
- def set_quick(self, number, value):
- addressname = 'servo_' + str(number) + '_quick'
- self.write_value(addressname, (value, ))
-
-Servo.add_compatible_sensor(None, 'mndsnsrs', 'NXTServo') #Tested with version 'V1.20'
-
-
-class MMX(BaseDigitalSensor):
- """Class for MMX sensors"""
- I2C_ADDRESS = BaseDigitalSensor.I2C_ADDRESS.copy()
- I2C_ADDRESS.update({'command' : (0x41, '<B'),
- #Motor Writes
- 'encoder_1_target': (0x42, '<l'),
- 'speed_1': (0x46, '<B'),
- 'seconds_to_run_1': (0x47, '<B'),
- 'command_b_1': (0x48, '<B'),
- 'command_a_1': (0x49, '<B'),
-
- 'encoder_2_target': (0x4A, '<l'),
- 'speed_2': (0x4E, '<B'),
- 'seconds_to_run_2': (0x4F, '<B'),
- 'command_b_2': (0x50, '<B'),
- 'command_a_2': (0x51, '<B'),
- #Motor reads
- 'encoder_1_pos': (0x62, '<H'),
- 'encoder_2_pos': (0x66, '<H'),
- 'status_m1': (0x72, '<B'),
- 'status_m2': (0x73, '<B'),
- 'tasks_running_m1': (0x76, '<H'),
- 'tasks_running_m2': (0x77, '<H'),
- #PID Control
- 'p_encoder': (0x7A, '<H'),
- 'i_encoder': (0x7C, '<H'),
- 'd_encoder': (0x7E, '<H'),
- 'p_speed': (0x80, '<H'),
- 'i_speed': (0x82, '<H'),
- 'd_speed': (0x84, '<H'),
- 'pass_count': (0x86, '<B'),
- 'tolerance': (0x87, '<B'),
- })
- I2C_DEV = 0x06
-
- class Commands:
- RESET_PARAMS_ENCODERS = 'R'
- ISSUE_SYNCED_COMMANDS = 'S'
- MOTOR_1_FLOAT_STOP = 'a'
- MOTOR_2_FLOAT_STOP = 'b'
- BOTH_FLOAT_STOP = 'c'
- MOTOR_1_BRAKE_STOP = 'A'
- MOTOR_2_BRAKE_STOP = 'B'
- BOTH_BRAKE_STOP = 'C'
- MOTOR_1_ENC_RESET = 'r'
- MOTOR_2_ENC_RESET = 's'
-
- def __init__(self, brick, port, check_compatible=True):
- super(MMX, self).__init__(brick, port, check_compatible)
-
- def command(self, command):
- value = ord(command)
- self.write_value('command', (value, ))
-
- def get_bat_level(self):
- return self.read_value('command')[0]
-
- def set_encoder_target(self, motor_number, value):
- addressname = 'encoder_' + str(motor_number) + '_target'
- self.write_value(addressname, (value, ))
-
- def set_speed(self, motor_number, value):
- addressname = 'speed_' + str(motor_number)
- self.write_value(addressname, (value, ))
-
- def set_time_run(self, motor_number, seconds):
- addressname = 'seconds_to_run_' + str(motor_number)
- self.write_value(addressname, (seconds, ))
-
- def command_b(self, motor_number, value):
- addressname = 'command_b_' + str(motor_number)
- self.write_value(addressname, (value, ))
-
- def command_a(self, motor_number, bit_num, bit_val):
- addressname = 'command_a_' + str(motor_number)
- s = self.read_value(addressname)[0]
- #I feel like there must be an easier way to write one bit...
- val = bit_val << bit_num
- if bit_val == 1:
- value = val | s
- self.write_value(addressname, (value, ))
- return value #testing purposes
- elif bit_val == 0:
- val = 1
- val = val << bit_num
- val = val ^ 0xFF
- value = val & s
- self.write_value(addressname, (value, ))
- return value
-
- def get_encoder_pos(self, motor_number):
- addressname = 'encoder_' +str(motor_number) +'_pos'
- return self.read_value(addressname)[0]
-
- def get_motor_status(self, motor_number, bit_num):
- addressname = 'status_m' + str(motor_number)
- s = self.read_value(addressname)[0]
- x = 1
- x = x << bit_num
- value = x & s
- value = value >> bit_num
- return value
-
- def get_tasks(self, motor_number):
- addressname = 'tasks_running_m' + str(motor_number)
- return self.read_value(addressname)[0]
-
- def set_pid(self, pid, target, value):
- addressname = str(pid) + '_' + str(target)
- self.write_value(addressname, (value, ))
-
- def set_pass_count(self, value):
- self.write_value('pass_count', (value, ))
-
- def set_tolerance(self, value):
- self.write_value('tolerance', (value, ))
-
-MMX.add_compatible_sensor(None, 'mndsnsrs', 'NxTMMX') #Tested with version 'V1.01'
-
-
-class HID(BaseDigitalSensor):
- """Class for Human Interface Device sensors.
-These are connected to a computer and look like a keyboard to it."""
- I2C_ADDRESS = BaseDigitalSensor.I2C_ADDRESS.copy()
- I2C_ADDRESS.update({'command' : (0x41, '<B'),
- 'modifier' : (0x42, '<B'),
- 'keyboard_data' : (0x43, '<B'),
- })
- I2C_DEV = 0x04
-
- class Commands:
- TRANSMIT = 'T'
- ASCII_MODE = 'A'
- DIRECT_MODE = 'D'
-
- def __init__(self, brick, port, check_compatible=True):
- super(HID, self).__init__(brick, port, check_compatible)
-
- def command(self, command):
- value = ord(command)
- self.write_value('command', (value, ))
-
- def set_modifier(self, mod):
- self.write_value('modifier', (mod, ))
-
- def write_data(self, data):
- data = ord(data)
- self.write_value('keyboard_data', (data, ))
-
-HID.add_compatible_sensor(None, 'mndsnsrs', 'NXTHID') #Tested with version 'V1.02'
-
-
-class PS2(BaseDigitalSensor):
- I2C_ADDRESS = BaseDigitalSensor.I2C_ADDRESS.copy()
- I2C_ADDRESS.update({'command' : (0x41, '<B'),
- 'button_set_1': (0x42, '<B'),
- 'button_set_2': (0x43, '<B'),
- 'x_left_joystick': (0x44, '<b'),
- 'y_left_joystick': (0x45, '<b'),
- 'x_right_joystick': (0x46, '<b'),
- 'y_right_joystick': (0x47, '<b'),
- })
-
- class ControllerState:
- class Buttons:
- left, down, right, up, square, cross, circle, triangle, r1, r2, r3, l1, l2, l3 = [0 for i in range(14)] #14 zeros
- def __init__(self, buttons_1, buttons_2, left_x, left_y, right_x, right_y):
- self.leftstick = (left_x, left_y)
- self.rightstick = (right_x, right_y)
- buttons_1 = ~buttons_1
- buttons_2 = ~buttons_2
- self.buttons = self.Buttons()
- self.buttons.left = bool(buttons_1 & 0x80)
- self.buttons.down = bool(buttons_1 & 0x40)
- self.buttons.right = bool(buttons_1 & 0x20)
- self.buttons.up = bool(buttons_1 & 0x10)
- self.buttons.square = bool(buttons_2 & 0x80)
- self.buttons.cross = bool(buttons_2 & 0x40)
- self.buttons.circle = bool(buttons_2 & 0x20)
- self.buttons.triangle = bool(buttons_2 & 0x10)
- self.buttons.r1 = bool(buttons_2 & 0x08)
- self.buttons.r2 = bool(buttons_2 & 0x02)
- self.buttons.r3 = bool(buttons_1 & 0x04)
- self.buttons.l1 = bool(buttons_2 & 0x04)
- self.buttons.l2 = bool(buttons_2 & 0x01)
- self.buttons.l3 = bool(buttons_1 & 0x02)
-
- class Commands:
- POWER_ON = 'E'
- POWER_OFF = 'D'
- DIGITAL_MODE = 'A'
- ANALOG_MODE = 's'
- ADPA_ON = 'N'
- ADPA_OFF = 'O'
-
- def __init__(self, brick, port, check_compatible=True):
- super(PS2, self).__init__(brick, port, check_compatible)
-
- def command(self, command):
- value = ord(command)
- self.write_value('command', (value, ))
-
- def get_joystick(self, xy, lr):
- addressname = str(xy) + '_' + str(lr) + '_joystick'
- return self.read_value(addressname)[0]
-
- def get_buttons(self, setnum):
- addressname = 'button_set_' + str(setnum)
- return self.read_value(addressname)[0]
-
- def get_sample(self):
- return self.ControllerState(
- get_buttons(0),
- get_buttons(1),
- get_joystick('x', 'l'),
- get_joystick('y', 'l'),
- get_joystick('x', 'r'),
- get_joystick('y', 'r'))
-
-PS2.add_compatible_sensor(None, 'mndsnsrs', 'PSPNX') #Tested with version 'V2.00'
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/system.py b/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/system.py
deleted file mode 100644
index a82d5d6..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/system.py
+++ /dev/null
@@ -1,297 +0,0 @@
-# nxt.system module -- LEGO Mindstorms NXT system telegrams
-# Copyright (C) 2006 Douglas P Lau
-# Copyright (C) 2009 Marcus Wanner
-#
-# 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 3 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.
-
-'Use for communications regarding the NXT filesystem and such ***ADVANCED USERS ONLY***'
-
-def _create(opcode):
- 'Create a simple system telegram'
- from telegram import Telegram
- return Telegram(False, opcode)
-
-def _create_with_file(opcode, fname):
- tgram = _create(opcode)
- tgram.add_filename(fname)
- return tgram
-
-def _create_with_handle(opcode, handle):
- tgram = _create(opcode)
- tgram.add_u8(handle)
- return tgram
-
-def open_read(opcode, fname):
- return _create_with_file(opcode, fname)
-
-def _parse_open_read(tgram):
- tgram.check_status()
- handle = tgram.parse_u8()
- n_bytes = tgram.parse_u32()
- return (handle, n_bytes)
-
-def open_write(opcode, fname, n_bytes):
- tgram = _create_with_file(opcode, fname)
- tgram.add_u32(n_bytes)
- return tgram
-
-def _parse_open_write(tgram):
- tgram.check_status()
- handle = tgram.parse_u8()
- return handle
-
-def read(opcode, handle, n_bytes):
- tgram = _create_with_handle(opcode, handle)
- tgram.add_u16(n_bytes)
- return tgram
-
-def _parse_read(tgram):
- tgram.check_status()
- handle = tgram.parse_u8()
- n_bytes = tgram.parse_u16()
- data = tgram.parse_string()
- return (handle, n_bytes, data)
-
-def write(opcode, handle, data):
- tgram = _create_with_handle(opcode, handle)
- tgram.add_string(len(data), data)
- return tgram
-
-def _parse_write(tgram):
- tgram.check_status()
- handle = tgram.parse_u8()
- n_bytes = tgram.parse_u16()
- return (handle, n_bytes)
-
-def close(opcode, handle):
- return _create_with_handle(opcode, handle)
-
-def _parse_close(tgram):
- tgram.check_status()
- handle = tgram.parse_u8()
- return handle
-
-def delete(opcode, fname):
- return _create_with_file(opcode, fname)
-
-def _parse_delete(tgram):
- tgram.check_status()
- handle = tgram.parse_u8()
- fname = tgram.parse_string()
- return (handle, fname)
-
-def find_first(opcode, fname):
- return _create_with_file(opcode, fname)
-
-def _parse_find(tgram):
- tgram.check_status()
- handle = tgram.parse_u8()
- fname = tgram.parse_string(20)
- n_bytes = tgram.parse_u32()
- return (handle, fname, n_bytes)
-
-def find_next(opcode, handle):
- return _create_with_handle(opcode, handle)
-
-def get_firmware_version(opcode):
- return _create(opcode)
-
-def _parse_get_firmware_version(tgram):
- tgram.check_status()
- prot_minor = tgram.parse_u8()
- prot_major = tgram.parse_u8()
- prot_version = (prot_major, prot_minor)
- fw_minor = tgram.parse_u8()
- fw_major = tgram.parse_u8()
- fw_version = (fw_major, fw_minor)
- return (prot_version, fw_version)
-
-def open_write_linear(opcode, fname, n_bytes):
- tgram = _create_with_file(opcode, fname)
- tgram.add_u32(n_bytes)
- return tgram
-
-def open_read_linear(opcode, fname):
- return _create_with_file(opcode, fname)
-
-def _parse_open_read_linear(tgram):
- tgram.check_status()
- n_bytes = tgram.parse_u32()
- return n_bytes
-
-def open_write_data(opcode, fname, n_bytes):
- tgram = _create_with_file(opcode, fname)
- tgram.add_u32(n_bytes)
- return tgram
-
-def open_append_data(opcode, fname):
- return _create_with_file(opcode, fname)
-
-def _parse_open_append_data(tgram):
- tgram.check_status()
- handle = tgram.parse_u8()
- n_bytes = tgram.parse_u32()
- return (handle, n_bytes)
-
-def request_first_module(opcode, mname):
- return _create_with_file(opcode, mname)
-
-def _parse_request_module(tgram):
- tgram.check_status()
- handle = tgram.parse_u8()
- mname = tgram.parse_string(20)
- mod_id = tgram.parse_u32()
- mod_size = tgram.parse_u32()
- mod_iomap_size = tgram.parse_u16()
- return (handle, mname, mod_id, mod_size, mod_iomap_size)
-
-def request_next_module(opcode, handle):
- return _create_with_handle(opcode, handle)
-
-def close_module_handle(opcode, handle):
- return _create_with_handle(opcode, handle)
-
-def read_io_map(opcode, mod_id, offset, n_bytes):
- tgram = _create(opcode)
- tgram.add_u32(mod_id)
- tgram.add_u16(offset)
- tgram.add_u16(n_bytes)
- return tgram
-
-def _parse_read_io_map(tgram):
- tgram.check_status()
- mod_id = tgram.parse_u32()
- n_bytes = tgram.parse_u16()
- contents = tgram.parse_string()
- return (mod_id, n_bytes, contents)
-
-def write_io_map(opcode, mod_id, offset, content):
- tgram = _create(opcode)
- tgram.add_u32(mod_id)
- tgram.add_u16(offset)
- tgram.add_u16(len(content))
- tgram.add_string(len(content), content)
- return tgram
-
-def _parse_write_io_map(tgram):
- tgram.check_status()
- mod_id = tgram.parse_u32()
- n_bytes = tgram.parse_u16()
- return (mod_id, n_bytes)
-
-def boot(opcode):
- # Note: this command is USB only (no Bluetooth)
- tgram = _create(opcode)
- tgram.add_string(19, "Let's dance: SAMBA\0")
- return tgram
-
-def _parse_boot(tgram):
- tgram.check_status()
- resp = tgram.parse_string()
- # Resp should be 'Yes\0'
- return resp
-
-def set_brick_name(opcode, bname):
- tgram = _create(opcode)
- if len(bname) > 15:
- print "Warning! Brick name %s will be truncated to %s!" % (bname, bname[0:15])
- bname = bname[0:15]
- elif len(bname) < 15:
- bname += '\x00' * (15-len(bname)) #fill the extra chars with nulls
- tgram.add_string(len(bname), bname)
- return tgram
-
-def _parse_set_brick_name(tgram):
- tgram.check_status()
-
-def get_device_info(opcode):
- return _create(opcode)
-
-def _parse_get_device_info(tgram):
- tgram.check_status()
- name = tgram.parse_string(15)
- a0 = tgram.parse_u8()
- a1 = tgram.parse_u8()
- a2 = tgram.parse_u8()
- a3 = tgram.parse_u8()
- a4 = tgram.parse_u8()
- a5 = tgram.parse_u8()
- a6 = tgram.parse_u8()
- # FIXME: what is a6 for?
- address = '%02X:%02X:%02X:%02X:%02X:%02X' % (a0, a1, a2, a3, a4, a5)
- signal_strength = tgram.parse_u32()
- user_flash = tgram.parse_u32()
- return (name, address, signal_strength, user_flash)
-
-def delete_user_flash(opcode):
- return _create(opcode)
-
-def _parse_delete_user_flash(tgram):
- tgram.check_status()
-
-def poll_command_length(opcode, buf_num):
- tgram = _create(opcode)
- tgram.add_u8(buf_num)
- return tgram
-
-def _parse_poll_command_length(tgram):
- buf_num = tgram.parse_u8()
- tgram.check_status()
- n_bytes = tgram.parse_u8()
- return (buf_num, n_bytes)
-
-def poll_command(opcode, buf_num, n_bytes):
- tgram = _create(opcode)
- tgram.add_u8(buf_num)
- tgram.add_u8(n_bytes)
- return tgram
-
-def _parse_poll_command(tgram):
- buf_num = tgram.parse_u8()
- tgram.check_status()
- n_bytes = tgram.parse_u8()
- command = tgram.parse_string()
- return (buf_num, n_bytes, command)
-
-def bluetooth_factory_reset(opcode):
- # Note: this command is USB only (no Bluetooth)
- return _create(opcode)
-
-def _parse_bluetooth_factory_reset(tgram):
- tgram.check_status()
-
-OPCODES = {
- 0x80: (open_read, _parse_open_read),
- 0x81: (open_write, _parse_open_write),
- 0x82: (read, _parse_read),
- 0x83: (write, _parse_write),
- 0x84: (close, _parse_close),
- 0x85: (delete, _parse_delete),
- 0x86: (find_first, _parse_find),
- 0x87: (find_next, _parse_find),
- 0x88: (get_firmware_version, _parse_get_firmware_version),
- 0x89: (open_write_linear, _parse_open_write),
- 0x8A: (open_read_linear, _parse_open_read_linear),
- 0x8B: (open_write_data, _parse_open_write),
- 0x8C: (open_append_data, _parse_open_append_data),
- 0x90: (request_first_module, _parse_request_module),
- 0x91: (request_next_module, _parse_request_module),
- 0x92: (close_module_handle, _parse_close),
- 0x94: (read_io_map, _parse_read_io_map),
- 0x95: (write_io_map, _parse_write_io_map),
- 0x97: (boot, _parse_boot),
- 0x98: (set_brick_name, _parse_set_brick_name),
- 0x9B: (get_device_info, _parse_get_device_info),
- 0xA0: (delete_user_flash, _parse_delete_user_flash),
- 0xA1: (poll_command_length, _parse_poll_command_length),
- 0xA2: (poll_command, _parse_poll_command),
- 0xA4: (bluetooth_factory_reset, _parse_bluetooth_factory_reset),
-}
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/telegram.py b/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/telegram.py
deleted file mode 100644
index 1fc5b3e..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/telegram.py
+++ /dev/null
@@ -1,118 +0,0 @@
-# nxt.telegram module -- LEGO Mindstorms NXT telegram formatting and parsing
-# Copyright (C) 2006 Douglas P Lau
-# Copyright (C) 2009 Marcus Wanner
-#
-# 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 3 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.
-
-'Used by nxt.system for sending telegrams to the NXT'
-
-from cStringIO import StringIO
-from struct import pack, unpack
-import nxt.error
-
-class InvalidReplyError(Exception):
- pass
-
-class InvalidOpcodeError(Exception):
- pass
-
-class Telegram(object):
-
- TYPE = 0 # type byte offset
- CODE = 1 # code byte offset
- DATA = 2 # data byte offset
-
- TYPE_NOT_DIRECT = 0x01 # system vs. direct type
- TYPE_REPLY = 0x02 # reply type (from NXT brick)
- TYPE_REPLY_NOT_REQUIRED = 0x80 # reply not required flag
-
- def __init__(self, direct=False, opcode=0, reply_req=True, pkt=None):
- if pkt:
- self.pkt = StringIO(pkt)
- self.typ = self.parse_u8()
- self.opcode = self.parse_u8()
- if not self.is_reply():
- raise InvalidReplyError
- if self.opcode != opcode:
- raise InvalidOpcodeError, self.opcode
- else:
- self.pkt = StringIO()
- typ = 0
- if not direct:
- typ |= Telegram.TYPE_NOT_DIRECT
- if not reply_req:
- typ |= Telegram.TYPE_REPLY_NOT_REQUIRED
- self.add_u8(typ)
- self.add_u8(opcode)
-
- def __str__(self):
- return self.pkt.getvalue()
-
- def is_reply(self):
- return self.typ == Telegram.TYPE_REPLY
-
- def add_string(self, n_bytes, v):
- self.pkt.write(pack('%ds' % n_bytes, v))
-
- def add_filename(self, fname):
- self.pkt.write(pack('20s', fname))
-
- def add_s8(self, v):
- self.pkt.write(pack('<b', v))
-
- def add_u8(self, v):
- self.pkt.write(pack('<B', v))
-
- def add_s16(self, v):
- self.pkt.write(pack('<h', v))
-
- def add_u16(self, v):
- self.pkt.write(pack('<H', v))
-
- def add_s32(self, v):
- self.pkt.write(pack('<i', v))
-
- def add_u32(self, v):
- self.pkt.write(pack('<I', v))
-
- def parse_string(self, n_bytes=0):
- if n_bytes:
- return unpack('%ss' % n_bytes,
- self.pkt.read(n_bytes))[0]
- else:
- return self.pkt.read()
-
- def parse_s8(self):
- return unpack('<b', self.pkt.read(1))[0]
-
- def parse_u8(self):
- return unpack('<B', self.pkt.read(1))[0]
-
- def parse_s16(self):
- return unpack('<h', self.pkt.read(2))[0]
-
- def parse_u16(self):
- return unpack('<H', self.pkt.read(2))[0]
-
- def parse_s32(self):
- return unpack('<i', self.pkt.read(4))[0]
-
- def parse_u32(self):
- return unpack('<I', self.pkt.read(4))[0]
-
- def check_status(self):
- nxt.error.check_status(self.parse_u8())
-
-import nxt.direct
-import nxt.system
-
-OPCODES = dict(nxt.system.OPCODES)
-OPCODES.update(nxt.direct.OPCODES)
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/usbsock.py b/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/usbsock.py
deleted file mode 100644
index 5ff2b36..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/usbsock.py
+++ /dev/null
@@ -1,133 +0,0 @@
-# nxt.usbsock module -- USB socket communication with LEGO Minstorms NXT
-# Copyright (C) 2006, 2007 Douglas P Lau
-# Copyright (C) 2009 Marcus Wanner
-#
-# 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 3 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.
-
-USB_BUFSIZE = 64
-
-try:
- import fantomglue as usb
-except ImportError:
- import pyusbglue as usb
-
-from nxt.brick import Brick
-
-class USBSock(object):
- 'Object for USB connection to NXT'
-
- bsize = 60 # USB socket block size
-
- def __init__(self, device):
- self.sock = usb.USBSocket(device)
- self.debug = True
-
- def __str__(self):
- return 'USB (%s)' % (self.sock.device_name())
-
- def connect(self):
- 'Use to connect to NXT.'
- if self.debug:
- print 'Connecting via USB...'
- self.sock.connect()
- return Brick(self)
-
- def close(self):
- 'Use to close the connection.'
- if self.debug:
- print 'Closing USB connection...'
- self.sock.close()
- #self.sock = None
- if self.debug:
- print 'USB connection closed.'
-
- def send(self, data):
- 'Use to send raw data over USB connection ***ADVANCED USERS ONLY***'
- if self.debug:
- print 'Send:',
- print ':'.join('%02x' % ord(c) for c in data)
- self.sock.send(data)
-
- def recv(self, num_bytes=USB_BUFSIZE):
- 'Use to recieve raw data over USB connection ***ADVANCED USERS ONLY***'
- data = self.sock.recv(num_bytes)
- if self.debug:
- print 'Recv:',
- print ':'.join('%02x' % ord(c) for c in data)
- return data
-
- def __del__(self):
- """Destroy interface."""
- if self.sock is not None:
- del self.sock
- if self.debug:
- print 'Deleted USBSocket.'
-
-
-def _check_brick(arg, value):
- return arg is None or arg == value
-
-def find_bricks(host=None, name=None):
- get_info = False
- 'Use to look for NXTs connected by USB only. ***ADVANCED USERS ONLY***'
- for d in usb.find_devices(lookup_names=True):
- if get_info:
- # pyfantom specific debug info
- print " firmware version:", d.get_firmware_version()
- print " get device info:", d.get_device_info()
- rs = d.get_resource_string()
- print " resource string:", rs
- # FIXME: probably should check host and name
- yield USBSock(d)
-
-if __name__ == '__main__':
- write_read = True
- socks = find_bricks()
- for s in socks:
- #llsocks = usb.find_devices()
- #for ls in llsocks:
- #s = USBSock(ls)
- print s.sock
- brick = s.connect()
- if write_read:
- import struct
- # Write VERSION SYS_CMD.
- # Query:
- # SYS_CMD: 0x01
- # VERSION: 0x88
- cmd = struct.pack('2B', 0x01, 0x88)
- brick.sock.send(cmd)
- #s.send(cmd)
- #s.sock.send(cmd)
- print "wrote", len(cmd)
- # Response:
- # REPLY_CMD: 0x02
- # VERSION: 0x88
- # SUCCESS: 0x00
- # PROTOCOL_VERSION minor
- # PROTOCOL_VERSION major
- # FIRMWARE_VERSION minor
- # FIRMWARE_VERSION major
- rep = brick.sock.recv(7)
- #rep = s.recv(7)
- #rep = s.sock.recv(7)
- print "read", struct.unpack('%dB' % len(rep), rep)
- # Same thing, without response.
- #cmd = struct.pack('2B', 0x81, 0x88)
- #brick.sock.send(cmd)
- #print "wrote", cmd
- #rep = brick.sock.recv()
- #print "read", struct.unpack('%dB' % len(rep), rep)
- #s.close()
- #del s
- #brick.sock.close()
- del brick
-
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/utils.py b/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/utils.py
deleted file mode 100644
index 98ba6df..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/nxt/utils.py
+++ /dev/null
@@ -1,33 +0,0 @@
-# nxt.utils module -- Generic utilities to support other modules
-# Copyright (C) 2010 Vladimir Moskva
-#
-# 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 3 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.
-
-from collections import defaultdict
-
-def parse_command_line_arguments(arguments):
- keyword_parameters = defaultdict(lambda: None)
- parameters = []
- current_key = None
-
- for argument in arguments[1:]:
- if argument in ('-h', '--host'):
- current_key = 'host'
- else:
- if current_key is not None:
- if argument.startswith('-'):
- raise Exception('Invalid arguments')
- keyword_parameters[current_key] = argument
- current_key = None
- else:
- parameters.append(argument)
- return parameters, keyword_parameters
-
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/scripts/nxt_filer b/AT91SAM7S256/armdebug/nxt-python-fantom/scripts/nxt_filer
deleted file mode 100644
index 767d268..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/scripts/nxt_filer
+++ /dev/null
@@ -1,142 +0,0 @@
-#!/usr/bin/env python
-#
-# nxt_filer program -- Simple GUI to manage files on a LEGO Mindstorms NXT
-# Copyright (C) 2006 Douglas P Lau
-# Copyright (C) 2010 rhn
-#
-# 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.
-
-import cStringIO
-import gtk
-import os.path
-import urllib2
-import sys
-
-import nxt.locator
-from nxt.brick import FileFinder, FileReader, FileWriter
-from nxt.utils import parse_command_line_arguments
-
-def read_file(b, fname):
- with FileReader(b, fname) as r:
- with open(fname, 'wb') as f:
- for data in r:
- f.write(data)
-
-class NXTListing(gtk.ListStore):
-
- def __init__(self, brick):
- gtk.ListStore.__init__(self, str, str)
- self.set_sort_column_id(0, gtk.SORT_ASCENDING)
- self.populate(brick, '*.*')
-
- def populate(self, brick, pattern):
- f = FileFinder(brick, pattern)
- for (fname, size) in f:
- self.append((fname, str(size)))
-
-def write_file(b, fname, data):
- w = FileWriter(b, fname, len(data))
- print 'Pushing %s (%d bytes) ...' % (fname, w.size),
- sys.stdout.flush()
- w.write(data)
- print 'wrote %d bytes' % len(data)
- w.close()
-
-def write_files(b, names):
- for fname in names.split('\r\n'):
- if fname:
- print 'File:', fname
- bname = os.path.basename(fname)
- url = urllib2.urlopen(fname)
- try:
- data = url.read()
- finally:
- url.close()
- print 'name %s, size: %d ' % (bname, len(data))
- write_file(b, bname, data)
-
-class NXT_Filer(gtk.Window):
- TARGETS = gtk.target_list_add_uri_targets()
-
- def __init__(self, brick):
- gtk.Window.__init__(self)
- self.brick = brick
- self.set_border_width(6)
- self.nxt_model = NXTListing(brick)
- h = gtk.HBox()
- h.pack_start(self.make_file_panel(str(brick.sock),
- self.nxt_model), True)
- self.add(h)
- self.connect('destroy', self.quit)
-
- def make_file_list(self):
- tv = gtk.TreeView()
- tv.set_headers_visible(True)
- tv.set_property('fixed_height_mode', True)
- r = gtk.CellRendererText()
- c = gtk.TreeViewColumn('File name', r, text=0)
- c.set_fixed_width(200)
- c.set_sizing(gtk.TREE_VIEW_COLUMN_FIXED)
- tv.append_column(c)
- r = gtk.CellRendererText()
- c = gtk.TreeViewColumn('Bytes', r, text=1)
- c.set_sizing(gtk.TREE_VIEW_COLUMN_FIXED)
- c.set_fixed_width(80)
- tv.append_column(c)
-
-# tv.enable_model_drag_source(gtk.gdk.BUTTON1_MASK, self.TARGETS,
-# gtk.gdk.ACTION_DEFAULT | gtk.gdk.ACTION_MOVE)
- tv.enable_model_drag_dest(self.TARGETS, gtk.gdk.ACTION_COPY)
-# tv.connect("drag_data_get", self.drag_data_get_data)
- tv.connect("drag_data_received", self.drag_data_received_data)
-
- return tv
-
- def make_file_panel(self, name, model):
- v = gtk.VBox()
- v.pack_start(gtk.Label(name), False)
- tv = self.make_file_list()
- tv.set_model(model)
- s = gtk.ScrolledWindow()
- s.set_policy(gtk.POLICY_NEVER, gtk.POLICY_ALWAYS)
- s.add(tv)
- s.set_border_width(2)
- v.pack_start(s, True)
- return v
-
- def drag_data_get_data(self, treeview, context, selection, target_id,
- etime):
- treeselection = treeview.get_selection()
- model, iter = treeselection.get_selected()
- data = model.get_value(iter, 0)
- print data
- selection.set(selection.target, 8, data)
-
- def drag_data_received_data(self, treeview, context, x, y, selection,
- info, etime):
- if context.action == gtk.gdk.ACTION_COPY:
- write_files(self.brick, selection.data)
- # FIXME: update file listing after writing files
- # FIXME: finish context
-
- def quit(self, w):
- 'Quit the program'
- self.brick.sock.close()
- gtk.main_quit()
-
-if __name__ == '__main__':
- # FIXME: add dialog with progress bar when scanning bluetooth devices
- arguments, keyword_arguments = parse_command_line_arguments(sys.argv)
-
- brick = nxt.locator.find_one_brick(keyword_arguments['host'])
- win = NXT_Filer(brick)
- win.show_all()
- gtk.main()
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/scripts/nxt_push b/AT91SAM7S256/armdebug/nxt-python-fantom/scripts/nxt_push
deleted file mode 100644
index 395b38f..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/scripts/nxt_push
+++ /dev/null
@@ -1,47 +0,0 @@
-#!/usr/bin/env python
-#
-# nxt_push program -- Push a file to a LEGO Mindstorms NXT brick
-# Copyright (C) 2006 Douglas P Lau
-# Copyright (C) 2010 rhn
-#
-# 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.
-
-import sys
-import nxt.locator
-from nxt.brick import FileWriter
-from nxt.error import FileNotFound
-from nxt.utils import parse_command_line_arguments
-
-def _write_file(b, fname, data):
- w = FileWriter(b, fname, len(data))
- print 'Pushing %s (%d bytes) ...' % (fname, w.size),
- sys.stdout.flush()
- w.write(data)
- print 'wrote %d bytes' % len(data)
- w.close()
-
-def write_file(b, fname):
- f = open(fname)
- data = f.read()
- f.close()
- try:
- b.delete(fname)
- print 'Overwriting %s on NXT' % fname
- except FileNotFound:
- pass
- _write_file(b, fname, data)
-
-if __name__ == '__main__':
- arguments, keyword_arguments = parse_command_line_arguments(sys.argv)
-
- brick = nxt.locator.find_one_brick(keyword_arguments['host'])
- for filename in arguments:
- write_file(brick, filename)
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/scripts/nxt_test b/AT91SAM7S256/armdebug/nxt-python-fantom/scripts/nxt_test
deleted file mode 100644
index 5cc0fcd..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/scripts/nxt_test
+++ /dev/null
@@ -1,33 +0,0 @@
-#!/usr/bin/env python
-
-#Lists various information from all bricks it can connect to.
-
-import sys, traceback
-import nxt.locator
-import nxt.brick
-
-b = None
-socks = nxt.locator.find_bricks()
-for sock in socks:
- try:
- b = sock.connect()
-
- name, host, signal_strength, user_flash = b.get_device_info()
- print 'NXT brick name: %s' % name
- print 'Host address: %s' % host
- print 'Bluetooth signal strength: %s' % signal_strength
- print 'Free user flash: %s' % user_flash
- prot_version, fw_version = b.get_firmware_version()
- print 'Protocol version %s.%s' % prot_version
- print 'Firmware version %s.%s' % fw_version
- millivolts = b.get_battery_level()
- print 'Battery level %s mV' % millivolts
- except:
- print "Error with brick:"
- traceback.print_tb(sys.exc_info()[2])
- print str(sys.exc_info()[1])
- if b:
- b.sock.close()
-
-if not b:
- print "No bricks found!"
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/scripts/pyenv-nxt_test b/AT91SAM7S256/armdebug/nxt-python-fantom/scripts/pyenv-nxt_test
deleted file mode 100755
index c78061c..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/scripts/pyenv-nxt_test
+++ /dev/null
@@ -1,3 +0,0 @@
-#!/bin/sh
-export PYTHONPATH=~/gitrepo/armdebug/nxt-python-fantom
-arch -i386 /usr/bin/python2.6 ~/gitrepo/armdebug/nxt-python-fantom/scripts/nxt_test
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/scripts/pyenv-syspython b/AT91SAM7S256/armdebug/nxt-python-fantom/scripts/pyenv-syspython
deleted file mode 100755
index cea6c52..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/scripts/pyenv-syspython
+++ /dev/null
@@ -1,3 +0,0 @@
-#!/bin/sh
-export PYTHONPATH=~/gitrepo/armdebug/nxt-python-fantom
-arch -i386 /usr/bin/python2.6
diff --git a/AT91SAM7S256/armdebug/nxt-python-fantom/setup.py b/AT91SAM7S256/armdebug/nxt-python-fantom/setup.py
deleted file mode 100644
index 9899347..0000000
--- a/AT91SAM7S256/armdebug/nxt-python-fantom/setup.py
+++ /dev/null
@@ -1,23 +0,0 @@
-#!/usr/bin/env python
-
-from distutils.core import setup
-
-try:
- readme = open('README', 'r')
- ldesc = readme.read(8192)
- readme.close()
-except:
- ldesc = ""
-
-setup(
- name='nxt-python',
- version='2.1.0',
- author='Marcus Wanner',
- author_email='marcusw@cox.net',
- description='LEGO Mindstorms NXT Control Package',
- url='http://code.google.com/p/nxt-python/',
- license='Gnu GPL v3',
- packages=['nxt', 'nxt.sensor'],
- scripts=['scripts/nxt_push', 'scripts/nxt_test', 'scripts/nxt_filer'],
- long_description=ldesc
-)